[linux-2.6-block.git] / drivers / hwmon / mc13783-adc.c

// SPDX-License-Identifier: GPL-2.0+
/*
 * Driver for the ADC on Freescale Semiconductor MC13783 and MC13892 PMICs.
 *
 * Copyright 2004-2007 Freescale Semiconductor, Inc. All Rights Reserved.
 * Copyright (C) 2009 Sascha Hauer, Pengutronix
 */

#include <linux/mfd/mc13xxx.h>
#include <linux/platform_device.h>
#include <linux/hwmon-sysfs.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/mod_devicetable.h>
#include <linux/hwmon.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/err.h>

#define DRIVER_NAME	"mc13783-adc"

/* platform device id driver data */
#define MC13783_ADC_16CHANS	1
#define MC13783_ADC_BPDIV2	2

struct mc13783_adc_priv {
	struct mc13xxx *mc13xxx;
	struct device *hwmon_dev;
	char name[PLATFORM_NAME_SIZE];
};

static ssize_t name_show(struct device *dev, struct device_attribute *devattr,
			 char *buf)
{
	struct mc13783_adc_priv *priv = dev_get_drvdata(dev);

	return sprintf(buf, "%s\n", priv->name);
}

static int mc13783_adc_read(struct device *dev,
		struct device_attribute *devattr, unsigned int *val)
{
	struct mc13783_adc_priv *priv = dev_get_drvdata(dev);
	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	unsigned int channel = attr->index;
	unsigned int sample[4];
	int ret;

	ret = mc13xxx_adc_do_conversion(priv->mc13xxx,
			MC13XXX_ADC_MODE_MULT_CHAN,
			channel, 0, 0, sample);
	if (ret)
		return ret;

	/* ADIN7 subchannels */
	if (channel >= 16)
		channel = 7;

	channel &= 0x7;

	*val = (sample[channel % 4] >> (channel > 3 ? 14 : 2)) & 0x3ff;

	return 0;
}

static ssize_t mc13783_adc_read_bp(struct device *dev,
		struct device_attribute *devattr, char *buf)
{
	unsigned val;
	struct platform_device *pdev = to_platform_device(dev);
	kernel_ulong_t driver_data = platform_get_device_id(pdev)->driver_data;
	int ret = mc13783_adc_read(dev, devattr, &val);

	if (ret)
		return ret;

	if (driver_data & MC13783_ADC_BPDIV2)
		val = DIV_ROUND_CLOSEST(val * 9, 2);
	else
		/*
		 * BP (channel 2) reports with offset 2.4V to the actual value
		 * to fit the input range of the ADC.  unit = 2.25mV = 9/4 mV.
		 */
		val = DIV_ROUND_CLOSEST(val * 9, 4) + 2400;

	return sprintf(buf, "%u\n", val);
}

static ssize_t mc13783_adc_read_gp(struct device *dev,
		struct device_attribute *devattr, char *buf)
{
	unsigned val;
	int ret = mc13783_adc_read(dev, devattr, &val);

	if (ret)
		return ret;

	/*
	 * input range is [0, 2.3V], val has 10 bits, so each bit
	 * is worth 9/4 mV.
	 */
	val = DIV_ROUND_CLOSEST(val * 9, 4);

	return sprintf(buf, "%u\n", val);
}

static ssize_t mc13783_adc_read_uid(struct device *dev,
		struct device_attribute *devattr, char *buf)
{
	unsigned int val;
	struct platform_device *pdev = to_platform_device(dev);
	kernel_ulong_t driver_data = platform_get_device_id(pdev)->driver_data;
	int ret = mc13783_adc_read(dev, devattr, &val);

	if (ret)
		return ret;

	if (driver_data & MC13783_ADC_BPDIV2)
		/* MC13892 have 1/2 divider, input range is [0, 4.800V] */
		val = DIV_ROUND_CLOSEST(val * 4800, 1024);
	else
		/* MC13783 have 0.9 divider, input range is [0, 2.555V] */
		val = DIV_ROUND_CLOSEST(val * 2555, 1024);

