mirror of https://gitee.com/openkylin/linux.git
Merge branch 'ib-iio-thermal-5.11-rc1' into togreg
Immutable branch to allow for additional patches to thermal that may be applied in this cycle.
This commit is contained in:
commit
1994a922eb
|
@ -10,6 +10,7 @@
|
||||||
* Author: Linus Walleij <linus.walleij@linaro.org>
|
* Author: Linus Walleij <linus.walleij@linaro.org>
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
#include <linux/iio/adc/qcom-vadc-common.h>
|
||||||
#include <linux/iio/iio.h>
|
#include <linux/iio/iio.h>
|
||||||
#include <linux/iio/sysfs.h>
|
#include <linux/iio/sysfs.h>
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
|
@ -21,8 +22,6 @@
|
||||||
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
||||||
#include <linux/regulator/consumer.h>
|
#include <linux/regulator/consumer.h>
|
||||||
|
|
||||||
#include "qcom-vadc-common.h"
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Definitions for the "user processor" registers lifted from the v3.4
|
* Definitions for the "user processor" registers lifted from the v3.4
|
||||||
* Qualcomm tree. Their kernel has two out-of-tree drivers for the ADC:
|
* Qualcomm tree. Their kernel has two out-of-tree drivers for the ADC:
|
||||||
|
|
|
@ -7,6 +7,7 @@
|
||||||
#include <linux/completion.h>
|
#include <linux/completion.h>
|
||||||
#include <linux/delay.h>
|
#include <linux/delay.h>
|
||||||
#include <linux/err.h>
|
#include <linux/err.h>
|
||||||
|
#include <linux/iio/adc/qcom-vadc-common.h>
|
||||||
#include <linux/iio/iio.h>
|
#include <linux/iio/iio.h>
|
||||||
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
||||||
#include <linux/kernel.h>
|
#include <linux/kernel.h>
|
||||||
|
@ -14,12 +15,12 @@
|
||||||
#include <linux/math64.h>
|
#include <linux/math64.h>
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
#include <linux/of.h>
|
#include <linux/of.h>
|
||||||
|
#include <linux/of_device.h>
|
||||||
#include <linux/platform_device.h>
|
#include <linux/platform_device.h>
|
||||||
#include <linux/regmap.h>
|
#include <linux/regmap.h>
|
||||||
#include <linux/slab.h>
|
#include <linux/slab.h>
|
||||||
|
|
||||||
#include <dt-bindings/iio/qcom,spmi-vadc.h>
|
#include <dt-bindings/iio/qcom,spmi-vadc.h>
|
||||||
#include "qcom-vadc-common.h"
|
|
||||||
|
|
||||||
#define ADC5_USR_REVISION1 0x0
|
#define ADC5_USR_REVISION1 0x0
|
||||||
#define ADC5_USR_STATUS1 0x8
|
#define ADC5_USR_STATUS1 0x8
|
||||||
|
@ -154,18 +155,6 @@ struct adc5_chip {
|
||||||
const struct adc5_data *data;
|
const struct adc5_data *data;
|
||||||
};
|
};
|
||||||
|
|
||||||
static const struct vadc_prescale_ratio adc5_prescale_ratios[] = {
|
|
||||||
{.num = 1, .den = 1},
|
|
||||||
{.num = 1, .den = 3},
|
|
||||||
{.num = 1, .den = 4},
|
|
||||||
{.num = 1, .den = 6},
|
|
||||||
{.num = 1, .den = 20},
|
|
||||||
{.num = 1, .den = 8},
|
|
||||||
{.num = 10, .den = 81},
|
|
||||||
{.num = 1, .den = 10},
|
|
||||||
{.num = 1, .den = 16}
|
|
||||||
};
|
|
||||||
|
|
||||||
static int adc5_read(struct adc5_chip *adc, u16 offset, u8 *data, int len)
|
static int adc5_read(struct adc5_chip *adc, u16 offset, u8 *data, int len)
|
||||||
{
|
{
|
||||||
return regmap_bulk_read(adc->regmap, adc->base + offset, data, len);
|
return regmap_bulk_read(adc->regmap, adc->base + offset, data, len);
|
||||||
|
@ -181,55 +170,6 @@ static int adc5_masked_write(struct adc5_chip *adc, u16 offset, u8 mask, u8 val)
|
||||||
return regmap_update_bits(adc->regmap, adc->base + offset, mask, val);
|
return regmap_update_bits(adc->regmap, adc->base + offset, mask, val);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int adc5_prescaling_from_dt(u32 num, u32 den)
|
|
||||||
{
|
|
||||||
unsigned int pre;
|
|
||||||
|
|
||||||
for (pre = 0; pre < ARRAY_SIZE(adc5_prescale_ratios); pre++)
|
|
||||||
if (adc5_prescale_ratios[pre].num == num &&
|
|
||||||
adc5_prescale_ratios[pre].den == den)
|
|
||||||
break;
|
|
||||||
|
|
||||||
if (pre == ARRAY_SIZE(adc5_prescale_ratios))
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
return pre;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int adc5_hw_settle_time_from_dt(u32 value,
|
|
||||||
const unsigned int *hw_settle)
|
|
||||||
{
|
|
||||||
unsigned int i;
|
|
||||||
|
|
||||||
for (i = 0; i < VADC_HW_SETTLE_SAMPLES_MAX; i++) {
|
|
||||||
if (value == hw_settle[i])
|
|
||||||
return i;
|
|
||||||
}
|
|
||||||
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int adc5_avg_samples_from_dt(u32 value)
|
|
||||||
{
|
|
||||||
if (!is_power_of_2(value) || value > ADC5_AVG_SAMPLES_MAX)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
return __ffs(value);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int adc5_decimation_from_dt(u32 value,
|
|
||||||
const unsigned int *decimation)
|
|
||||||
{
|
|
||||||
unsigned int i;
|
|
||||||
|
|
||||||
for (i = 0; i < ADC5_DECIMATION_SAMPLES_MAX; i++) {
|
|
||||||
if (value == decimation[i])
|
|
||||||
return i;
|
|
||||||
}
|
|
||||||
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int adc5_read_voltage_data(struct adc5_chip *adc, u16 *data)
|
static int adc5_read_voltage_data(struct adc5_chip *adc, u16 *data)
|
||||||
{
|
{
|
||||||
int ret;
|
int ret;
|
||||||
|
@ -511,7 +451,7 @@ static int adc_read_raw_common(struct iio_dev *indio_dev,
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
ret = qcom_adc5_hw_scale(prop->scale_fn_type,
|
ret = qcom_adc5_hw_scale(prop->scale_fn_type,
|
||||||
&adc5_prescale_ratios[prop->prescale],
|
prop->prescale,
|
||||||
adc->data,
|
adc->data,
|
||||||
adc_code_volt, val);
|
adc_code_volt, val);
|
||||||
if (ret)
|
if (ret)
|
||||||
|
@ -717,7 +657,7 @@ static int adc5_get_dt_channel_data(struct adc5_chip *adc,
|
||||||
|
|
||||||
ret = of_property_read_u32(node, "qcom,decimation", &value);
|
ret = of_property_read_u32(node, "qcom,decimation", &value);
|
||||||
if (!ret) {
|
if (!ret) {
|
||||||
ret = adc5_decimation_from_dt(value, data->decimation);
|
ret = qcom_adc5_decimation_from_dt(value, data->decimation);
|
||||||
if (ret < 0) {
|
if (ret < 0) {
|
||||||
dev_err(dev, "%02x invalid decimation %d\n",
|
dev_err(dev, "%02x invalid decimation %d\n",
|
||||||
chan, value);
|
chan, value);
|
||||||
|
@ -730,7 +670,7 @@ static int adc5_get_dt_channel_data(struct adc5_chip *adc,
|
||||||
|
|
||||||
ret = of_property_read_u32_array(node, "qcom,pre-scaling", varr, 2);
|
ret = of_property_read_u32_array(node, "qcom,pre-scaling", varr, 2);
|
||||||
if (!ret) {
|
if (!ret) {
|
||||||
ret = adc5_prescaling_from_dt(varr[0], varr[1]);
|
ret = qcom_adc5_prescaling_from_dt(varr[0], varr[1]);
|
||||||
if (ret < 0) {
|
if (ret < 0) {
|
||||||
dev_err(dev, "%02x invalid pre-scaling <%d %d>\n",
|
dev_err(dev, "%02x invalid pre-scaling <%d %d>\n",
|
||||||
chan, varr[0], varr[1]);
|
chan, varr[0], varr[1]);
|
||||||
|
@ -759,11 +699,9 @@ static int adc5_get_dt_channel_data(struct adc5_chip *adc,
|
||||||
if ((dig_version[0] >= ADC5_HW_SETTLE_DIFF_MINOR &&
|
if ((dig_version[0] >= ADC5_HW_SETTLE_DIFF_MINOR &&
|
||||||
dig_version[1] >= ADC5_HW_SETTLE_DIFF_MAJOR) ||
|
dig_version[1] >= ADC5_HW_SETTLE_DIFF_MAJOR) ||
|
||||||
adc->data->info == &adc7_info)
|
adc->data->info == &adc7_info)
|
||||||
ret = adc5_hw_settle_time_from_dt(value,
|
ret = qcom_adc5_hw_settle_time_from_dt(value, data->hw_settle_2);
|
||||||
data->hw_settle_2);
|
|
||||||
else
|
else
|
||||||
ret = adc5_hw_settle_time_from_dt(value,
|
ret = qcom_adc5_hw_settle_time_from_dt(value, data->hw_settle_1);
|
||||||
data->hw_settle_1);
|
|
||||||
|
|
||||||
if (ret < 0) {
|
if (ret < 0) {
|
||||||
dev_err(dev, "%02x invalid hw-settle-time %d us\n",
|
dev_err(dev, "%02x invalid hw-settle-time %d us\n",
|
||||||
|
@ -777,7 +715,7 @@ static int adc5_get_dt_channel_data(struct adc5_chip *adc,
|
||||||
|
|
||||||
ret = of_property_read_u32(node, "qcom,avg-samples", &value);
|
ret = of_property_read_u32(node, "qcom,avg-samples", &value);
|
||||||
if (!ret) {
|
if (!ret) {
|
||||||
ret = adc5_avg_samples_from_dt(value);
|
ret = qcom_adc5_avg_samples_from_dt(value);
|
||||||
if (ret < 0) {
|
if (ret < 0) {
|
||||||
dev_err(dev, "%02x invalid avg-samples %d\n",
|
dev_err(dev, "%02x invalid avg-samples %d\n",
|
||||||
chan, value);
|
chan, value);
|
||||||
|
@ -870,8 +808,6 @@ static int adc5_get_dt_data(struct adc5_chip *adc, struct device_node *node)
|
||||||
struct adc5_channel_prop prop, *chan_props;
|
struct adc5_channel_prop prop, *chan_props;
|
||||||
struct device_node *child;
|
struct device_node *child;
|
||||||
unsigned int index = 0;
|
unsigned int index = 0;
|
||||||
const struct of_device_id *id;
|
|
||||||
const struct adc5_data *data;
|
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
adc->nchannels = of_get_available_child_count(node);
|
adc->nchannels = of_get_available_child_count(node);
|
||||||
|
@ -890,24 +826,21 @@ static int adc5_get_dt_data(struct adc5_chip *adc, struct device_node *node)
|
||||||
|
|
||||||
chan_props = adc->chan_props;
|
chan_props = adc->chan_props;
|
||||||
iio_chan = adc->iio_chans;
|
iio_chan = adc->iio_chans;
|
||||||
id = of_match_node(adc5_match_table, node);
|
adc->data = of_device_get_match_data(adc->dev);
|
||||||
if (id)
|
if (!adc->data)
|
||||||
data = id->data;
|
adc->data = &adc5_data_pmic;
|
||||||
else
|
|
||||||
data = &adc5_data_pmic;
|
|
||||||
adc->data = data;
|
|
||||||
|
|
||||||
for_each_available_child_of_node(node, child) {
|
for_each_available_child_of_node(node, child) {
|
||||||
ret = adc5_get_dt_channel_data(adc, &prop, child, data);
|
ret = adc5_get_dt_channel_data(adc, &prop, child, adc->data);
|
||||||
if (ret) {
|
if (ret) {
|
||||||
of_node_put(child);
|
of_node_put(child);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
prop.scale_fn_type =
|
prop.scale_fn_type =
|
||||||
data->adc_chans[prop.channel].scale_fn_type;
|
adc->data->adc_chans[prop.channel].scale_fn_type;
|
||||||
*chan_props = prop;
|
*chan_props = prop;
|
||||||
adc_chan = &data->adc_chans[prop.channel];
|
adc_chan = &adc->data->adc_chans[prop.channel];
|
||||||
|
|
||||||
iio_chan->channel = prop.channel;
|
iio_chan->channel = prop.channel;
|
||||||
iio_chan->datasheet_name = prop.datasheet_name;
|
iio_chan->datasheet_name = prop.datasheet_name;
|
||||||
|
|
|
@ -7,6 +7,7 @@
|
||||||
#include <linux/completion.h>
|
#include <linux/completion.h>
|
||||||
#include <linux/delay.h>
|
#include <linux/delay.h>
|
||||||
#include <linux/err.h>
|
#include <linux/err.h>
|
||||||
|
#include <linux/iio/adc/qcom-vadc-common.h>
|
||||||
#include <linux/iio/iio.h>
|
#include <linux/iio/iio.h>
|
||||||
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
||||||
#include <linux/kernel.h>
|
#include <linux/kernel.h>
|
||||||
|
@ -20,8 +21,6 @@
|
||||||
|
|
||||||
#include <dt-bindings/iio/qcom,spmi-vadc.h>
|
#include <dt-bindings/iio/qcom,spmi-vadc.h>
|
||||||
|
|
||||||
#include "qcom-vadc-common.h"
|
|
||||||
|
|
||||||
/* VADC register and bit definitions */
|
/* VADC register and bit definitions */
|
||||||
#define VADC_REVISION2 0x1
|
#define VADC_REVISION2 0x1
|
||||||
#define VADC_REVISION2_SUPPORTED_VADC 1
|
#define VADC_REVISION2_SUPPORTED_VADC 1
|
||||||
|
|
|
@ -2,50 +2,61 @@
|
||||||
#include <linux/bug.h>
|
#include <linux/bug.h>
|
||||||
#include <linux/kernel.h>
|
#include <linux/kernel.h>
|
||||||
#include <linux/bitops.h>
|
#include <linux/bitops.h>
|
||||||
|
#include <linux/fixp-arith.h>
|
||||||
|
#include <linux/iio/adc/qcom-vadc-common.h>
|
||||||
#include <linux/math64.h>
|
#include <linux/math64.h>
|
||||||
#include <linux/log2.h>
|
#include <linux/log2.h>
|
||||||
#include <linux/err.h>
|
#include <linux/err.h>
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
#include <linux/units.h>
|
#include <linux/units.h>
|
||||||
|
|
||||||
#include "qcom-vadc-common.h"
|
/**
|
||||||
|
* struct vadc_map_pt - Map the graph representation for ADC channel
|
||||||
|
* @x: Represent the ADC digitized code.
|
||||||
|
* @y: Represent the physical data which can be temperature, voltage,
|
||||||
|
* resistance.
|
||||||
|
*/
|
||||||
|
struct vadc_map_pt {
|
||||||
|
s32 x;
|
||||||
|
s32 y;
|
||||||
|
};
|
||||||
|
|
||||||
/* Voltage to temperature */
|
/* Voltage to temperature */
|
||||||
static const struct vadc_map_pt adcmap_100k_104ef_104fb[] = {
|
static const struct vadc_map_pt adcmap_100k_104ef_104fb[] = {
|
||||||
{1758, -40},
|
{1758, -40000 },
|
||||||
{1742, -35},
|
{1742, -35000 },
|
||||||
{1719, -30},
|
{1719, -30000 },
|
||||||
{1691, -25},
|
{1691, -25000 },
|
||||||
{1654, -20},
|
{1654, -20000 },
|
||||||
{1608, -15},
|
{1608, -15000 },
|
||||||
{1551, -10},
|
{1551, -10000 },
|
||||||
{1483, -5},
|
{1483, -5000 },
|
||||||
{1404, 0},
|
{1404, 0 },
|
||||||
{1315, 5},
|
{1315, 5000 },
|
||||||
{1218, 10},
|
{1218, 10000 },
|
||||||
{1114, 15},
|
{1114, 15000 },
|
||||||
{1007, 20},
|
{1007, 20000 },
|
||||||
{900, 25},
|
{900, 25000 },
|
||||||
{795, 30},
|
{795, 30000 },
|
||||||
{696, 35},
|
{696, 35000 },
|
||||||
{605, 40},
|
{605, 40000 },
|
||||||
{522, 45},
|
{522, 45000 },
|
||||||
{448, 50},
|
{448, 50000 },
|
||||||
{383, 55},
|
{383, 55000 },
|
||||||
{327, 60},
|
{327, 60000 },
|
||||||
{278, 65},
|
{278, 65000 },
|
||||||
{237, 70},
|
{237, 70000 },
|
||||||
{202, 75},
|
{202, 75000 },
|
||||||
{172, 80},
|
{172, 80000 },
|
||||||
{146, 85},
|
{146, 85000 },
|
||||||
{125, 90},
|
{125, 90000 },
|
||||||
{107, 95},
|
{107, 95000 },
|
||||||
{92, 100},
|
{92, 100000 },
|
||||||
{79, 105},
|
{79, 105000 },
|
||||||
{68, 110},
|
{68, 110000 },
|
||||||
{59, 115},
|
{59, 115000 },
|
||||||
{51, 120},
|
{51, 120000 },
|
||||||
{44, 125}
|
{44, 125000 }
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -90,18 +101,18 @@ static const struct vadc_map_pt adcmap_100k_104ef_104fb_1875_vref[] = {
|
||||||
};
|
};
|
||||||
|
|
||||||
static const struct vadc_map_pt adcmap7_die_temp[] = {
|
static const struct vadc_map_pt adcmap7_die_temp[] = {
|
||||||
{ 433700, 1967},
|
{ 857300, 160000 },
|
||||||
{ 473100, 1964},
|
{ 820100, 140000 },
|
||||||
{ 512400, 1957},
|
{ 782500, 120000 },
|
||||||
{ 551500, 1949},
|
{ 744600, 100000 },
|
||||||
{ 590500, 1940},
|
{ 706400, 80000 },
|
||||||
{ 629300, 1930},
|
{ 667900, 60000 },
|
||||||
{ 667900, 1921},
|
{ 629300, 40000 },
|
||||||
{ 706400, 1910},
|
{ 590500, 20000 },
|
||||||
{ 744600, 1896},
|
{ 551500, 0 },
|
||||||
{ 782500, 1878},
|
{ 512400, -20000 },
|
||||||
{ 820100, 1859},
|
{ 473100, -40000 },
|
||||||
{ 857300, 0},
|
{ 433700, -60000 },
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
@ -278,6 +289,18 @@ static const struct vadc_map_pt adcmap7_100k[] = {
|
||||||
{ 2420, 130048 }
|
{ 2420, 130048 }
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static const struct vadc_prescale_ratio adc5_prescale_ratios[] = {
|
||||||
|
{.num = 1, .den = 1},
|
||||||
|
{.num = 1, .den = 3},
|
||||||
|
{.num = 1, .den = 4},
|
||||||
|
{.num = 1, .den = 6},
|
||||||
|
{.num = 1, .den = 20},
|
||||||
|
{.num = 1, .den = 8},
|
||||||
|
{.num = 10, .den = 81},
|
||||||
|
{.num = 1, .den = 10},
|
||||||
|
{.num = 1, .den = 16}
|
||||||
|
};
|
||||||
|
|
||||||
static int qcom_vadc_scale_hw_calib_volt(
|
static int qcom_vadc_scale_hw_calib_volt(
|
||||||
const struct vadc_prescale_ratio *prescale,
|
const struct vadc_prescale_ratio *prescale,
|
||||||
const struct adc5_data *data,
|
const struct adc5_data *data,
|
||||||
|
@ -323,43 +346,23 @@ static struct qcom_adc5_scale_type scale_adc5_fn[] = {
|
||||||
static int qcom_vadc_map_voltage_temp(const struct vadc_map_pt *pts,
|
static int qcom_vadc_map_voltage_temp(const struct vadc_map_pt *pts,
|
||||||
u32 tablesize, s32 input, int *output)
|
u32 tablesize, s32 input, int *output)
|
||||||
{
|
{
|
||||||
bool descending = 1;
|
|
||||||
u32 i = 0;
|
u32 i = 0;
|
||||||
|
|
||||||
if (!pts)
|
if (!pts)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
/* Check if table is descending or ascending */
|
while (i < tablesize && pts[i].x > input)
|
||||||
if (tablesize > 1) {
|
|
||||||
if (pts[0].x < pts[1].x)
|
|
||||||
descending = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
while (i < tablesize) {
|
|
||||||
if ((descending) && (pts[i].x < input)) {
|
|
||||||
/* table entry is less than measured*/
|
|
||||||
/* value and table is descending, stop */
|
|
||||||
break;
|
|
||||||
} else if ((!descending) &&
|
|
||||||
(pts[i].x > input)) {
|
|
||||||
/* table entry is greater than measured*/
|
|
||||||
/*value and table is ascending, stop */
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
i++;
|
i++;
|
||||||
}
|
|
||||||
|
|
||||||
if (i == 0) {
|
if (i == 0) {
|
||||||
*output = pts[0].y;
|
*output = pts[0].y;
|
||||||
} else if (i == tablesize) {
|
} else if (i == tablesize) {
|
||||||
*output = pts[tablesize - 1].y;
|
*output = pts[tablesize - 1].y;
|
||||||
} else {
|
} else {
|
||||||
/* result is between search_index and search_index-1 */
|
|
||||||
/* interpolate linearly */
|
/* interpolate linearly */
|
||||||
*output = (((s32)((pts[i].y - pts[i - 1].y) *
|
*output = fixp_linear_interpolate(pts[i - 1].x, pts[i - 1].y,
|
||||||
(input - pts[i - 1].x)) /
|
pts[i].x, pts[i].y,
|
||||||
(pts[i].x - pts[i - 1].x)) +
|
input);
|
||||||
pts[i - 1].y);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
@ -415,8 +418,6 @@ static int qcom_vadc_scale_therm(const struct vadc_linear_graph *calib_graph,
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
*result_mdec *= 1000;
|
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -563,33 +564,13 @@ static int qcom_vadc7_scale_hw_calib_die_temp(
|
||||||
u16 adc_code, int *result_mdec)
|
u16 adc_code, int *result_mdec)
|
||||||
{
|
{
|
||||||
|
|
||||||
int voltage, vtemp0, temp, i;
|
int voltage;
|
||||||
|
|
||||||
voltage = qcom_vadc_scale_code_voltage_factor(adc_code,
|
voltage = qcom_vadc_scale_code_voltage_factor(adc_code,
|
||||||
prescale, data, 1);
|
prescale, data, 1);
|
||||||
|
|
||||||
if (adcmap7_die_temp[0].x > voltage) {
|
return qcom_vadc_map_voltage_temp(adcmap7_die_temp, ARRAY_SIZE(adcmap7_die_temp),
|
||||||
*result_mdec = DIE_TEMP_ADC7_SCALE_1;
|
voltage, result_mdec);
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (adcmap7_die_temp[ARRAY_SIZE(adcmap7_die_temp) - 1].x <= voltage) {
|
|
||||||
*result_mdec = DIE_TEMP_ADC7_MAX;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
for (i = 0; i < ARRAY_SIZE(adcmap7_die_temp); i++)
|
|
||||||
if (adcmap7_die_temp[i].x > voltage)
|
|
||||||
break;
|
|
||||||
|
|
||||||
vtemp0 = adcmap7_die_temp[i - 1].x;
|
|
||||||
voltage = voltage - vtemp0;
|
|
||||||
temp = div64_s64(voltage * DIE_TEMP_ADC7_SCALE_FACTOR,
|
|
||||||
adcmap7_die_temp[i - 1].y);
|
|
||||||
temp += DIE_TEMP_ADC7_SCALE_1 + (DIE_TEMP_ADC7_SCALE_2 * (i - 1));
|
|
||||||
*result_mdec = temp;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int qcom_vadc_scale_hw_smb_temp(
|
static int qcom_vadc_scale_hw_smb_temp(
|
||||||
|
@ -647,10 +628,12 @@ int qcom_vadc_scale(enum vadc_scale_fn_type scaletype,
|
||||||
EXPORT_SYMBOL(qcom_vadc_scale);
|
EXPORT_SYMBOL(qcom_vadc_scale);
|
||||||
|
|
||||||
int qcom_adc5_hw_scale(enum vadc_scale_fn_type scaletype,
|
int qcom_adc5_hw_scale(enum vadc_scale_fn_type scaletype,
|
||||||
const struct vadc_prescale_ratio *prescale,
|
unsigned int prescale_ratio,
|
||||||
const struct adc5_data *data,
|
const struct adc5_data *data,
|
||||||
u16 adc_code, int *result)
|
u16 adc_code, int *result)
|
||||||
{
|
{
|
||||||
|
const struct vadc_prescale_ratio *prescale = &adc5_prescale_ratios[prescale_ratio];
|
||||||
|
|
||||||
if (!(scaletype >= SCALE_HW_CALIB_DEFAULT &&
|
if (!(scaletype >= SCALE_HW_CALIB_DEFAULT &&
|
||||||
scaletype < SCALE_HW_CALIB_INVALID)) {
|
scaletype < SCALE_HW_CALIB_INVALID)) {
|
||||||
pr_err("Invalid scale type %d\n", scaletype);
|
pr_err("Invalid scale type %d\n", scaletype);
|
||||||
|
@ -662,6 +645,58 @@ int qcom_adc5_hw_scale(enum vadc_scale_fn_type scaletype,
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(qcom_adc5_hw_scale);
|
EXPORT_SYMBOL(qcom_adc5_hw_scale);
|
||||||
|
|
||||||
|
int qcom_adc5_prescaling_from_dt(u32 num, u32 den)
|
||||||
|
{
|
||||||
|
unsigned int pre;
|
||||||
|
|
||||||
|
for (pre = 0; pre < ARRAY_SIZE(adc5_prescale_ratios); pre++)
|
||||||
|
if (adc5_prescale_ratios[pre].num == num &&
|
||||||
|
adc5_prescale_ratios[pre].den == den)
|
||||||
|
break;
|
||||||
|
|
||||||
|
if (pre == ARRAY_SIZE(adc5_prescale_ratios))
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
return pre;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL(qcom_adc5_prescaling_from_dt);
|
||||||
|
|
||||||
|
int qcom_adc5_hw_settle_time_from_dt(u32 value,
|
||||||
|
const unsigned int *hw_settle)
|
||||||
|
{
|
||||||
|
unsigned int i;
|
||||||
|
|
||||||
|
for (i = 0; i < VADC_HW_SETTLE_SAMPLES_MAX; i++) {
|
||||||
|
if (value == hw_settle[i])
|
||||||
|
return i;
|
||||||
|
}
|
||||||
|
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL(qcom_adc5_hw_settle_time_from_dt);
|
||||||
|
|
||||||
|
int qcom_adc5_avg_samples_from_dt(u32 value)
|
||||||
|
{
|
||||||
|
if (!is_power_of_2(value) || value > ADC5_AVG_SAMPLES_MAX)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
return __ffs(value);
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL(qcom_adc5_avg_samples_from_dt);
|
||||||
|
|
||||||
|
int qcom_adc5_decimation_from_dt(u32 value, const unsigned int *decimation)
|
||||||
|
{
|
||||||
|
unsigned int i;
|
||||||
|
|
||||||
|
for (i = 0; i < ADC5_DECIMATION_SAMPLES_MAX; i++) {
|
||||||
|
if (value == decimation[i])
|
||||||
|
return i;
|
||||||
|
}
|
||||||
|
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL(qcom_adc5_decimation_from_dt);
|
||||||
|
|
||||||
int qcom_vadc_decimation_from_dt(u32 value)
|
int qcom_vadc_decimation_from_dt(u32 value)
|
||||||
{
|
{
|
||||||
if (!is_power_of_2(value) || value < VADC_DECIMATION_MIN ||
|
if (!is_power_of_2(value) || value < VADC_DECIMATION_MIN ||
|
||||||
|
|
|
@ -191,8 +191,8 @@ static struct iio_channel *of_iio_channel_get(struct device_node *np, int index)
|
||||||
return ERR_PTR(err);
|
return ERR_PTR(err);
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct iio_channel *of_iio_channel_get_by_name(struct device_node *np,
|
struct iio_channel *of_iio_channel_get_by_name(struct device_node *np,
|
||||||
const char *name)
|
const char *name)
|
||||||
{
|
{
|
||||||
struct iio_channel *chan = NULL;
|
struct iio_channel *chan = NULL;
|
||||||
|
|
||||||
|
@ -230,6 +230,7 @@ static struct iio_channel *of_iio_channel_get_by_name(struct device_node *np,
|
||||||
|
|
||||||
return chan;
|
return chan;
|
||||||
}
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(of_iio_channel_get_by_name);
|
||||||
|
|
||||||
static struct iio_channel *of_iio_channel_get_all(struct device *dev)
|
static struct iio_channel *of_iio_channel_get_all(struct device *dev)
|
||||||
{
|
{
|
||||||
|
@ -272,12 +273,6 @@ static struct iio_channel *of_iio_channel_get_all(struct device *dev)
|
||||||
|
|
||||||
#else /* CONFIG_OF */
|
#else /* CONFIG_OF */
|
||||||
|
|
||||||
static inline struct iio_channel *
|
|
||||||
of_iio_channel_get_by_name(struct device_node *np, const char *name)
|
|
||||||
{
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline struct iio_channel *of_iio_channel_get_all(struct device *dev)
|
static inline struct iio_channel *of_iio_channel_get_all(struct device *dev)
|
||||||
{
|
{
|
||||||
return NULL;
|
return NULL;
|
||||||
|
@ -393,6 +388,29 @@ struct iio_channel *devm_iio_channel_get(struct device *dev,
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(devm_iio_channel_get);
|
EXPORT_SYMBOL_GPL(devm_iio_channel_get);
|
||||||
|
|
||||||
|
struct iio_channel *devm_of_iio_channel_get_by_name(struct device *dev,
|
||||||
|
struct device_node *np,
|
||||||
|
const char *channel_name)
|
||||||
|
{
|
||||||
|
struct iio_channel **ptr, *channel;
|
||||||
|
|
||||||
|
ptr = devres_alloc(devm_iio_channel_free, sizeof(*ptr), GFP_KERNEL);
|
||||||
|
if (!ptr)
|
||||||
|
return ERR_PTR(-ENOMEM);
|
||||||
|
|
||||||
|
channel = of_iio_channel_get_by_name(np, channel_name);
|
||||||
|
if (IS_ERR(channel)) {
|
||||||
|
devres_free(ptr);
|
||||||
|
return channel;
|
||||||
|
}
|
||||||
|
|
||||||
|
*ptr = channel;
|
||||||
|
devres_add(dev, ptr);
|
||||||
|
|
||||||
|
return channel;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(devm_of_iio_channel_get_by_name);
|
||||||
|
|
||||||
struct iio_channel *iio_channel_get_all(struct device *dev)
|
struct iio_channel *iio_channel_get_all(struct device *dev)
|
||||||
{
|
{
|
||||||
const char *name;
|
const char *name;
|
||||||
|
|
|
@ -141,4 +141,23 @@ static inline s32 fixp_sin32_rad(u32 radians, u32 twopi)
|
||||||
#define fixp_cos32_rad(rad, twopi) \
|
#define fixp_cos32_rad(rad, twopi) \
|
||||||
fixp_sin32_rad(rad + twopi / 4, twopi)
|
fixp_sin32_rad(rad + twopi / 4, twopi)
|
||||||
|
|
||||||
|
/**
|
||||||
|
* fixp_linear_interpolate() - interpolates a value from two known points
|
||||||
|
*
|
||||||
|
* @x0: x value of point 0
|
||||||
|
* @y0: y value of point 0
|
||||||
|
* @x1: x value of point 1
|
||||||
|
* @y1: y value of point 1
|
||||||
|
* @x: the linear interpolant
|
||||||
|
*/
|
||||||
|
static inline int fixp_linear_interpolate(int x0, int y0, int x1, int y1, int x)
|
||||||
|
{
|
||||||
|
if (y0 == y1 || x == x0)
|
||||||
|
return y0;
|
||||||
|
if (x1 == x0 || x == x1)
|
||||||
|
return y1;
|
||||||
|
|
||||||
|
return y0 + ((y1 - y0) * (x - x0) / (x1 - x0));
|
||||||
|
}
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -6,6 +6,8 @@
|
||||||
#ifndef QCOM_VADC_COMMON_H
|
#ifndef QCOM_VADC_COMMON_H
|
||||||
#define QCOM_VADC_COMMON_H
|
#define QCOM_VADC_COMMON_H
|
||||||
|
|
||||||
|
#include <linux/types.h>
|
||||||
|
|
||||||
#define VADC_CONV_TIME_MIN_US 2000
|
#define VADC_CONV_TIME_MIN_US 2000
|
||||||
#define VADC_CONV_TIME_MAX_US 2100
|
#define VADC_CONV_TIME_MAX_US 2100
|
||||||
|
|
||||||
|
@ -52,22 +54,6 @@
|
||||||
#define R_PU_100K 100000
|
#define R_PU_100K 100000
|
||||||
#define RATIO_MAX_ADC7 BIT(14)
|
#define RATIO_MAX_ADC7 BIT(14)
|
||||||
|
|
||||||
#define DIE_TEMP_ADC7_SCALE_1 -60000
|
|
||||||
#define DIE_TEMP_ADC7_SCALE_2 20000
|
|
||||||
#define DIE_TEMP_ADC7_SCALE_FACTOR 1000
|
|
||||||
#define DIE_TEMP_ADC7_MAX 160000
|
|
||||||
|
|
||||||
/**
|
|
||||||
* struct vadc_map_pt - Map the graph representation for ADC channel
|
|
||||||
* @x: Represent the ADC digitized code.
|
|
||||||
* @y: Represent the physical data which can be temperature, voltage,
|
|
||||||
* resistance.
|
|
||||||
*/
|
|
||||||
struct vadc_map_pt {
|
|
||||||
s32 x;
|
|
||||||
s32 y;
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* VADC_CALIB_ABSOLUTE: uses the 625mV and 1.25V as reference channels.
|
* VADC_CALIB_ABSOLUTE: uses the 625mV and 1.25V as reference channels.
|
||||||
* VADC_CALIB_RATIOMETRIC: uses the reference voltage (1.8V) and GND for
|
* VADC_CALIB_RATIOMETRIC: uses the reference voltage (1.8V) and GND for
|
||||||
|
@ -168,10 +154,18 @@ struct qcom_adc5_scale_type {
|
||||||
};
|
};
|
||||||
|
|
||||||
int qcom_adc5_hw_scale(enum vadc_scale_fn_type scaletype,
|
int qcom_adc5_hw_scale(enum vadc_scale_fn_type scaletype,
|
||||||
const struct vadc_prescale_ratio *prescale,
|
unsigned int prescale_ratio,
|
||||||
const struct adc5_data *data,
|
const struct adc5_data *data,
|
||||||
u16 adc_code, int *result_mdec);
|
u16 adc_code, int *result_mdec);
|
||||||
|
|
||||||
|
int qcom_adc5_prescaling_from_dt(u32 num, u32 den);
|
||||||
|
|
||||||
|
int qcom_adc5_hw_settle_time_from_dt(u32 value, const unsigned int *hw_settle);
|
||||||
|
|
||||||
|
int qcom_adc5_avg_samples_from_dt(u32 value);
|
||||||
|
|
||||||
|
int qcom_adc5_decimation_from_dt(u32 value, const unsigned int *decimation);
|
||||||
|
|
||||||
int qcom_vadc_decimation_from_dt(u32 value);
|
int qcom_vadc_decimation_from_dt(u32 value);
|
||||||
|
|
||||||
#endif /* QCOM_VADC_COMMON_H */
|
#endif /* QCOM_VADC_COMMON_H */
|
|
@ -13,6 +13,7 @@
|
||||||
struct iio_dev;
|
struct iio_dev;
|
||||||
struct iio_chan_spec;
|
struct iio_chan_spec;
|
||||||
struct device;
|
struct device;
|
||||||
|
struct device_node;
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* struct iio_channel - everything needed for a consumer to use a channel
|
* struct iio_channel - everything needed for a consumer to use a channel
|
||||||
|
@ -97,6 +98,41 @@ void iio_channel_release_all(struct iio_channel *chan);
|
||||||
*/
|
*/
|
||||||
struct iio_channel *devm_iio_channel_get_all(struct device *dev);
|
struct iio_channel *devm_iio_channel_get_all(struct device *dev);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* of_iio_channel_get_by_name() - get description of all that is needed to access channel.
|
||||||
|
* @np: Pointer to consumer device tree node
|
||||||
|
* @consumer_channel: Unique name to identify the channel on the consumer
|
||||||
|
* side. This typically describes the channels use within
|
||||||
|
* the consumer. E.g. 'battery_voltage'
|
||||||
|
*/
|
||||||
|
#ifdef CONFIG_OF
|
||||||
|
struct iio_channel *of_iio_channel_get_by_name(struct device_node *np, const char *name);
|
||||||
|
#else
|
||||||
|
static inline struct iio_channel *
|
||||||
|
of_iio_channel_get_by_name(struct device_node *np, const char *name)
|
||||||
|
{
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* devm_of_iio_channel_get_by_name() - Resource managed version of of_iio_channel_get_by_name().
|
||||||
|
* @dev: Pointer to consumer device.
|
||||||
|
* @np: Pointer to consumer device tree node
|
||||||
|
* @consumer_channel: Unique name to identify the channel on the consumer
|
||||||
|
* side. This typically describes the channels use within
|
||||||
|
* the consumer. E.g. 'battery_voltage'
|
||||||
|
*
|
||||||
|
* Returns a pointer to negative errno if it is not able to get the iio channel
|
||||||
|
* otherwise returns valid pointer for iio channel.
|
||||||
|
*
|
||||||
|
* The allocated iio channel is automatically released when the device is
|
||||||
|
* unbound.
|
||||||
|
*/
|
||||||
|
struct iio_channel *devm_of_iio_channel_get_by_name(struct device *dev,
|
||||||
|
struct device_node *np,
|
||||||
|
const char *consumer_channel);
|
||||||
|
|
||||||
struct iio_cb_buffer;
|
struct iio_cb_buffer;
|
||||||
/**
|
/**
|
||||||
* iio_channel_get_all_cb() - register callback for triggered capture
|
* iio_channel_get_all_cb() - register callback for triggered capture
|
||||||
|
|
Loading…
Reference in New Issue