treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / hwmon / max1111.c
blob5fcfd57df61e12b15144a6100302fc7dfda56116
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * max1111.c - +2.7V, Low-Power, Multichannel, Serial 8-bit ADCs
5 * Based on arch/arm/mach-pxa/corgi_ssp.c
7 * Copyright (C) 2004-2005 Richard Purdie
9 * Copyright (C) 2008 Marvell International Ltd.
10 * Eric Miao <eric.miao@marvell.com>
13 #include <linux/module.h>
14 #include <linux/kernel.h>
15 #include <linux/init.h>
16 #include <linux/err.h>
17 #include <linux/hwmon.h>
18 #include <linux/hwmon-sysfs.h>
19 #include <linux/spi/spi.h>
20 #include <linux/slab.h>
22 enum chips { max1110, max1111, max1112, max1113 };
24 #define MAX1111_TX_BUF_SIZE 1
25 #define MAX1111_RX_BUF_SIZE 2
27 /* MAX1111 Commands */
28 #define MAX1111_CTRL_PD0 (1u << 0)
29 #define MAX1111_CTRL_PD1 (1u << 1)
30 #define MAX1111_CTRL_SGL (1u << 2)
31 #define MAX1111_CTRL_UNI (1u << 3)
32 #define MAX1110_CTRL_SEL_SH (4)
33 #define MAX1111_CTRL_SEL_SH (5) /* NOTE: bit 4 is ignored */
34 #define MAX1111_CTRL_STR (1u << 7)
36 struct max1111_data {
37 struct spi_device *spi;
38 struct device *hwmon_dev;
39 struct spi_message msg;
40 struct spi_transfer xfer[2];
41 uint8_t tx_buf[MAX1111_TX_BUF_SIZE];
42 uint8_t rx_buf[MAX1111_RX_BUF_SIZE];
43 struct mutex drvdata_lock;
44 /* protect msg, xfer and buffers from multiple access */
45 int sel_sh;
46 int lsb;
49 static int max1111_read(struct device *dev, int channel)
51 struct max1111_data *data = dev_get_drvdata(dev);
52 uint8_t v1, v2;
53 int err;
55 /* writing to drvdata struct is not thread safe, wait on mutex */
56 mutex_lock(&data->drvdata_lock);
58 data->tx_buf[0] = (channel << data->sel_sh) |
59 MAX1111_CTRL_PD0 | MAX1111_CTRL_PD1 |
60 MAX1111_CTRL_SGL | MAX1111_CTRL_UNI | MAX1111_CTRL_STR;
62 err = spi_sync(data->spi, &data->msg);
63 if (err < 0) {
64 dev_err(dev, "spi_sync failed with %d\n", err);
65 mutex_unlock(&data->drvdata_lock);
66 return err;
69 v1 = data->rx_buf[0];
70 v2 = data->rx_buf[1];
72 mutex_unlock(&data->drvdata_lock);
74 if ((v1 & 0xc0) || (v2 & 0x3f))
75 return -EINVAL;
77 return (v1 << 2) | (v2 >> 6);
80 #ifdef CONFIG_SHARPSL_PM
81 static struct max1111_data *the_max1111;
83 int max1111_read_channel(int channel)
85 if (!the_max1111 || !the_max1111->spi)
86 return -ENODEV;
88 return max1111_read(&the_max1111->spi->dev, channel);
90 EXPORT_SYMBOL(max1111_read_channel);
91 #endif
94 * NOTE: SPI devices do not have a default 'name' attribute, which is
95 * likely to be used by hwmon applications to distinguish between
96 * different devices, explicitly add a name attribute here.
98 static ssize_t name_show(struct device *dev,
99 struct device_attribute *attr, char *buf)
101 return sprintf(buf, "%s\n", to_spi_device(dev)->modalias);
104 static ssize_t show_adc(struct device *dev,
105 struct device_attribute *attr, char *buf)
107 struct max1111_data *data = dev_get_drvdata(dev);
108 int channel = to_sensor_dev_attr(attr)->index;
109 int ret;
111 ret = max1111_read(dev, channel);
112 if (ret < 0)
113 return ret;
116 * Assume the reference voltage to be 2.048V or 4.096V, with an 8-bit
117 * sample. The LSB weight is 8mV or 16mV depending on the chip type.
119 return sprintf(buf, "%d\n", ret * data->lsb);
122 #define MAX1111_ADC_ATTR(_id) \
123 SENSOR_DEVICE_ATTR(in##_id##_input, S_IRUGO, show_adc, NULL, _id)
125 static DEVICE_ATTR_RO(name);
126 static MAX1111_ADC_ATTR(0);
127 static MAX1111_ADC_ATTR(1);
128 static MAX1111_ADC_ATTR(2);
129 static MAX1111_ADC_ATTR(3);
130 static MAX1111_ADC_ATTR(4);
131 static MAX1111_ADC_ATTR(5);
132 static MAX1111_ADC_ATTR(6);
133 static MAX1111_ADC_ATTR(7);
135 static struct attribute *max1111_attributes[] = {
136 &dev_attr_name.attr,
137 &sensor_dev_attr_in0_input.dev_attr.attr,
138 &sensor_dev_attr_in1_input.dev_attr.attr,
139 &sensor_dev_attr_in2_input.dev_attr.attr,
140 &sensor_dev_attr_in3_input.dev_attr.attr,
141 NULL,
144 static const struct attribute_group max1111_attr_group = {
145 .attrs = max1111_attributes,
148 static struct attribute *max1110_attributes[] = {
149 &sensor_dev_attr_in4_input.dev_attr.attr,
150 &sensor_dev_attr_in5_input.dev_attr.attr,
151 &sensor_dev_attr_in6_input.dev_attr.attr,
152 &sensor_dev_attr_in7_input.dev_attr.attr,
153 NULL,
156 static const struct attribute_group max1110_attr_group = {
157 .attrs = max1110_attributes,
160 static int setup_transfer(struct max1111_data *data)
162 struct spi_message *m;
163 struct spi_transfer *x;
165 m = &data->msg;
166 x = &data->xfer[0];
168 spi_message_init(m);
170 x->tx_buf = &data->tx_buf[0];
171 x->len = MAX1111_TX_BUF_SIZE;
172 spi_message_add_tail(x, m);
174 x++;
175 x->rx_buf = &data->rx_buf[0];
176 x->len = MAX1111_RX_BUF_SIZE;
177 spi_message_add_tail(x, m);
179 return 0;
182 static int max1111_probe(struct spi_device *spi)
184 enum chips chip = spi_get_device_id(spi)->driver_data;
185 struct max1111_data *data;
186 int err;
188 spi->bits_per_word = 8;
189 spi->mode = SPI_MODE_0;
190 err = spi_setup(spi);
191 if (err < 0)
192 return err;
194 data = devm_kzalloc(&spi->dev, sizeof(struct max1111_data), GFP_KERNEL);
195 if (data == NULL)
196 return -ENOMEM;
198 switch (chip) {
199 case max1110:
200 data->lsb = 8;
201 data->sel_sh = MAX1110_CTRL_SEL_SH;
202 break;
203 case max1111:
204 data->lsb = 8;
205 data->sel_sh = MAX1111_CTRL_SEL_SH;
206 break;
207 case max1112:
208 data->lsb = 16;
209 data->sel_sh = MAX1110_CTRL_SEL_SH;
210 break;
211 case max1113:
212 data->lsb = 16;
213 data->sel_sh = MAX1111_CTRL_SEL_SH;
214 break;
216 err = setup_transfer(data);
217 if (err)
218 return err;
220 mutex_init(&data->drvdata_lock);
222 data->spi = spi;
223 spi_set_drvdata(spi, data);
225 err = sysfs_create_group(&spi->dev.kobj, &max1111_attr_group);
226 if (err) {
227 dev_err(&spi->dev, "failed to create attribute group\n");
228 return err;
230 if (chip == max1110 || chip == max1112) {
231 err = sysfs_create_group(&spi->dev.kobj, &max1110_attr_group);
232 if (err) {
233 dev_err(&spi->dev,
234 "failed to create extended attribute group\n");
235 goto err_remove;
239 data->hwmon_dev = hwmon_device_register(&spi->dev);
240 if (IS_ERR(data->hwmon_dev)) {
241 dev_err(&spi->dev, "failed to create hwmon device\n");
242 err = PTR_ERR(data->hwmon_dev);
243 goto err_remove;
246 #ifdef CONFIG_SHARPSL_PM
247 the_max1111 = data;
248 #endif
249 return 0;
251 err_remove:
252 sysfs_remove_group(&spi->dev.kobj, &max1110_attr_group);
253 sysfs_remove_group(&spi->dev.kobj, &max1111_attr_group);
254 return err;
257 static int max1111_remove(struct spi_device *spi)
259 struct max1111_data *data = spi_get_drvdata(spi);
261 #ifdef CONFIG_SHARPSL_PM
262 the_max1111 = NULL;
263 #endif
264 hwmon_device_unregister(data->hwmon_dev);
265 sysfs_remove_group(&spi->dev.kobj, &max1110_attr_group);
266 sysfs_remove_group(&spi->dev.kobj, &max1111_attr_group);
267 mutex_destroy(&data->drvdata_lock);
268 return 0;
271 static const struct spi_device_id max1111_ids[] = {
272 { "max1110", max1110 },
273 { "max1111", max1111 },
274 { "max1112", max1112 },
275 { "max1113", max1113 },
276 { },
278 MODULE_DEVICE_TABLE(spi, max1111_ids);
280 static struct spi_driver max1111_driver = {
281 .driver = {
282 .name = "max1111",
284 .id_table = max1111_ids,
285 .probe = max1111_probe,
286 .remove = max1111_remove,
289 module_spi_driver(max1111_driver);
291 MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>");
292 MODULE_DESCRIPTION("MAX1110/MAX1111/MAX1112/MAX1113 ADC Driver");
293 MODULE_LICENSE("GPL");