	return sprintf(buf, "%u\n", val);
}

static ssize_t mc13783_adc_read_temp(struct device *dev,
		struct device_attribute *devattr, char *buf)
{
	unsigned int val;
	struct platform_device *pdev = to_platform_device(dev);
	kernel_ulong_t driver_data = platform_get_device_id(pdev)->driver_data;
	int ret = mc13783_adc_read(dev, devattr, &val);

	if (ret)
		return ret;

	if (driver_data & MC13783_ADC_BPDIV2) {
		/*
		 * MC13892:
		 * Die Temperature Read Out Code at 25C 680
		 * Temperature change per LSB +0.4244C
		 */
		ret = DIV_ROUND_CLOSEST(-2635920 + val * 4244, 10);
	} else {
		/*
		 * MC13783:
		 * Die Temperature Read Out Code at 25C 282
		 * Temperature change per LSB -1.14C
		 */
		ret = 346480 - 1140 * val;
	}

	return sprintf(buf, "%d\n", ret);
}

static DEVICE_ATTR_RO(name);
static SENSOR_DEVICE_ATTR(in2_input, S_IRUGO, mc13783_adc_read_bp, NULL, 2);
static SENSOR_DEVICE_ATTR(in5_input, S_IRUGO, mc13783_adc_read_gp, NULL, 5);
static SENSOR_DEVICE_ATTR(in6_input, S_IRUGO, mc13783_adc_read_gp, NULL, 6);
static SENSOR_DEVICE_ATTR(in7_input, S_IRUGO, mc13783_adc_read_gp, NULL, 7);
static SENSOR_DEVICE_ATTR(in8_input, S_IRUGO, mc13783_adc_read_gp, NULL, 8);
static SENSOR_DEVICE_ATTR(in9_input, S_IRUGO, mc13783_adc_read_gp, NULL, 9);
static SENSOR_DEVICE_ATTR(in10_input, S_IRUGO, mc13783_adc_read_gp, NULL, 10);
static SENSOR_DEVICE_ATTR(in11_input, S_IRUGO, mc13783_adc_read_gp, NULL, 11);
static SENSOR_DEVICE_ATTR(in12_input, S_IRUGO, mc13783_adc_read_gp, NULL, 12);
static SENSOR_DEVICE_ATTR(in13_input, S_IRUGO, mc13783_adc_read_gp, NULL, 13);
static SENSOR_DEVICE_ATTR(in14_input, S_IRUGO, mc13783_adc_read_gp, NULL, 14);
static SENSOR_DEVICE_ATTR(in15_input, S_IRUGO, mc13783_adc_read_gp, NULL, 15);
static SENSOR_DEVICE_ATTR(in16_input, S_IRUGO, mc13783_adc_read_uid, NULL, 16);
static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO,
			  mc13783_adc_read_temp, NULL, 17);

static struct attribute *mc13783_attr_base[] = {
	&dev_attr_name.attr,
	&sensor_dev_attr_in2_input.dev_attr.attr,
	&sensor_dev_attr_in5_input.dev_attr.attr,
	&sensor_dev_attr_in6_input.dev_attr.attr,
	&sensor_dev_attr_in7_input.dev_attr.attr,
	&sensor_dev_attr_in16_input.dev_attr.attr,
	&sensor_dev_attr_temp1_input.dev_attr.attr,
	NULL
};

static const struct attribute_group mc13783_group_base = {
	.attrs = mc13783_attr_base,
};

/* these are only used if MC13783_ADC_16CHANS is provided in driver data */
static struct attribute *mc13783_attr_16chans[] = {
	&sensor_dev_attr_in8_input.dev_attr.attr,
	&sensor_dev_attr_in9_input.dev_attr.attr,
	&sensor_dev_attr_in10_input.dev_attr.attr,
	&sensor_dev_attr_in11_input.dev_attr.attr,
	NULL
};

static const struct attribute_group mc13783_group_16chans = {
	.attrs = mc13783_attr_16chans,
};

