Root/
1 | /* |
2 | * HWMON Driver for Dialog DA9055 |
3 | * |
4 | * Copyright(c) 2012 Dialog Semiconductor Ltd. |
5 | * |
6 | * Author: David Dajun Chen <dchen@diasemi.com> |
7 | * |
8 | * This program is free software; you can redistribute it and/or modify it |
9 | * under the terms of the GNU General Public License as published by the |
10 | * Free Software Foundation; either version 2 of the License, or (at your |
11 | * option) any later version. |
12 | * |
13 | */ |
14 | |
15 | #include <linux/delay.h> |
16 | #include <linux/err.h> |
17 | #include <linux/hwmon.h> |
18 | #include <linux/hwmon-sysfs.h> |
19 | #include <linux/init.h> |
20 | #include <linux/kernel.h> |
21 | #include <linux/module.h> |
22 | #include <linux/platform_device.h> |
23 | #include <linux/completion.h> |
24 | |
25 | #include <linux/mfd/da9055/core.h> |
26 | #include <linux/mfd/da9055/reg.h> |
27 | |
28 | #define DA9055_ADCIN_DIV 102 |
29 | #define DA9055_VSYS_DIV 85 |
30 | |
31 | #define DA9055_ADC_VSYS 0 |
32 | #define DA9055_ADC_ADCIN1 1 |
33 | #define DA9055_ADC_ADCIN2 2 |
34 | #define DA9055_ADC_ADCIN3 3 |
35 | #define DA9055_ADC_TJUNC 4 |
36 | |
37 | struct da9055_hwmon { |
38 | struct da9055 *da9055; |
39 | struct device *class_device; |
40 | struct mutex hwmon_lock; |
41 | struct mutex irq_lock; |
42 | struct completion done; |
43 | }; |
44 | |
45 | static const char * const input_names[] = { |
46 | [DA9055_ADC_VSYS] = "VSYS", |
47 | [DA9055_ADC_ADCIN1] = "ADC IN1", |
48 | [DA9055_ADC_ADCIN2] = "ADC IN2", |
49 | [DA9055_ADC_ADCIN3] = "ADC IN3", |
50 | [DA9055_ADC_TJUNC] = "CHIP TEMP", |
51 | }; |
52 | |
53 | static const u8 chan_mux[DA9055_ADC_TJUNC + 1] = { |
54 | [DA9055_ADC_VSYS] = DA9055_ADC_MUX_VSYS, |
55 | [DA9055_ADC_ADCIN1] = DA9055_ADC_MUX_ADCIN1, |
56 | [DA9055_ADC_ADCIN2] = DA9055_ADC_MUX_ADCIN2, |
57 | [DA9055_ADC_ADCIN3] = DA9055_ADC_MUX_ADCIN3, |
58 | [DA9055_ADC_TJUNC] = DA9055_ADC_MUX_T_SENSE, |
59 | }; |
60 | |
61 | static int da9055_adc_manual_read(struct da9055_hwmon *hwmon, |
62 | unsigned char channel) |
63 | { |
64 | int ret; |
65 | unsigned short calc_data; |
66 | unsigned short data; |
67 | unsigned char mux_sel; |
68 | struct da9055 *da9055 = hwmon->da9055; |
69 | |
70 | if (channel > DA9055_ADC_TJUNC) |
71 | return -EINVAL; |
72 | |
73 | mutex_lock(&hwmon->irq_lock); |
74 | |
75 | /* Selects desired MUX for manual conversion */ |
76 | mux_sel = chan_mux[channel] | DA9055_ADC_MAN_CONV; |
77 | |
78 | ret = da9055_reg_write(da9055, DA9055_REG_ADC_MAN, mux_sel); |
79 | if (ret < 0) |
80 | goto err; |
81 | |
82 | /* Wait for an interrupt */ |
83 | if (!wait_for_completion_timeout(&hwmon->done, |
84 | msecs_to_jiffies(500))) { |
85 | dev_err(da9055->dev, |
86 | "timeout waiting for ADC conversion interrupt\n"); |
87 | ret = -ETIMEDOUT; |
88 | goto err; |
89 | } |
90 | |
91 | ret = da9055_reg_read(da9055, DA9055_REG_ADC_RES_H); |
92 | if (ret < 0) |
93 | goto err; |
94 | |
95 | calc_data = (unsigned short)ret; |
96 | data = calc_data << 2; |
97 | |
98 | ret = da9055_reg_read(da9055, DA9055_REG_ADC_RES_L); |
99 | if (ret < 0) |
100 | goto err; |
101 | |
102 | calc_data = (unsigned short)(ret & DA9055_ADC_LSB_MASK); |
103 | data |= calc_data; |
104 | |
105 | ret = data; |
106 | |
107 | err: |
108 | mutex_unlock(&hwmon->irq_lock); |
109 | return ret; |
110 | } |
111 | |
112 | static irqreturn_t da9055_auxadc_irq(int irq, void *irq_data) |
113 | { |
114 | struct da9055_hwmon *hwmon = irq_data; |
115 | |
116 | complete(&hwmon->done); |
117 | |
118 | return IRQ_HANDLED; |
119 | } |
120 | |
121 | /* Conversion function for VSYS and ADCINx */ |
122 | static inline int volt_reg_to_mv(int value, int channel) |
123 | { |
124 | if (channel == DA9055_ADC_VSYS) |
125 | return DIV_ROUND_CLOSEST(value * 1000, DA9055_VSYS_DIV) + 2500; |
126 | else |
127 | return DIV_ROUND_CLOSEST(value * 1000, DA9055_ADCIN_DIV); |
128 | } |
129 | |
130 | static int da9055_enable_auto_mode(struct da9055 *da9055, int channel) |
131 | { |
132 | |
133 | return da9055_reg_update(da9055, DA9055_REG_ADC_CONT, 1 << channel, |
134 | 1 << channel); |
135 | |
136 | } |
137 | |
138 | static int da9055_disable_auto_mode(struct da9055 *da9055, int channel) |
139 | { |
140 | |
141 | return da9055_reg_update(da9055, DA9055_REG_ADC_CONT, 1 << channel, 0); |
142 | } |
143 | |
144 | static ssize_t da9055_read_auto_ch(struct device *dev, |
145 | struct device_attribute *devattr, char *buf) |
146 | { |
147 | struct da9055_hwmon *hwmon = dev_get_drvdata(dev); |
148 | int ret, adc; |
149 | int channel = to_sensor_dev_attr(devattr)->index; |
150 | |
151 | mutex_lock(&hwmon->hwmon_lock); |
152 | |
153 | ret = da9055_enable_auto_mode(hwmon->da9055, channel); |
154 | if (ret < 0) |
155 | goto hwmon_err; |
156 | |
157 | usleep_range(10000, 10500); |
158 | |
159 | adc = da9055_reg_read(hwmon->da9055, DA9055_REG_VSYS_RES + channel); |
160 | if (adc < 0) { |
161 | ret = adc; |
162 | goto hwmon_err_release; |
163 | } |
164 | |
165 | ret = da9055_disable_auto_mode(hwmon->da9055, channel); |
166 | if (ret < 0) |
167 | goto hwmon_err; |
168 | |
169 | mutex_unlock(&hwmon->hwmon_lock); |
170 | |
171 | return sprintf(buf, "%d\n", volt_reg_to_mv(adc, channel)); |
172 | |
173 | hwmon_err_release: |
174 | da9055_disable_auto_mode(hwmon->da9055, channel); |
175 | hwmon_err: |
176 | mutex_unlock(&hwmon->hwmon_lock); |
177 | return ret; |
178 | } |
179 | |
180 | static ssize_t da9055_read_tjunc(struct device *dev, |
181 | struct device_attribute *devattr, char *buf) |
182 | { |
183 | struct da9055_hwmon *hwmon = dev_get_drvdata(dev); |
184 | int tjunc; |
185 | int toffset; |
186 | |
187 | tjunc = da9055_adc_manual_read(hwmon, DA9055_ADC_TJUNC); |
188 | if (tjunc < 0) |
189 | return tjunc; |
190 | |
191 | toffset = da9055_reg_read(hwmon->da9055, DA9055_REG_T_OFFSET); |
192 | if (toffset < 0) |
193 | return toffset; |
194 | |
195 | /* |
196 | * Degrees celsius = -0.4084 * (ADC_RES - T_OFFSET) + 307.6332 |
197 | * T_OFFSET is a trim value used to improve accuracy of the result |
198 | */ |
199 | return sprintf(buf, "%d\n", DIV_ROUND_CLOSEST(-4084 * (tjunc - toffset) |
200 | + 3076332, 10000)); |
201 | } |
202 | |
203 | static ssize_t da9055_hwmon_show_name(struct device *dev, |
204 | struct device_attribute *devattr, |
205 | char *buf) |
206 | { |
207 | return sprintf(buf, "da9055-hwmon\n"); |
208 | } |
209 | |
210 | static ssize_t show_label(struct device *dev, |
211 | struct device_attribute *devattr, char *buf) |
212 | { |
213 | return sprintf(buf, "%s\n", |
214 | input_names[to_sensor_dev_attr(devattr)->index]); |
215 | } |
216 | |
217 | static SENSOR_DEVICE_ATTR(in0_input, S_IRUGO, da9055_read_auto_ch, NULL, |
218 | DA9055_ADC_VSYS); |
219 | static SENSOR_DEVICE_ATTR(in0_label, S_IRUGO, show_label, NULL, |
220 | DA9055_ADC_VSYS); |
221 | static SENSOR_DEVICE_ATTR(in1_input, S_IRUGO, da9055_read_auto_ch, NULL, |
222 | DA9055_ADC_ADCIN1); |
223 | static SENSOR_DEVICE_ATTR(in1_label, S_IRUGO, show_label, NULL, |
224 | DA9055_ADC_ADCIN1); |
225 | static SENSOR_DEVICE_ATTR(in2_input, S_IRUGO, da9055_read_auto_ch, NULL, |
226 | DA9055_ADC_ADCIN2); |
227 | static SENSOR_DEVICE_ATTR(in2_label, S_IRUGO, show_label, NULL, |
228 | DA9055_ADC_ADCIN2); |
229 | static SENSOR_DEVICE_ATTR(in3_input, S_IRUGO, da9055_read_auto_ch, NULL, |
230 | DA9055_ADC_ADCIN3); |
231 | static SENSOR_DEVICE_ATTR(in3_label, S_IRUGO, show_label, NULL, |
232 | DA9055_ADC_ADCIN3); |
233 | |
234 | static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, da9055_read_tjunc, NULL, |
235 | DA9055_ADC_TJUNC); |
236 | static SENSOR_DEVICE_ATTR(temp1_label, S_IRUGO, show_label, NULL, |
237 | DA9055_ADC_TJUNC); |
238 | |
239 | static DEVICE_ATTR(name, S_IRUGO, da9055_hwmon_show_name, NULL); |
240 | |
241 | static struct attribute *da9055_attr[] = { |
242 | &dev_attr_name.attr, |
243 | &sensor_dev_attr_in0_input.dev_attr.attr, |
244 | &sensor_dev_attr_in0_label.dev_attr.attr, |
245 | &sensor_dev_attr_in1_input.dev_attr.attr, |
246 | &sensor_dev_attr_in1_label.dev_attr.attr, |
247 | &sensor_dev_attr_in2_input.dev_attr.attr, |
248 | &sensor_dev_attr_in2_label.dev_attr.attr, |
249 | &sensor_dev_attr_in3_input.dev_attr.attr, |
250 | &sensor_dev_attr_in3_label.dev_attr.attr, |
251 | |
252 | &sensor_dev_attr_temp1_input.dev_attr.attr, |
253 | &sensor_dev_attr_temp1_label.dev_attr.attr, |
254 | NULL |
255 | }; |
256 | |
257 | static const struct attribute_group da9055_attr_group = {.attrs = da9055_attr}; |
258 | |
259 | static int da9055_hwmon_probe(struct platform_device *pdev) |
260 | { |
261 | struct da9055_hwmon *hwmon; |
262 | int hwmon_irq, ret; |
263 | |
264 | hwmon = devm_kzalloc(&pdev->dev, sizeof(struct da9055_hwmon), |
265 | GFP_KERNEL); |
266 | if (!hwmon) |
267 | return -ENOMEM; |
268 | |
269 | mutex_init(&hwmon->hwmon_lock); |
270 | mutex_init(&hwmon->irq_lock); |
271 | |
272 | init_completion(&hwmon->done); |
273 | hwmon->da9055 = dev_get_drvdata(pdev->dev.parent); |
274 | |
275 | platform_set_drvdata(pdev, hwmon); |
276 | |
277 | hwmon_irq = platform_get_irq_byname(pdev, "HWMON"); |
278 | if (hwmon_irq < 0) |
279 | return hwmon_irq; |
280 | |
281 | hwmon_irq = regmap_irq_get_virq(hwmon->da9055->irq_data, hwmon_irq); |
282 | if (hwmon_irq < 0) |
283 | return hwmon_irq; |
284 | |
285 | ret = devm_request_threaded_irq(&pdev->dev, hwmon_irq, |
286 | NULL, da9055_auxadc_irq, |
287 | IRQF_TRIGGER_HIGH | IRQF_ONESHOT, |
288 | "adc-irq", hwmon); |
289 | if (ret != 0) { |
290 | dev_err(hwmon->da9055->dev, "DA9055 ADC IRQ failed ret=%d\n", |
291 | ret); |
292 | return ret; |
293 | } |
294 | |
295 | ret = sysfs_create_group(&pdev->dev.kobj, &da9055_attr_group); |
296 | if (ret) |
297 | return ret; |
298 | |
299 | hwmon->class_device = hwmon_device_register(&pdev->dev); |
300 | if (IS_ERR(hwmon->class_device)) { |
301 | ret = PTR_ERR(hwmon->class_device); |
302 | goto err; |
303 | } |
304 | |
305 | return 0; |
306 | |
307 | err: |
308 | sysfs_remove_group(&pdev->dev.kobj, &da9055_attr_group); |
309 | return ret; |
310 | } |
311 | |
312 | static int da9055_hwmon_remove(struct platform_device *pdev) |
313 | { |
314 | struct da9055_hwmon *hwmon = platform_get_drvdata(pdev); |
315 | |
316 | sysfs_remove_group(&pdev->dev.kobj, &da9055_attr_group); |
317 | hwmon_device_unregister(hwmon->class_device); |
318 | |
319 | return 0; |
320 | } |
321 | |
322 | static struct platform_driver da9055_hwmon_driver = { |
323 | .probe = da9055_hwmon_probe, |
324 | .remove = da9055_hwmon_remove, |
325 | .driver = { |
326 | .name = "da9055-hwmon", |
327 | .owner = THIS_MODULE, |
328 | }, |
329 | }; |
330 | |
331 | module_platform_driver(da9055_hwmon_driver); |
332 | |
333 | MODULE_AUTHOR("David Dajun Chen <dchen@diasemi.com>"); |
334 | MODULE_DESCRIPTION("DA9055 HWMON driver"); |
335 | MODULE_LICENSE("GPL"); |
336 | MODULE_ALIAS("platform:da9055-hwmon"); |
337 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9