1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/module.h>
17#include <linux/kernel.h>
18#include <linux/init.h>
19#include <linux/err.h>
20#include <linux/hwmon.h>
21#include <linux/hwmon-sysfs.h>
22#include <linux/spi/spi.h>
23#include <linux/slab.h>
24
25#define MAX1111_TX_BUF_SIZE 1
26#define MAX1111_RX_BUF_SIZE 2
27
28
29#define MAX1111_CTRL_PD0 (1u << 0)
30#define MAX1111_CTRL_PD1 (1u << 1)
31#define MAX1111_CTRL_SGL (1u << 2)
32#define MAX1111_CTRL_UNI (1u << 3)
33#define MAX1111_CTRL_SEL_SH (5)
34#define MAX1111_CTRL_STR (1u << 7)
35
36struct 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
45};
46
47static int max1111_read(struct device *dev, int channel)
48{
49 struct max1111_data *data = dev_get_drvdata(dev);
50 uint8_t v1, v2;
51 int err;
52
53
54 mutex_lock(&data->drvdata_lock);
55
56 data->tx_buf[0] = (channel << MAX1111_CTRL_SEL_SH) |
57 MAX1111_CTRL_PD0 | MAX1111_CTRL_PD1 |
58 MAX1111_CTRL_SGL | MAX1111_CTRL_UNI | MAX1111_CTRL_STR;
59
60 err = spi_sync(data->spi, &data->msg);
61 if (err < 0) {
62 dev_err(dev, "spi_sync failed with %d\n", err);
63 mutex_unlock(&data->drvdata_lock);
64 return err;
65 }
66
67 v1 = data->rx_buf[0];
68 v2 = data->rx_buf[1];
69
70 mutex_unlock(&data->drvdata_lock);
71
72 if ((v1 & 0xc0) || (v2 & 0x3f))
73 return -EINVAL;
74
75 return (v1 << 2) | (v2 >> 6);
76}
77
78#ifdef CONFIG_SHARPSL_PM
79static struct max1111_data *the_max1111;
80
81int max1111_read_channel(int channel)
82{
83 return max1111_read(&the_max1111->spi->dev, channel);
84}
85EXPORT_SYMBOL(max1111_read_channel);
86#endif
87
88
89
90
91
92
93static ssize_t show_name(struct device *dev,
94 struct device_attribute *attr, char *buf)
95{
96 return sprintf(buf, "max1111\n");
97}
98
99static ssize_t show_adc(struct device *dev,
100 struct device_attribute *attr, char *buf)
101{
102 int channel = to_sensor_dev_attr(attr)->index;
103 int ret;
104
105 ret = max1111_read(dev, channel);
106 if (ret < 0)
107 return ret;
108
109 return sprintf(buf, "%d\n", ret);
110}
111
112#define MAX1111_ADC_ATTR(_id) \
113 SENSOR_DEVICE_ATTR(adc##_id##_in, S_IRUGO, show_adc, NULL, _id)
114
115static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
116static MAX1111_ADC_ATTR(0);
117static MAX1111_ADC_ATTR(1);
118static MAX1111_ADC_ATTR(2);
119static MAX1111_ADC_ATTR(3);
120
121static struct attribute *max1111_attributes[] = {
122 &dev_attr_name.attr,
123 &sensor_dev_attr_adc0_in.dev_attr.attr,
124 &sensor_dev_attr_adc1_in.dev_attr.attr,
125 &sensor_dev_attr_adc2_in.dev_attr.attr,
126 &sensor_dev_attr_adc3_in.dev_attr.attr,
127 NULL,
128};
129
130static const struct attribute_group max1111_attr_group = {
131 .attrs = max1111_attributes,
132};
133
134static int __devinit setup_transfer(struct max1111_data *data)
135{
136 struct spi_message *m;
137 struct spi_transfer *x;
138
139 m = &data->msg;
140 x = &data->xfer[0];
141
142 spi_message_init(m);
143
144 x->tx_buf = &data->tx_buf[0];
145 x->len = MAX1111_TX_BUF_SIZE;
146 spi_message_add_tail(x, m);
147
148 x++;
149 x->rx_buf = &data->rx_buf[0];
150 x->len = MAX1111_RX_BUF_SIZE;
151 spi_message_add_tail(x, m);
152
153 return 0;
154}
155
156static int __devinit max1111_probe(struct spi_device *spi)
157{
158 struct max1111_data *data;
159 int err;
160
161 spi->bits_per_word = 8;
162 spi->mode = SPI_MODE_0;
163 err = spi_setup(spi);
164 if (err < 0)
165 return err;
166
167 data = kzalloc(sizeof(struct max1111_data), GFP_KERNEL);
168 if (data == NULL) {
169 dev_err(&spi->dev, "failed to allocate memory\n");
170 return -ENOMEM;
171 }
172
173 err = setup_transfer(data);
174 if (err)
175 goto err_free_data;
176
177 mutex_init(&data->drvdata_lock);
178
179 data->spi = spi;
180 spi_set_drvdata(spi, data);
181
182 err = sysfs_create_group(&spi->dev.kobj, &max1111_attr_group);
183 if (err) {
184 dev_err(&spi->dev, "failed to create attribute group\n");
185 goto err_free_data;
186 }
187
188 data->hwmon_dev = hwmon_device_register(&spi->dev);
189 if (IS_ERR(data->hwmon_dev)) {
190 dev_err(&spi->dev, "failed to create hwmon device\n");
191 err = PTR_ERR(data->hwmon_dev);
192 goto err_remove;
193 }
194
195#ifdef CONFIG_SHARPSL_PM
196 the_max1111 = data;
197#endif
198 return 0;
199
200err_remove:
201 sysfs_remove_group(&spi->dev.kobj, &max1111_attr_group);
202err_free_data:
203 kfree(data);
204 return err;
205}
206
207static int __devexit max1111_remove(struct spi_device *spi)
208{
209 struct max1111_data *data = spi_get_drvdata(spi);
210
211 hwmon_device_unregister(data->hwmon_dev);
212 sysfs_remove_group(&spi->dev.kobj, &max1111_attr_group);
213 mutex_destroy(&data->drvdata_lock);
214 kfree(data);
215 return 0;
216}
217
218static struct spi_driver max1111_driver = {
219 .driver = {
220 .name = "max1111",
221 .owner = THIS_MODULE,
222 },
223 .probe = max1111_probe,
224 .remove = __devexit_p(max1111_remove),
225};
226
227static int __init max1111_init(void)
228{
229 return spi_register_driver(&max1111_driver);
230}
231module_init(max1111_init);
232
233static void __exit max1111_exit(void)
234{
235 spi_unregister_driver(&max1111_driver);
236}
237module_exit(max1111_exit);
238
239MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>");
240MODULE_DESCRIPTION("MAX1111 ADC Driver");
241MODULE_LICENSE("GPL");
242MODULE_ALIAS("spi:max1111");
243