/* last four channels may be occupied by the touchscreen */
static struct attribute *mc13783_attr_ts[] = {
	&sensor_dev_attr_in12_input.dev_attr.attr,
	&sensor_dev_attr_in13_input.dev_attr.attr,
	&sensor_dev_attr_in14_input.dev_attr.attr,
	&sensor_dev_attr_in15_input.dev_attr.attr,
	NULL
};

static const struct attribute_group mc13783_group_ts = {
	.attrs = mc13783_attr_ts,
};

static int mc13783_adc_use_touchscreen(struct platform_device *pdev)
{
	struct mc13783_adc_priv *priv = platform_get_drvdata(pdev);
	unsigned flags = mc13xxx_get_flags(priv->mc13xxx);

	return flags & MC13XXX_USE_TOUCHSCREEN;
}

static int __init mc13783_adc_probe(struct platform_device *pdev)
{
	struct mc13783_adc_priv *priv;
	int ret;
	const struct platform_device_id *id = platform_get_device_id(pdev);
	char *dash;

	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	priv->mc13xxx = dev_get_drvdata(pdev->dev.parent);
	snprintf(priv->name, ARRAY_SIZE(priv->name), "%s", id->name);
	dash = strchr(priv->name, '-');
	if (dash)
		*dash = '\0';

	platform_set_drvdata(pdev, priv);

	/* Register sysfs hooks */
	ret = sysfs_create_group(&pdev->dev.kobj, &mc13783_group_base);
	if (ret)
		return ret;

	if (id->driver_data & MC13783_ADC_16CHANS) {
		ret = sysfs_create_group(&pdev->dev.kobj,
				&mc13783_group_16chans);
		if (ret)
			goto out_err_create_16chans;
	}

	if (!mc13783_adc_use_touchscreen(pdev)) {
		ret = sysfs_create_group(&pdev->dev.kobj, &mc13783_group_ts);
		if (ret)
			goto out_err_create_ts;
	}

	priv->hwmon_dev = hwmon_device_register(&pdev->dev);
	if (IS_ERR(priv->hwmon_dev)) {
		ret = PTR_ERR(priv->hwmon_dev);
		dev_err(&pdev->dev,
				"hwmon_device_register failed with %d.\n", ret);
		goto out_err_register;
	}

	return 0;

out_err_register:

	if (!mc13783_adc_use_touchscreen(pdev))
		sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_ts);
out_err_create_ts:

	if (id->driver_data & MC13783_ADC_16CHANS)
		sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_16chans);
out_err_create_16chans:

	sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_base);
	return ret;
}

static int mc13783_adc_remove(struct platform_device *pdev)
{
	struct mc13783_adc_priv *priv = platform_get_drvdata(pdev);
	kernel_ulong_t driver_data = platform_get_device_id(pdev)->driver_data;

	hwmon_device_unregister(priv->hwmon_dev);

	if (!mc13783_adc_use_touchscreen(pdev))
		sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_ts);

	if (driver_data & MC13783_ADC_16CHANS)
		sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_16chans);

	sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_base);

	return 0;
}

static const struct platform_device_id mc13783_adc_idtable[] = {
	{
		.name = "mc13783-adc",
		.driver_data = MC13783_ADC_16CHANS,
	}, {
		.name = "mc13892-adc",
		.driver_data = MC13783_ADC_BPDIV2,
	}, {
		/* sentinel */
	}
};
MODULE_DEVICE_TABLE(platform, mc13783_adc_idtable);

static struct platform_driver mc13783_adc_driver = {
	.remove		= mc13783_adc_remove,
	.driver		= {
		.name	= DRIVER_NAME,
	},
	.id_table	= mc13783_adc_idtable,
};

module_platform_driver_probe(mc13783_adc_driver, mc13783_adc_probe);

