[PATCH 07/16] iio: adc: sun4i-gpadc-iio: rework: support nvmem calibration data

Philipp Rossak embed3d at gmail.com
Sun Jan 28 06:39:15 PST 2018



On 28.01.2018 14:52, Icenowy Zheng wrote:
> 
> 
> 于 2018年1月28日 GMT+08:00 下午9:46:18, Philipp Rossak <embed3d at gmail.com> 写到:
>>
>>
>> On 28.01.2018 10:02, Jonathan Cameron wrote:
>>> On Fri, 26 Jan 2018 16:19:32 +0100
>>> Philipp Rossak <embed3d at gmail.com> wrote:
>>>
>>>> This patch reworks the driver to support nvmem calibration cells.
>>>> The driver checks if the nvmem calibration is supported and reads
>> out
>>>> the nvmem. At the beginning of the startup process the calibration
>> data
>>>> is written to the related registers.
>>>>
>>>> Signed-off-by: Philipp Rossak <embed3d at gmail.com>
>>>
>>> A few minor suggestions inline.
>>>
>>> Jonathan
>>>
>>>> ---
>>>>    drivers/iio/adc/sun4i-gpadc-iio.c | 52
>> +++++++++++++++++++++++++++++++++++++++
>>>>    include/linux/mfd/sun4i-gpadc.h   |  2 ++
>>>>    2 files changed, 54 insertions(+)
>>>>
>>>> diff --git a/drivers/iio/adc/sun4i-gpadc-iio.c
>> b/drivers/iio/adc/sun4i-gpadc-iio.c
>>>> index bff06f2798e8..7b12666cdd9e 100644
>>>> --- a/drivers/iio/adc/sun4i-gpadc-iio.c
>>>> +++ b/drivers/iio/adc/sun4i-gpadc-iio.c
>>>> @@ -27,6 +27,7 @@
>>>>    #include <linux/interrupt.h>
>>>>    #include <linux/io.h>
>>>>    #include <linux/module.h>
>>>> +#include <linux/nvmem-consumer.h>
>>>>    #include <linux/of.h>
>>>>    #include <linux/of_device.h>
>>>>    #include <linux/platform_device.h>
>>>> @@ -81,6 +82,7 @@ struct gpadc_data {
>>>>    	bool		has_bus_rst;
>>>>    	bool		has_mod_clk;
>>>>    	int		sensor_count;
>>>> +	bool		supports_nvmem;
>>>>    };
>>>>    
>>>>    static const struct gpadc_data sun4i_gpadc_data = {
>>>> @@ -94,6 +96,7 @@ static const struct gpadc_data sun4i_gpadc_data =
>> {
>>>>    	.sample_start = sun4i_gpadc_sample_start,
>>>>    	.sample_end = sun4i_gpadc_sample_end,
>>>>    	.sensor_count = 1,
>>>> +	.supports_nvmem = false,
>>>>    };
>>>>    
>>>>    static const struct gpadc_data sun5i_gpadc_data = {
>>>> @@ -107,6 +110,7 @@ static const struct gpadc_data sun5i_gpadc_data
>> = {
>>>>    	.sample_start = sun4i_gpadc_sample_start,
>>>>    	.sample_end = sun4i_gpadc_sample_end,
>>>>    	.sensor_count = 1,
>>>> +	.supports_nvmem = false,
>>>>    };
>>>>    
>>>>    static const struct gpadc_data sun6i_gpadc_data = {
>>>> @@ -120,6 +124,7 @@ static const struct gpadc_data sun6i_gpadc_data
>> = {
>>>>    	.sample_start = sun4i_gpadc_sample_start,
>>>>    	.sample_end = sun4i_gpadc_sample_end,
>>>>    	.sensor_count = 1,
>>>> +	.supports_nvmem = false,
>>>>    };
>>>>    
>>>>    static const struct gpadc_data sun8i_a33_gpadc_data = {
>>>> @@ -130,6 +135,7 @@ static const struct gpadc_data
>> sun8i_a33_gpadc_data = {
>>>>    	.sample_start = sun4i_gpadc_sample_start,
>>>>    	.sample_end = sun4i_gpadc_sample_end,
>>>>    	.sensor_count = 1,
>>>> +	.supports_nvmem = false,
> 
> BTW A33 claims to support calibration data according to the manual.
> 

Yes that's true, but I haven't seen a sid/nvmem driver for the a33. If 
that is available, we can change this for true (same on a83t).

>>>>    };
>>>>    
>>>>    struct sun4i_gpadc_iio {
>>>> @@ -148,6 +154,8 @@ struct sun4i_gpadc_iio {
>>>>    	struct clk			*mod_clk;
>>>>    	struct reset_control		*reset;
>>>>    	int				sensor_id;
>>>> +	u32				calibration_data[2];
>>>> +	bool				has_calibration_data[2];
>>>>    	/* prevents concurrent reads of temperature and ADC */
>>>>    	struct mutex			mutex;
>>>>    	struct thermal_zone_device	*tzd;
>>>> @@ -459,6 +467,17 @@ static int sun4i_gpadc_runtime_suspend(struct
>> device *dev)
>>>>    	return info->data->sample_end(info);
>>>>    }
>>>>    
>>>> +static void sunxi_calibrate(struct sun4i_gpadc_iio *info)
>>>> +{
>>>> +	if (info->has_calibration_data[0])
>>>> +		regmap_write(info->regmap, SUNXI_THS_CDATA_0_1,
>>>> +			info->calibration_data[0]);
>>>> +
>>>> +	if (info->has_calibration_data[1])
>>>> +		regmap_write(info->regmap, SUNXI_THS_CDATA_2_3,
>>>> +			info->calibration_data[1]);
>>>> +}
>>>> +
>>>>    static int sun4i_gpadc_sample_start(struct sun4i_gpadc_iio *info)
>>>>    {
>>>>    	/* clkin = 6MHz */
>>>> @@ -481,6 +500,7 @@ static int sun4i_gpadc_sample_start(struct
>> sun4i_gpadc_iio *info)
>>>>    static int sunxi_ths_sample_start(struct sun4i_gpadc_iio *info)
>>>>    {
>>>>    	u32 value;
>>>> +	sunxi_calibrate(info);
>>>>    
>>>>    	if (info->data->ctrl0_map)
>>>>    		regmap_write(info->regmap, SUNXI_THS_CTRL0,
>>>> @@ -602,6 +622,9 @@ static int sun4i_gpadc_probe_dt(struct
>> platform_device *pdev,
>>>>    	struct resource *mem;
>>>>    	void __iomem *base;
>>>>    	int ret;
>>>> +	struct nvmem_cell *cell;
>>>> +	ssize_t cell_size;
>>>> +	u64 *cell_data;
>>>>    
>>>>    	info->data = of_device_get_match_data(&pdev->dev);
>>>>    	if (!info->data)
>>>> @@ -616,6 +639,35 @@ static int sun4i_gpadc_probe_dt(struct
>> platform_device *pdev,
>>>>    	if (IS_ERR(base))
>>>>    		return PTR_ERR(base);
>>>>    
>>>> +	info->has_calibration_data[0] = false;
>>>> +	info->has_calibration_data[1] = false;
>>>> +
>>>> +	if (!info->data->supports_nvmem)
>>>> +		goto no_nvmem;
>>>> +
>>>> +	cell = devm_nvmem_cell_get(&pdev->dev, "calibration");
>>>> +	if (IS_ERR(cell)) {
>>>> +		if (PTR_ERR(cell) == -EPROBE_DEFER)
>>>> +			return PTR_ERR(cell);
>>> Use a goto here to no_nvmem.
>>>
>>> Then you can drop the below else to make things more readable.
>>>> +	} else {
>>>> +		cell_data = (u64 *)nvmem_cell_read(cell, &cell_size);
>>>> +		devm_nvmem_cell_put(&pdev->dev, cell);
>>>
>>> I'm really not keen on use of devm for things we are intending
>>> to drop almost immediately.  Just use the non managed versions
>>> and clean up properly in the error paths (if there are any
>>> where it is needed - which there aren't that I can see)
>>>
>>
>> ^^ Ok, I will rework that.
>>
>>>> +		if (cell_size <= 4) {
>>> Is it valid if it is anything other than 4?
>>
>> For sensors with only one sensor would be also a 2 valid, for those
>> with
>> 2 sensors ==> 4, with 3 sensors ==> 6 and with and with 4 sensors ==>
>> 8.
>>
>> In hardware we have in total to 32bit registers for calibration, thus I
>>
>> thought it would be a good idea to use always four bytes per register.
>> If two bytes are used, they should be the default value.
>>
>> But I agree, this needs a rework.
>>
>>>> +			info->has_calibration_data[0] = true;
>>>> +			info->calibration_data[0] = be32_to_cpu(cell_data[0] &
>>>> +					GENMASK(31, 0));
>>>
>>> Masking isn't needed,  If you want to be paranoid there is the
>> lower_32_bits
>>> function..
>>>
>> ^^ Ok, I will rework that.
>>>> +		} else if (cell_size <= 8) {
>>>> +			info->has_calibration_data[0] = true;
>>>> +			info->calibration_data[0] = be32_to_cpu(cell_data[0] &
>>>> +					GENMASK(31, 0));
>>>
>>> This first block is repeated.  Easy enough to avoid I think...
>>>
>>
>> ^^ Ok, I will rework that.
>>
>>>> +			info->has_calibration_data[1] = true;
>>>> +			info->calibration_data[1] = be32_to_cpu(
>>>> +					(cell_data[0] >> 32) & GENMASK(31, 0));
>>>> +		}
>>>> +	}
>>>> +
>>>> +no_nvmem:
>>>> +
>>>>    	info->regmap = devm_regmap_init_mmio(&pdev->dev, base,
>>>>    					     &sun4i_gpadc_regmap_config);
>>>>    	if (IS_ERR(info->regmap)) {
>>>> diff --git a/include/linux/mfd/sun4i-gpadc.h
>> b/include/linux/mfd/sun4i-gpadc.h
>>>> index 40b4dd9d2405..c251002431bd 100644
>>>> --- a/include/linux/mfd/sun4i-gpadc.h
>>>> +++ b/include/linux/mfd/sun4i-gpadc.h
>>>> @@ -90,6 +90,8 @@
>>>>    #define SUNXI_THS_CTRL0					0x00
>>>>    #define SUNXI_THS_CTRL2					0x40
>>>>    #define SUNXI_THS_FILTER				0x70
>>>> +#define SUNXI_THS_CDATA_0_1				0x74
>>>> +#define SUNXI_THS_CDATA_2_3				0x78
>>>>    #define SUNXI_THS_TDATA0				0x80
>>>>    #define SUNXI_THS_TDATA1				0x84
>>>>    #define SUNXI_THS_TDATA2				0x88
>>>
>> Thanks,
>> Philipp
>>
>> _______________________________________________
>> linux-arm-kernel mailing list
>> linux-arm-kernel at lists.infradead.org
>> http://lists.infradead.org/mailman/listinfo/linux-arm-kernel



More information about the linux-arm-kernel mailing list