rtlwifi: Change order in device startup
[deliverable/linux.git] / drivers / iio / proximity / as3935.c
1 /*
2 * as3935.c - Support for AS3935 Franklin lightning sensor
3 *
4 * Copyright (C) 2014 Matt Ranostay <mranostay@gmail.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 */
17
18 #include <linux/module.h>
19 #include <linux/init.h>
20 #include <linux/interrupt.h>
21 #include <linux/delay.h>
22 #include <linux/workqueue.h>
23 #include <linux/mutex.h>
24 #include <linux/err.h>
25 #include <linux/irq.h>
26 #include <linux/gpio.h>
27 #include <linux/spi/spi.h>
28 #include <linux/iio/iio.h>
29 #include <linux/iio/sysfs.h>
30 #include <linux/iio/trigger.h>
31 #include <linux/iio/trigger_consumer.h>
32 #include <linux/iio/buffer.h>
33 #include <linux/iio/triggered_buffer.h>
34 #include <linux/of_gpio.h>
35
36
37 #define AS3935_AFE_GAIN 0x00
38 #define AS3935_AFE_MASK 0x3F
39 #define AS3935_AFE_GAIN_MAX 0x1F
40 #define AS3935_AFE_PWR_BIT BIT(0)
41
42 #define AS3935_INT 0x03
43 #define AS3935_INT_MASK 0x07
44 #define AS3935_EVENT_INT BIT(3)
45 #define AS3935_NOISE_INT BIT(1)
46
47 #define AS3935_DATA 0x07
48 #define AS3935_DATA_MASK 0x3F
49
50 #define AS3935_TUNE_CAP 0x08
51 #define AS3935_CALIBRATE 0x3D
52
53 #define AS3935_WRITE_DATA BIT(15)
54 #define AS3935_READ_DATA BIT(14)
55 #define AS3935_ADDRESS(x) ((x) << 8)
56
57 #define MAX_PF_CAP 120
58 #define TUNE_CAP_DIV 8
59
60 struct as3935_state {
61 struct spi_device *spi;
62 struct iio_trigger *trig;
63 struct mutex lock;
64 struct delayed_work work;
65
66 u32 tune_cap;
67 u8 buf[2] ____cacheline_aligned;
68 };
69
70 static const struct iio_chan_spec as3935_channels[] = {
71 {
72 .type = IIO_PROXIMITY,
73 .info_mask_separate =
74 BIT(IIO_CHAN_INFO_RAW) |
75 BIT(IIO_CHAN_INFO_PROCESSED),
76 .scan_index = 0,
77 .scan_type = {
78 .sign = 'u',
79 .realbits = 6,
80 .storagebits = 8,
81 },
82 },
83 IIO_CHAN_SOFT_TIMESTAMP(1),
84 };
85
86 static int as3935_read(struct as3935_state *st, unsigned int reg, int *val)
87 {
88 u8 cmd;
89 int ret;
90
91 cmd = (AS3935_READ_DATA | AS3935_ADDRESS(reg)) >> 8;
92 ret = spi_w8r8(st->spi, cmd);
93 if (ret < 0)
94 return ret;
95 *val = ret;
96
97 return 0;
98 };
99
100 static int as3935_write(struct as3935_state *st,
101 unsigned int reg,
102 unsigned int val)
103 {
104 u8 *buf = st->buf;
105
106 buf[0] = (AS3935_WRITE_DATA | AS3935_ADDRESS(reg)) >> 8;
107 buf[1] = val;
108
109 return spi_write(st->spi, buf, 2);
110 };
111
112 static ssize_t as3935_sensor_sensitivity_show(struct device *dev,
113 struct device_attribute *attr,
114 char *buf)
115 {
116 struct as3935_state *st = iio_priv(dev_to_iio_dev(dev));
117 int val, ret;
118
119 ret = as3935_read(st, AS3935_AFE_GAIN, &val);
120 if (ret)
121 return ret;
122 val = (val & AS3935_AFE_MASK) >> 1;
123
124 return sprintf(buf, "%d\n", val);
125 };
126
127 static ssize_t as3935_sensor_sensitivity_store(struct device *dev,
128 struct device_attribute *attr,
129 const char *buf, size_t len)
130 {
131 struct as3935_state *st = iio_priv(dev_to_iio_dev(dev));
132 unsigned long val;
133 int ret;
134
135 ret = kstrtoul((const char *) buf, 10, &val);
136 if (ret)
137 return -EINVAL;
138
139 if (val > AS3935_AFE_GAIN_MAX)
140 return -EINVAL;
141
142 as3935_write(st, AS3935_AFE_GAIN, val << 1);
143
144 return len;
145 };
146
147 static IIO_DEVICE_ATTR(sensor_sensitivity, S_IRUGO | S_IWUSR,
148 as3935_sensor_sensitivity_show, as3935_sensor_sensitivity_store, 0);
149
150
151 static struct attribute *as3935_attributes[] = {
152 &iio_dev_attr_sensor_sensitivity.dev_attr.attr,
153 NULL,
154 };
155
156 static struct attribute_group as3935_attribute_group = {
157 .attrs = as3935_attributes,
158 };
159
160 static int as3935_read_raw(struct iio_dev *indio_dev,
161 struct iio_chan_spec const *chan,
162 int *val,
163 int *val2,
164 long m)
165 {
166 struct as3935_state *st = iio_priv(indio_dev);
167 int ret;
168
169
170 switch (m) {
171 case IIO_CHAN_INFO_PROCESSED:
172 case IIO_CHAN_INFO_RAW:
173 *val2 = 0;
174 ret = as3935_read(st, AS3935_DATA, val);
175 if (ret)
176 return ret;
177
178 if (m == IIO_CHAN_INFO_RAW)
179 return IIO_VAL_INT;
180
181 /* storm out of range */
182 if (*val == AS3935_DATA_MASK)
183 return -EINVAL;
184 *val *= 1000;
185 break;
186 default:
187 return -EINVAL;
188 }
189
190 return IIO_VAL_INT;
191 }
192
193 static const struct iio_info as3935_info = {
194 .driver_module = THIS_MODULE,
195 .attrs = &as3935_attribute_group,
196 .read_raw = &as3935_read_raw,
197 };
198
199 static irqreturn_t as3935_trigger_handler(int irq, void *private)
200 {
201 struct iio_poll_func *pf = private;
202 struct iio_dev *indio_dev = pf->indio_dev;
203 struct as3935_state *st = iio_priv(indio_dev);
204 int val, ret;
205
206 ret = as3935_read(st, AS3935_DATA, &val);
207 if (ret)
208 goto err_read;
209 val &= AS3935_DATA_MASK;
210 val *= 1000;
211
212 iio_push_to_buffers_with_timestamp(indio_dev, &val, pf->timestamp);
213 err_read:
214 iio_trigger_notify_done(indio_dev->trig);
215
216 return IRQ_HANDLED;
217 };
218
219 static const struct iio_trigger_ops iio_interrupt_trigger_ops = {
220 .owner = THIS_MODULE,
221 };
222
223 static void as3935_event_work(struct work_struct *work)
224 {
225 struct as3935_state *st;
226 int val;
227
228 st = container_of(work, struct as3935_state, work.work);
229
230 as3935_read(st, AS3935_INT, &val);
231 val &= AS3935_INT_MASK;
232
233 switch (val) {
234 case AS3935_EVENT_INT:
235 iio_trigger_poll(st->trig);
236 break;
237 case AS3935_NOISE_INT:
238 dev_warn(&st->spi->dev, "noise level is too high");
239 break;
240 }
241 };
242
243 static irqreturn_t as3935_interrupt_handler(int irq, void *private)
244 {
245 struct iio_dev *indio_dev = private;
246 struct as3935_state *st = iio_priv(indio_dev);
247
248 /*
249 * Delay work for >2 milliseconds after an interrupt to allow
250 * estimated distance to recalculated.
251 */
252
253 schedule_delayed_work(&st->work, msecs_to_jiffies(3));
254
255 return IRQ_HANDLED;
256 }
257
258 static void calibrate_as3935(struct as3935_state *st)
259 {
260 mutex_lock(&st->lock);
261
262 /* mask disturber interrupt bit */
263 as3935_write(st, AS3935_INT, BIT(5));
264
265 as3935_write(st, AS3935_CALIBRATE, 0x96);
266 as3935_write(st, AS3935_TUNE_CAP,
267 BIT(5) | (st->tune_cap / TUNE_CAP_DIV));
268
269 mdelay(2);
270 as3935_write(st, AS3935_TUNE_CAP, (st->tune_cap / TUNE_CAP_DIV));
271
272 mutex_unlock(&st->lock);
273 }
274
275 #ifdef CONFIG_PM_SLEEP
276 static int as3935_suspend(struct spi_device *spi, pm_message_t msg)
277 {
278 struct iio_dev *indio_dev = spi_get_drvdata(spi);
279 struct as3935_state *st = iio_priv(indio_dev);
280 int val, ret;
281
282 mutex_lock(&st->lock);
283 ret = as3935_read(st, AS3935_AFE_GAIN, &val);
284 if (ret)
285 goto err_suspend;
286 val |= AS3935_AFE_PWR_BIT;
287
288 ret = as3935_write(st, AS3935_AFE_GAIN, val);
289
290 err_suspend:
291 mutex_unlock(&st->lock);
292
293 return ret;
294 }
295
296 static int as3935_resume(struct spi_device *spi)
297 {
298 struct iio_dev *indio_dev = spi_get_drvdata(spi);
299 struct as3935_state *st = iio_priv(indio_dev);
300 int val, ret;
301
302 mutex_lock(&st->lock);
303 ret = as3935_read(st, AS3935_AFE_GAIN, &val);
304 if (ret)
305 goto err_resume;
306 val &= ~AS3935_AFE_PWR_BIT;
307 ret = as3935_write(st, AS3935_AFE_GAIN, val);
308
309 err_resume:
310 mutex_unlock(&st->lock);
311
312 return ret;
313 }
314 #else
315 #define as3935_suspend NULL
316 #define as3935_resume NULL
317 #endif
318
319 static int as3935_probe(struct spi_device *spi)
320 {
321 struct iio_dev *indio_dev;
322 struct iio_trigger *trig;
323 struct as3935_state *st;
324 struct device_node *np = spi->dev.of_node;
325 int ret;
326
327 /* Be sure lightning event interrupt is specified */
328 if (!spi->irq) {
329 dev_err(&spi->dev, "unable to get event interrupt\n");
330 return -EINVAL;
331 }
332
333 indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(st));
334 if (!indio_dev)
335 return -ENOMEM;
336
337 st = iio_priv(indio_dev);
338 st->spi = spi;
339 st->tune_cap = 0;
340
341 spi_set_drvdata(spi, indio_dev);
342 mutex_init(&st->lock);
343 INIT_DELAYED_WORK(&st->work, as3935_event_work);
344
345 ret = of_property_read_u32(np,
346 "ams,tuning-capacitor-pf", &st->tune_cap);
347 if (ret) {
348 st->tune_cap = 0;
349 dev_warn(&spi->dev,
350 "no tuning-capacitor-pf set, defaulting to %d",
351 st->tune_cap);
352 }
353
354 if (st->tune_cap > MAX_PF_CAP) {
355 dev_err(&spi->dev,
356 "wrong tuning-capacitor-pf setting of %d\n",
357 st->tune_cap);
358 return -EINVAL;
359 }
360
361 indio_dev->dev.parent = &spi->dev;
362 indio_dev->name = spi_get_device_id(spi)->name;
363 indio_dev->channels = as3935_channels;
364 indio_dev->num_channels = ARRAY_SIZE(as3935_channels);
365 indio_dev->modes = INDIO_DIRECT_MODE;
366 indio_dev->info = &as3935_info;
367
368 trig = devm_iio_trigger_alloc(&spi->dev, "%s-dev%d",
369 indio_dev->name, indio_dev->id);
370
371 if (!trig)
372 return -ENOMEM;
373
374 st->trig = trig;
375 trig->dev.parent = indio_dev->dev.parent;
376 iio_trigger_set_drvdata(trig, indio_dev);
377 trig->ops = &iio_interrupt_trigger_ops;
378
379 ret = iio_trigger_register(trig);
380 if (ret) {
381 dev_err(&spi->dev, "failed to register trigger\n");
382 return ret;
383 }
384
385 ret = iio_triggered_buffer_setup(indio_dev, NULL,
386 &as3935_trigger_handler, NULL);
387
388 if (ret) {
389 dev_err(&spi->dev, "cannot setup iio trigger\n");
390 goto unregister_trigger;
391 }
392
393 calibrate_as3935(st);
394
395 ret = devm_request_irq(&spi->dev, spi->irq,
396 &as3935_interrupt_handler,
397 IRQF_TRIGGER_RISING,
398 dev_name(&spi->dev),
399 indio_dev);
400
401 if (ret) {
402 dev_err(&spi->dev, "unable to request irq\n");
403 goto unregister_buffer;
404 }
405
406 ret = iio_device_register(indio_dev);
407 if (ret < 0) {
408 dev_err(&spi->dev, "unable to register device\n");
409 goto unregister_buffer;
410 }
411 return 0;
412
413 unregister_buffer:
414 iio_triggered_buffer_cleanup(indio_dev);
415
416 unregister_trigger:
417 iio_trigger_unregister(st->trig);
418
419 return ret;
420 };
421
422 static int as3935_remove(struct spi_device *spi)
423 {
424 struct iio_dev *indio_dev = spi_get_drvdata(spi);
425 struct as3935_state *st = iio_priv(indio_dev);
426
427 iio_device_unregister(indio_dev);
428 iio_triggered_buffer_cleanup(indio_dev);
429 iio_trigger_unregister(st->trig);
430
431 return 0;
432 };
433
434 static const struct spi_device_id as3935_id[] = {
435 {"as3935", 0},
436 {},
437 };
438 MODULE_DEVICE_TABLE(spi, as3935_id);
439
440 static struct spi_driver as3935_driver = {
441 .driver = {
442 .name = "as3935",
443 .owner = THIS_MODULE,
444 },
445 .probe = as3935_probe,
446 .remove = as3935_remove,
447 .id_table = as3935_id,
448 .suspend = as3935_suspend,
449 .resume = as3935_resume,
450 };
451 module_spi_driver(as3935_driver);
452
453 MODULE_AUTHOR("Matt Ranostay <mranostay@gmail.com>");
454 MODULE_DESCRIPTION("AS3935 lightning sensor");
455 MODULE_LICENSE("GPL");
456 MODULE_ALIAS("spi:as3935");
This page took 0.05439 seconds and 5 git commands to generate.