MODULE_DESCRIPTION("MC13783 ADC driver");
MODULE_AUTHOR("Luotao Fu <l.fu@pengutronix.de>");
MODULE_LICENSE("GPL");
Commit	Line	Data
9450f52c	1	// SPDX-License-Identifier: GPL-2.0+
93ee0a75	2	/*
0c273215	3	* Driver for the ADC on Freescale Semiconductor MC13783 and MC13892 PMICs.
93ee0a75 LF	4	*
	5	* Copyright 2004-2007 Freescale Semiconductor, Inc. All Rights Reserved.
	6	* Copyright (C) 2009 Sascha Hauer, Pengutronix
93ee0a75 LF	7	*/
93ee0a75 LF	8
0c273215	9	#include <linux/mfd/mc13xxx.h>
93ee0a75 LF	10	#include <linux/platform_device.h>
	11	#include <linux/hwmon-sysfs.h>
	12	#include <linux/kernel.h>
	13	#include <linux/module.h>
ac316725	14	#include <linux/mod_devicetable.h>
93ee0a75	15	#include <linux/hwmon.h>
5a0e3ad6	16	#include <linux/slab.h>
93ee0a75 LF	17	#include <linux/init.h>
	18	#include <linux/err.h>
	19
0c273215 UKK	20	#define DRIVER_NAME "mc13783-adc"
	21
	22	/* platform device id driver data */
	23	#define MC13783_ADC_16CHANS 1
	24	#define MC13783_ADC_BPDIV2 2
93ee0a75 LF	25
93ee0a75 LF	26	struct mc13783_adc_priv {
613c27ab	27	struct mc13xxx *mc13xxx;
93ee0a75	28	struct device *hwmon_dev;
ae02e741	29	char name[PLATFORM_NAME_SIZE];
93ee0a75 LF	30	};
93ee0a75 LF	31
918b4056 JL	32	static ssize_t name_show(struct device dev, struct device_attribute devattr,
918b4056 JL	33	char *buf)
93ee0a75	34	{
0c273215 UKK	35	struct mc13783_adc_priv *priv = dev_get_drvdata(dev);
	36
	37	return sprintf(buf, "%s\n", priv->name);
93ee0a75 LF	38	}
	39
	40	static int mc13783_adc_read(struct device *dev,
	41	struct device_attribute devattr, unsigned int val)
	42	{
0c273215	43	struct mc13783_adc_priv *priv = dev_get_drvdata(dev);
93ee0a75 LF	44	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	45	unsigned int channel = attr->index;
	46	unsigned int sample[4];
	47	int ret;
	48
613c27ab UKK	49	ret = mc13xxx_adc_do_conversion(priv->mc13xxx,
613c27ab UKK	50	MC13XXX_ADC_MODE_MULT_CHAN,
1039d762	51	channel, 0, 0, sample);
93ee0a75 LF	52	if (ret)
	53	return ret;
	54
ed645ccc AG	55	/* ADIN7 subchannels */
	56	if (channel >= 16)
	57	channel = 7;
	58
93ee0a75 LF	59	channel &= 0x7;
	60
	61	*val = (sample[channel % 4] >> (channel > 3 ? 14 : 2)) & 0x3ff;
	62
	63	return 0;
	64	}
	65
	66	static ssize_t mc13783_adc_read_bp(struct device *dev,
	67	struct device_attribute devattr, char buf)
	68	{
	69	unsigned val;
0c273215 UKK	70	struct platform_device *pdev = to_platform_device(dev);
0c273215 UKK	71	kernel_ulong_t driver_data = platform_get_device_id(pdev)->driver_data;
93ee0a75 LF	72	int ret = mc13783_adc_read(dev, devattr, &val);
	73
	74	if (ret)
	75	return ret;
	76
0c273215 UKK	77	if (driver_data & MC13783_ADC_BPDIV2)
	78	val = DIV_ROUND_CLOSEST(val * 9, 2);
	79	else
	80	/*
	81	* BP (channel 2) reports with offset 2.4V to the actual value
	82	* to fit the input range of the ADC. unit = 2.25mV = 9/4 mV.
	83	*/
	84	val = DIV_ROUND_CLOSEST(val * 9, 4) + 2400;
93ee0a75 LF	85
	86	return sprintf(buf, "%u\n", val);
	87	}
	88
	89	static ssize_t mc13783_adc_read_gp(struct device *dev,
	90	struct device_attribute devattr, char buf)
	91	{
	92	unsigned val;
	93	int ret = mc13783_adc_read(dev, devattr, &val);
	94
	95	if (ret)
	96	return ret;
	97
	98	/*
	99	* input range is [0, 2.3V], val has 10 bits, so each bit
	100	* is worth 9/4 mV.
	101	*/
	102	val = DIV_ROUND_CLOSEST(val * 9, 4);
	103
	104	return sprintf(buf, "%u\n", val);
	105	}
	106
