1 // SPDX-License-Identifier: GPL-2.0-only
5  * Copyright (C) 2009-2013 Texas Instruments Inc.
13  * Based on twl4030-madc.c
73  * struct twl6030_chnl_calib - channel calibration
85  * struct twl6030_ideal_code - GPADC calibration parameters
106  * struct twl6030_gpadc_platform_data - platform specific data
125  * struct twl6030_gpadc_data - GPADC data
151 	[0] = { /* ch 0, external, battery type, resistor value */
158 	[1] = { /* ch 1, external, battery temperature, NTC resistor value */
165 	[2] = { /* ch 2, external, audio accessory/general purpose */
172 	[3] = { /* ch 3, external, general purpose */
179 	[4] = { /* ch 4, external, temperature measurement/general purpose */
186 	[5] = { /* ch 5, external, general purpose */
193 	[6] = { /* ch 6, external, general purpose */
214 	[9] = { /* ch 9, internal, external charger input */
244 	[0] = { /* ch 0, external, battery type, resistor value */
251 	[1] = { /* ch 1, external, battery temperature, NTC resistor value */
258 	[2] = { /* ch 2, external, audio accessory/general purpose */
265 	[3] = { /* ch 3, external, temperature with external diode/general
273 	[4] = { /* ch 4, external, temperature measurement/general purpose */
280 	[5] = { /* ch 5, external, general purpose */
287 	[6] = { /* ch 6, external, general purpose */
308 	[9] = { /* ch 9, internal, external charger input */
322 	[11] = { /* ch 11, internal, VBUS DC-DC output current */
386 	complete(&gpadc->irq_complete);  in twl6030_gpadc_irq_handler()
439 	const struct twl6030_ideal_code *ideal = pdata->ideal;  in twl6030_channel_calibrated()
442 	i = twl6030_gpadc_lookup(ideal, channel, pdata->nchannels);  in twl6030_channel_calibrated()
444 	return pdata->ideal[i].code2;  in twl6030_channel_calibrated()
450 	const struct twl6030_ideal_code *ideal = gpadc->pdata->ideal;  in twl6030_gpadc_make_correction()
454 	i = twl6030_gpadc_lookup(ideal, channel, gpadc->pdata->nchannels);  in twl6030_gpadc_make_correction()
455 	corrected_code = ((raw_code * 1000) -  in twl6030_gpadc_make_correction()
456 		gpadc->twl6030_cal_tbl[i].offset_error) /  in twl6030_gpadc_make_correction()
457 		gpadc->twl6030_cal_tbl[i].gain_error;  in twl6030_gpadc_make_correction()
465 	u8 reg = gpadc->pdata->channel_to_reg(channel);  in twl6030_gpadc_get_raw()
472 		dev_dbg(gpadc->dev, "unable to read register 0x%X\n", reg);  in twl6030_gpadc_get_raw()
477 	dev_dbg(gpadc->dev, "GPADC raw code: %d", raw_code);  in twl6030_gpadc_get_raw()
479 	if (twl6030_channel_calibrated(gpadc->pdata, channel))  in twl6030_gpadc_get_raw()
490 	const struct twl6030_ideal_code *ideal = gpadc->pdata->ideal;  in twl6030_gpadc_get_processed()
500 	i = twl6030_gpadc_lookup(ideal, channel, gpadc->pdata->nchannels);  in twl6030_gpadc_get_processed()
502 			gpadc->twl6030_cal_tbl[i].gain;  in twl6030_gpadc_get_processed()
507 	dev_dbg(gpadc->dev, "GPADC corrected code: %d", corrected_code);  in twl6030_gpadc_get_processed()
508 	dev_dbg(gpadc->dev, "GPADC value: %d", channel_value);  in twl6030_gpadc_get_processed()
523 	mutex_lock(&gpadc->lock);  in twl6030_gpadc_read_raw()
525 	ret = gpadc->pdata->start_conversion(chan->channel);  in twl6030_gpadc_read_raw()
527 		dev_err(gpadc->dev, "failed to start conversion\n");  in twl6030_gpadc_read_raw()
532 				&gpadc->irq_complete, msecs_to_jiffies(5000));  in twl6030_gpadc_read_raw()
534 		ret = -ETIMEDOUT;  in twl6030_gpadc_read_raw()
537 		ret = -EINTR;  in twl6030_gpadc_read_raw()
543 		ret = twl6030_gpadc_get_raw(gpadc, chan->channel, val);  in twl6030_gpadc_read_raw()
544 		ret = ret ? -EIO : IIO_VAL_INT;  in twl6030_gpadc_read_raw()
548 		ret = twl6030_gpadc_get_processed(gpadc, chan->channel, val);  in twl6030_gpadc_read_raw()
549 		ret = ret ? -EIO : IIO_VAL_INT;  in twl6030_gpadc_read_raw()
556 	mutex_unlock(&gpadc->lock);  in twl6030_gpadc_read_raw()
569  * gain: k = 1 + ((d2 - d1) / (x2 - x1))
570  * offset: b = d1 + (k - 1) * x1
576 	const struct twl6030_ideal_code *ideal = gpadc->pdata->ideal;  in twl6030_calibrate_channel()
578 	i = twl6030_gpadc_lookup(ideal, channel, gpadc->pdata->nchannels);  in twl6030_calibrate_channel()
581 	gain = ((ideal[i].volt2 - ideal[i].volt1) * 1000) /  in twl6030_calibrate_channel()
582 		(ideal[i].code2 - ideal[i].code1);  in twl6030_calibrate_channel()
587 	/* k - real curve gain */  in twl6030_calibrate_channel()
588 	k = 1000 + (((d2 - d1) * 1000) / (x2 - x1));  in twl6030_calibrate_channel()
590 	/* b - offset of the real curve gain */  in twl6030_calibrate_channel()
591 	b = (d1 * 1000) - (k - 1000) * x1;  in twl6030_calibrate_channel()
593 	gpadc->twl6030_cal_tbl[i].gain = gain;  in twl6030_calibrate_channel()
594 	gpadc->twl6030_cal_tbl[i].gain_error = k;  in twl6030_calibrate_channel()
595 	gpadc->twl6030_cal_tbl[i].offset_error = b;  in twl6030_calibrate_channel()
597 	dev_dbg(gpadc->dev, "GPADC d1   for Chn: %d = %d\n", channel, d1);  in twl6030_calibrate_channel()
598 	dev_dbg(gpadc->dev, "GPADC d2   for Chn: %d = %d\n", channel, d2);  in twl6030_calibrate_channel()
599 	dev_dbg(gpadc->dev, "GPADC x1   for Chn: %d = %d\n", channel, x1);  in twl6030_calibrate_channel()
600 	dev_dbg(gpadc->dev, "GPADC x2   for Chn: %d = %d\n", channel, x2);  in twl6030_calibrate_channel()
601 	dev_dbg(gpadc->dev, "GPADC Gain for Chn: %d = %d\n", channel, gain);  in twl6030_calibrate_channel()
602 	dev_dbg(gpadc->dev, "GPADC k    for Chn: %d = %d\n", channel, k);  in twl6030_calibrate_channel()
603 	dev_dbg(gpadc->dev, "GPADC b    for Chn: %d = %d\n", channel, b);  in twl6030_calibrate_channel()
610 	 * bit 0 - sign, bit 7 - reserved, 6..1 - trim value  in twl6030_gpadc_get_trim_offset()
637 		dev_err(gpadc->dev, "calibration failed\n");  in twl6030_calibration()
702 		val = -val;  in twl6032_get_trim_value()
716 		dev_err(gpadc->dev, "calibration failed\n");  in twl6032_calibration()
778 				d1 = -d1;  in twl6032_calibration()
786 				d2 = -d2;  in twl6032_calibration()
866 		.compatible = "ti,twl6030-gpadc",
870 		.compatible = "ti,twl6032-gpadc",
879 	struct device *dev = &pdev->dev;  in twl6030_gpadc_probe()
889 		return -EINVAL;  in twl6030_gpadc_probe()
891 	pdata = match->data;  in twl6030_gpadc_probe()
895 		return -ENOMEM;  in twl6030_gpadc_probe()
899 	gpadc->twl6030_cal_tbl = devm_kcalloc(dev,  in twl6030_gpadc_probe()
900 					pdata->nchannels,  in twl6030_gpadc_probe()
901 					sizeof(*gpadc->twl6030_cal_tbl),  in twl6030_gpadc_probe()
903 	if (!gpadc->twl6030_cal_tbl)  in twl6030_gpadc_probe()
904 		return -ENOMEM;  in twl6030_gpadc_probe()
906 	gpadc->dev = dev;  in twl6030_gpadc_probe()
907 	gpadc->pdata = pdata;  in twl6030_gpadc_probe()
910 	mutex_init(&gpadc->lock);  in twl6030_gpadc_probe()
911 	init_completion(&gpadc->irq_complete);  in twl6030_gpadc_probe()
913 	ret = pdata->calibrate(gpadc);  in twl6030_gpadc_probe()
962 	indio_dev->name = DRIVER_NAME;  in twl6030_gpadc_probe()
963 	indio_dev->info = &twl6030_gpadc_iio_info;  in twl6030_gpadc_probe()
964 	indio_dev->modes = INDIO_DIRECT_MODE;  in twl6030_gpadc_probe()
965 	indio_dev->channels = pdata->iio_channels;  in twl6030_gpadc_probe()
966 	indio_dev->num_channels = pdata->nchannels;  in twl6030_gpadc_probe()