ed645ccc AG	107	static ssize_t mc13783_adc_read_uid(struct device *dev,
	108	struct device_attribute devattr, char buf)
	109	{
	110	unsigned int val;
	111	struct platform_device *pdev = to_platform_device(dev);
	112	kernel_ulong_t driver_data = platform_get_device_id(pdev)->driver_data;
	113	int ret = mc13783_adc_read(dev, devattr, &val);
	114
	115	if (ret)
	116	return ret;
	117
	118	if (driver_data & MC13783_ADC_BPDIV2)
	119	/* MC13892 have 1/2 divider, input range is [0, 4.800V] */
	120	val = DIV_ROUND_CLOSEST(val * 4800, 1024);
	121	else
	122	/* MC13783 have 0.9 divider, input range is [0, 2.555V] */
	123	val = DIV_ROUND_CLOSEST(val * 2555, 1024);
	124
	125	return sprintf(buf, "%u\n", val);
	126	}
	127
	128	static ssize_t mc13783_adc_read_temp(struct device *dev,
	129	struct device_attribute devattr, char buf)
	130	{
	131	unsigned int val;
	132	struct platform_device *pdev = to_platform_device(dev);
	133	kernel_ulong_t driver_data = platform_get_device_id(pdev)->driver_data;
	134	int ret = mc13783_adc_read(dev, devattr, &val);
	135
	136	if (ret)
	137	return ret;
	138
	139	if (driver_data & MC13783_ADC_BPDIV2) {
	140	/*
	141	* MC13892:
	142	* Die Temperature Read Out Code at 25C 680
	143	* Temperature change per LSB +0.4244C
	144	*/
	145	ret = DIV_ROUND_CLOSEST(-2635920 + val * 4244, 10);
	146	} else {
	147	/*
	148	* MC13783:
	149	* Die Temperature Read Out Code at 25C 282
	150	* Temperature change per LSB -1.14C
	151	*/
	152	ret = 346480 - 1140 * val;
	153	}
	154
	155	return sprintf(buf, "%d\n", ret);
	156	}
	157
918b4056	158	static DEVICE_ATTR_RO(name);
93ee0a75 LF	159	static SENSOR_DEVICE_ATTR(in2_input, S_IRUGO, mc13783_adc_read_bp, NULL, 2);
	160	static SENSOR_DEVICE_ATTR(in5_input, S_IRUGO, mc13783_adc_read_gp, NULL, 5);
	161	static SENSOR_DEVICE_ATTR(in6_input, S_IRUGO, mc13783_adc_read_gp, NULL, 6);
	162	static SENSOR_DEVICE_ATTR(in7_input, S_IRUGO, mc13783_adc_read_gp, NULL, 7);
	163	static SENSOR_DEVICE_ATTR(in8_input, S_IRUGO, mc13783_adc_read_gp, NULL, 8);
	164	static SENSOR_DEVICE_ATTR(in9_input, S_IRUGO, mc13783_adc_read_gp, NULL, 9);
	165	static SENSOR_DEVICE_ATTR(in10_input, S_IRUGO, mc13783_adc_read_gp, NULL, 10);
	166	static SENSOR_DEVICE_ATTR(in11_input, S_IRUGO, mc13783_adc_read_gp, NULL, 11);
	167	static SENSOR_DEVICE_ATTR(in12_input, S_IRUGO, mc13783_adc_read_gp, NULL, 12);
	168	static SENSOR_DEVICE_ATTR(in13_input, S_IRUGO, mc13783_adc_read_gp, NULL, 13);
	169	static SENSOR_DEVICE_ATTR(in14_input, S_IRUGO, mc13783_adc_read_gp, NULL, 14);
	170	static SENSOR_DEVICE_ATTR(in15_input, S_IRUGO, mc13783_adc_read_gp, NULL, 15);
ed645ccc AG	171	static SENSOR_DEVICE_ATTR(in16_input, S_IRUGO, mc13783_adc_read_uid, NULL, 16);
	172	static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO,
	173	mc13783_adc_read_temp, NULL, 17);
93ee0a75	174
0c273215	175	static struct attribute *mc13783_attr_base[] = {
93ee0a75 LF	176	&dev_attr_name.attr,
	177	&sensor_dev_attr_in2_input.dev_attr.attr,
	178	&sensor_dev_attr_in5_input.dev_attr.attr,
	179	&sensor_dev_attr_in6_input.dev_attr.attr,
	180	&sensor_dev_attr_in7_input.dev_attr.attr,
ed645ccc AG	181	&sensor_dev_attr_in16_input.dev_attr.attr,
ed645ccc AG	182	&sensor_dev_attr_temp1_input.dev_attr.attr,
0c273215 UKK	183	NULL
	184	};
	185
	186	static const struct attribute_group mc13783_group_base = {
	187	.attrs = mc13783_attr_base,
	188	};
	189
	190	/* these are only used if MC13783_ADC_16CHANS is provided in driver data */
	191	static struct attribute *mc13783_attr_16chans[] = {
93ee0a75 LF	192	&sensor_dev_attr_in8_input.dev_attr.attr,
	193	&sensor_dev_attr_in9_input.dev_attr.attr,
	194	&sensor_dev_attr_in10_input.dev_attr.attr,
	195	&sensor_dev_attr_in11_input.dev_attr.attr,
	196	NULL
	197	};
	198
0c273215 UKK	199	static const struct attribute_group mc13783_group_16chans = {
0c273215 UKK	200	.attrs = mc13783_attr_16chans,
93ee0a75 LF	201	};
	202
	203	/* last four channels may be occupied by the touchscreen */
	204	static struct attribute *mc13783_attr_ts[] = {
	205	&sensor_dev_attr_in12_input.dev_attr.attr,
	206	&sensor_dev_attr_in13_input.dev_attr.attr,
	207	&sensor_dev_attr_in14_input.dev_attr.attr,
	208	&sensor_dev_attr_in15_input.dev_attr.attr,
	209	NULL
	210	};
	211
	212	static const struct attribute_group mc13783_group_ts = {
	213	.attrs = mc13783_attr_ts,
	214	};
	215
eaf06ee2 UKK	216	static int mc13783_adc_use_touchscreen(struct platform_device *pdev)
	217	{
	218	struct mc13783_adc_priv *priv = platform_get_drvdata(pdev);
613c27ab	219	unsigned flags = mc13xxx_get_flags(priv->mc13xxx);
eaf06ee2	220
613c27ab	221	return flags & MC13XXX_USE_TOUCHSCREEN;
eaf06ee2 UKK	222	}
eaf06ee2 UKK	223
93ee0a75 LF	224	static int __init mc13783_adc_probe(struct platform_device *pdev)
	225	{
	226	struct mc13783_adc_priv *priv;
	227	int ret;
0c273215 UKK	228	const struct platform_device_id *id = platform_get_device_id(pdev);
0c273215 UKK	229	char *dash;
93ee0a75	230
ed2e073b	231	priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
93ee0a75 LF	232	if (!priv)
	233	return -ENOMEM;
	234
613c27ab	235	priv->mc13xxx = dev_get_drvdata(pdev->dev.parent);
0c273215 UKK	236	snprintf(priv->name, ARRAY_SIZE(priv->name), "%s", id->name);
	237	dash = strchr(priv->name, '-');
	238	if (dash)
	239	*dash = '\0';
93ee0a75 LF	240
	241	platform_set_drvdata(pdev, priv);
	242
	243	/* Register sysfs hooks */
0c273215	244	ret = sysfs_create_group(&pdev->dev.kobj, &mc13783_group_base);
93ee0a75	245	if (ret)
ed2e073b	246	return ret;
0c273215 UKK	247
	248	if (id->driver_data & MC13783_ADC_16CHANS) {
	249	ret = sysfs_create_group(&pdev->dev.kobj,
	250	&mc13783_group_16chans);
	251	if (ret)
	252	goto out_err_create_16chans;
	253	}
93ee0a75	254
eaf06ee2	255	if (!mc13783_adc_use_touchscreen(pdev)) {
93ee0a75 LF	256	ret = sysfs_create_group(&pdev->dev.kobj, &mc13783_group_ts);
93ee0a75 LF	257	if (ret)
0c273215	258	goto out_err_create_ts;
eaf06ee2	259	}
93ee0a75 LF	260
	261	priv->hwmon_dev = hwmon_device_register(&pdev->dev);
	262	if (IS_ERR(priv->hwmon_dev)) {
	263	ret = PTR_ERR(priv->hwmon_dev);
	264	dev_err(&pdev->dev,
	265	"hwmon_device_register failed with %d.\n", ret);
	266	goto out_err_register;
	267	}
	268
93ee0a75 LF	269	return 0;
	270
	271	out_err_register:
	272
eaf06ee2	273	if (!mc13783_adc_use_touchscreen(pdev))
93ee0a75	274	sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_ts);
0c273215	275	out_err_create_ts:
93ee0a75	276
0c273215 UKK	277	if (id->driver_data & MC13783_ADC_16CHANS)
	278	sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_16chans);
	279	out_err_create_16chans:
	280
	281	sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_base);
93ee0a75 LF	282	return ret;
	283	}
	284
281dfd0b	285	static int mc13783_adc_remove(struct platform_device *pdev)
93ee0a75 LF	286	{
93ee0a75 LF	287	struct mc13783_adc_priv *priv = platform_get_drvdata(pdev);
0c273215	288	kernel_ulong_t driver_data = platform_get_device_id(pdev)->driver_data;
93ee0a75 LF	289
	290	hwmon_device_unregister(priv->hwmon_dev);
	291
eaf06ee2	292	if (!mc13783_adc_use_touchscreen(pdev))
93ee0a75 LF	293	sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_ts);
93ee0a75 LF	294
0c273215 UKK	295	if (driver_data & MC13783_ADC_16CHANS)
	296	sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_16chans);
	297
	298	sysfs_remove_group(&pdev->dev.kobj, &mc13783_group_base);
93ee0a75	299
93ee0a75 LF	300	return 0;
	301	}
	302
0c273215 UKK	303	static const struct platform_device_id mc13783_adc_idtable[] = {
	304	{
	305	.name = "mc13783-adc",
	306	.driver_data = MC13783_ADC_16CHANS,
	307	}, {
	308	.name = "mc13892-adc",
	309	.driver_data = MC13783_ADC_BPDIV2,
	310	}, {
	311	/* sentinel */
	312	}
	313	};
	314	MODULE_DEVICE_TABLE(platform, mc13783_adc_idtable);
	315
93ee0a75	316	static struct platform_driver mc13783_adc_driver = {
9e5e9b7a	317	.remove = mc13783_adc_remove,
93ee0a75	318	.driver = {
0c273215	319	.name = DRIVER_NAME,
93ee0a75	320	},
0c273215	321	.id_table = mc13783_adc_idtable,
93ee0a75 LF	322	};
93ee0a75 LF	323
f40fb63e	324	module_platform_driver_probe(mc13783_adc_driver, mc13783_adc_probe);
93ee0a75 LF	325
	326	MODULE_DESCRIPTION("MC13783 ADC driver");
	327	MODULE_AUTHOR("Luotao Fu <l.fu@pengutronix.de>");
	328	MODULE_LICENSE("GPL");