1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * bma180.c - IIO driver for Bosch BMA180 triaxial acceleration sensor
4 *
5 * Copyright 2013 Oleksandr Kravchenko <x0199363@ti.com>
6 *
7 * Support for BMA250 (c) Peter Meerwald <pmeerw@pmeerw.net>
8 *
9 * SPI is not supported by driver
10 * BMA023/BMA150/SMB380: 7-bit I2C slave address 0x38
11 * BMA180: 7-bit I2C slave address 0x40 or 0x41
12 * BMA250: 7-bit I2C slave address 0x18 or 0x19
13 */
14
15 #include <linux/module.h>
16 #include <linux/mod_devicetable.h>
17 #include <linux/i2c.h>
18 #include <linux/interrupt.h>
19 #include <linux/delay.h>
20 #include <linux/bitops.h>
21 #include <linux/regulator/consumer.h>
22 #include <linux/slab.h>
23 #include <linux/string.h>
24 #include <linux/types.h>
25 #include <linux/iio/iio.h>
26 #include <linux/iio/sysfs.h>
27 #include <linux/iio/buffer.h>
28 #include <linux/iio/trigger.h>
29 #include <linux/iio/trigger_consumer.h>
30 #include <linux/iio/triggered_buffer.h>
31
32 enum chip_ids {
33 BMA023,
34 BMA150,
35 BMA180,
36 BMA250,
37 };
38
39 struct bma180_data;
40
41 struct bma180_part_info {
42 u8 chip_id;
43 const struct iio_chan_spec *channels;
44 unsigned int num_channels;
45 const int *scale_table;
46 unsigned int num_scales;
47 const int *bw_table;
48 unsigned int num_bw;
49 int temp_offset;
50
51 u8 int_reset_reg, int_reset_mask;
52 u8 sleep_reg, sleep_mask;
53 u8 bw_reg, bw_mask, bw_offset;
54 u8 scale_reg, scale_mask;
55 u8 power_reg, power_mask, lowpower_val;
56 u8 int_enable_reg, int_enable_mask;
57 u8 softreset_reg, softreset_val;
58
59 int (*chip_config)(struct bma180_data *data);
60 void (*chip_disable)(struct bma180_data *data);
61 };
62
63 /* Register set */
64 #define BMA023_CTRL_REG0 0x0a
65 #define BMA023_CTRL_REG1 0x0b
66 #define BMA023_CTRL_REG2 0x14
67 #define BMA023_CTRL_REG3 0x15
68
69 #define BMA023_RANGE_MASK GENMASK(4, 3) /* Range of accel values */
70 #define BMA023_BW_MASK GENMASK(2, 0) /* Accel bandwidth */
71 #define BMA023_SLEEP BIT(0)
72 #define BMA023_INT_RESET_MASK BIT(6)
73 #define BMA023_NEW_DATA_INT BIT(5) /* Intr every new accel data is ready */
74 #define BMA023_RESET_VAL BIT(1)
75
76 #define BMA180_CHIP_ID 0x00 /* Need to distinguish BMA180 from other */
77 #define BMA180_ACC_X_LSB 0x02 /* First of 6 registers of accel data */
78 #define BMA180_TEMP 0x08
79 #define BMA180_CTRL_REG0 0x0d
80 #define BMA180_RESET 0x10
81 #define BMA180_BW_TCS 0x20
82 #define BMA180_CTRL_REG3 0x21
83 #define BMA180_TCO_Z 0x30
84 #define BMA180_OFFSET_LSB1 0x35
85
86 /* BMA180_CTRL_REG0 bits */
87 #define BMA180_DIS_WAKE_UP BIT(0) /* Disable wake up mode */
88 #define BMA180_SLEEP BIT(1) /* 1 - chip will sleep */
89 #define BMA180_EE_W BIT(4) /* Unlock writing to addr from 0x20 */
90 #define BMA180_RESET_INT BIT(6) /* Reset pending interrupts */
91
92 /* BMA180_CTRL_REG3 bits */
93 #define BMA180_NEW_DATA_INT BIT(1) /* Intr every new accel data is ready */
94
95 /* BMA180_OFFSET_LSB1 skipping mode bit */
96 #define BMA180_SMP_SKIP BIT(0)
97
98 /* Bit masks for registers bit fields */
99 #define BMA180_RANGE 0x0e /* Range of measured accel values */
100 #define BMA180_BW 0xf0 /* Accel bandwidth */
101 #define BMA180_MODE_CONFIG 0x03 /* Config operation modes */
102
103 /* We have to write this value in reset register to do soft reset */
104 #define BMA180_RESET_VAL 0xb6
105
106 #define BMA023_ID_REG_VAL 0x02
107 #define BMA180_ID_REG_VAL 0x03
108 #define BMA250_ID_REG_VAL 0x03
109
110 /* Chip power modes */
111 #define BMA180_LOW_POWER 0x03
112
113 #define BMA250_RANGE_REG 0x0f
114 #define BMA250_BW_REG 0x10
115 #define BMA250_POWER_REG 0x11
116 #define BMA250_RESET_REG 0x14
117 #define BMA250_INT_ENABLE_REG 0x17
118 #define BMA250_INT_MAP_REG 0x1a
119 #define BMA250_INT_RESET_REG 0x21
120
121 #define BMA250_RANGE_MASK GENMASK(3, 0) /* Range of accel values */
122 #define BMA250_BW_MASK GENMASK(4, 0) /* Accel bandwidth */
123 #define BMA250_BW_OFFSET 8
124 #define BMA250_SUSPEND_MASK BIT(7) /* chip will sleep */
125 #define BMA250_LOWPOWER_MASK BIT(6)
126 #define BMA250_DATA_INTEN_MASK BIT(4)
127 #define BMA250_INT1_DATA_MASK BIT(0)
128 #define BMA250_INT_RESET_MASK BIT(7) /* Reset pending interrupts */
129
130 struct bma180_data {
131 struct regulator *vdd_supply;
132 struct regulator *vddio_supply;
133 struct i2c_client *client;
134 struct iio_trigger *trig;
135 const struct bma180_part_info *part_info;
136 struct iio_mount_matrix orientation;
137 struct mutex mutex;
138 bool sleep_state;
139 int scale;
140 int bw;
141 bool pmode;
142 /* Ensure timestamp is naturally aligned */
143 struct {
144 s16 chan[4];
145 aligned_s64 timestamp;
146 } scan;
147 };
148
149 enum bma180_chan {
150 AXIS_X,
151 AXIS_Y,
152 AXIS_Z,
153 TEMP
154 };
155
156 static int bma023_bw_table[] = { 25, 50, 100, 190, 375, 750, 1500 }; /* Hz */
157 static int bma023_scale_table[] = { 2452, 4903, 9709, };
158
159 static int bma180_bw_table[] = { 10, 20, 40, 75, 150, 300 }; /* Hz */
160 static int bma180_scale_table[] = { 1275, 1863, 2452, 3727, 4903, 9709, 19417 };
161
162 static int bma250_bw_table[] = { 8, 16, 31, 63, 125, 250, 500, 1000 }; /* Hz */
163 static int bma250_scale_table[] = { 0, 0, 0, 38344, 0, 76590, 0, 0, 153180, 0,
164 0, 0, 306458 };
165
bma180_get_data_reg(struct bma180_data * data,enum bma180_chan chan)166 static int bma180_get_data_reg(struct bma180_data *data, enum bma180_chan chan)
167 {
168 int ret;
169
170 if (data->sleep_state)
171 return -EBUSY;
172
173 switch (chan) {
174 case TEMP:
175 ret = i2c_smbus_read_byte_data(data->client, BMA180_TEMP);
176 if (ret < 0)
177 dev_err(&data->client->dev, "failed to read temp register\n");
178 break;
179 default:
180 ret = i2c_smbus_read_word_data(data->client,
181 BMA180_ACC_X_LSB + chan * 2);
182 if (ret < 0)
183 dev_err(&data->client->dev,
184 "failed to read accel_%c register\n",
185 'x' + chan);
186 }
187
188 return ret;
189 }
190
bma180_set_bits(struct bma180_data * data,u8 reg,u8 mask,u8 val)191 static int bma180_set_bits(struct bma180_data *data, u8 reg, u8 mask, u8 val)
192 {
193 int ret = i2c_smbus_read_byte_data(data->client, reg);
194 u8 reg_val = (ret & ~mask) | (val << (ffs(mask) - 1));
195
196 if (ret < 0)
197 return ret;
198
199 return i2c_smbus_write_byte_data(data->client, reg, reg_val);
200 }
201
bma180_reset_intr(struct bma180_data * data)202 static int bma180_reset_intr(struct bma180_data *data)
203 {
204 int ret = bma180_set_bits(data, data->part_info->int_reset_reg,
205 data->part_info->int_reset_mask, 1);
206
207 if (ret)
208 dev_err(&data->client->dev, "failed to reset interrupt\n");
209
210 return ret;
211 }
212
bma180_set_new_data_intr_state(struct bma180_data * data,bool state)213 static int bma180_set_new_data_intr_state(struct bma180_data *data, bool state)
214 {
215 int ret = bma180_set_bits(data, data->part_info->int_enable_reg,
216 data->part_info->int_enable_mask, state);
217 if (ret)
218 goto err;
219 ret = bma180_reset_intr(data);
220 if (ret)
221 goto err;
222
223 return 0;
224
225 err:
226 dev_err(&data->client->dev,
227 "failed to set new data interrupt state %d\n", state);
228 return ret;
229 }
230
bma180_set_sleep_state(struct bma180_data * data,bool state)231 static int bma180_set_sleep_state(struct bma180_data *data, bool state)
232 {
233 int ret = bma180_set_bits(data, data->part_info->sleep_reg,
234 data->part_info->sleep_mask, state);
235
236 if (ret) {
237 dev_err(&data->client->dev,
238 "failed to set sleep state %d\n", state);
239 return ret;
240 }
241 data->sleep_state = state;
242
243 return 0;
244 }
245
bma180_set_ee_writing_state(struct bma180_data * data,bool state)246 static int bma180_set_ee_writing_state(struct bma180_data *data, bool state)
247 {
248 int ret = bma180_set_bits(data, BMA180_CTRL_REG0, BMA180_EE_W, state);
249
250 if (ret)
251 dev_err(&data->client->dev,
252 "failed to set ee writing state %d\n", state);
253
254 return ret;
255 }
256
bma180_set_bw(struct bma180_data * data,int val)257 static int bma180_set_bw(struct bma180_data *data, int val)
258 {
259 int ret, i;
260
261 if (data->sleep_state)
262 return -EBUSY;
263
264 for (i = 0; i < data->part_info->num_bw; ++i) {
265 if (data->part_info->bw_table[i] == val) {
266 ret = bma180_set_bits(data, data->part_info->bw_reg,
267 data->part_info->bw_mask,
268 i + data->part_info->bw_offset);
269 if (ret) {
270 dev_err(&data->client->dev,
271 "failed to set bandwidth\n");
272 return ret;
273 }
274 data->bw = val;
275 return 0;
276 }
277 }
278
279 return -EINVAL;
280 }
281
bma180_set_scale(struct bma180_data * data,int val)282 static int bma180_set_scale(struct bma180_data *data, int val)
283 {
284 int ret, i;
285
286 if (data->sleep_state)
287 return -EBUSY;
288
289 for (i = 0; i < data->part_info->num_scales; ++i)
290 if (data->part_info->scale_table[i] == val) {
291 ret = bma180_set_bits(data, data->part_info->scale_reg,
292 data->part_info->scale_mask, i);
293 if (ret) {
294 dev_err(&data->client->dev,
295 "failed to set scale\n");
296 return ret;
297 }
298 data->scale = val;
299 return 0;
300 }
301
302 return -EINVAL;
303 }
304
bma180_set_pmode(struct bma180_data * data,bool mode)305 static int bma180_set_pmode(struct bma180_data *data, bool mode)
306 {
307 u8 reg_val = mode ? data->part_info->lowpower_val : 0;
308 int ret = bma180_set_bits(data, data->part_info->power_reg,
309 data->part_info->power_mask, reg_val);
310
311 if (ret) {
312 dev_err(&data->client->dev, "failed to set power mode\n");
313 return ret;
314 }
315 data->pmode = mode;
316
317 return 0;
318 }
319
bma180_soft_reset(struct bma180_data * data)320 static int bma180_soft_reset(struct bma180_data *data)
321 {
322 int ret = i2c_smbus_write_byte_data(data->client,
323 data->part_info->softreset_reg,
324 data->part_info->softreset_val);
325
326 if (ret)
327 dev_err(&data->client->dev, "failed to reset the chip\n");
328
329 return ret;
330 }
331
bma180_chip_init(struct bma180_data * data)332 static int bma180_chip_init(struct bma180_data *data)
333 {
334 /* Try to read chip_id register. It must return 0x03. */
335 int ret = i2c_smbus_read_byte_data(data->client, BMA180_CHIP_ID);
336
337 if (ret < 0)
338 return ret;
339 if (ret != data->part_info->chip_id) {
340 dev_err(&data->client->dev, "wrong chip ID %d expected %d\n",
341 ret, data->part_info->chip_id);
342 return -ENODEV;
343 }
344
345 ret = bma180_soft_reset(data);
346 if (ret)
347 return ret;
348 /*
349 * No serial transaction should occur within minimum 10 us
350 * after soft_reset command
351 */
352 msleep(20);
353
354 return bma180_set_new_data_intr_state(data, false);
355 }
356
bma023_chip_config(struct bma180_data * data)357 static int bma023_chip_config(struct bma180_data *data)
358 {
359 int ret = bma180_chip_init(data);
360
361 if (ret)
362 goto err;
363
364 ret = bma180_set_bw(data, 50); /* 50 Hz */
365 if (ret)
366 goto err;
367 ret = bma180_set_scale(data, 2452); /* 2 G */
368 if (ret)
369 goto err;
370
371 return 0;
372
373 err:
374 dev_err(&data->client->dev, "failed to config the chip\n");
375 return ret;
376 }
377
bma180_chip_config(struct bma180_data * data)378 static int bma180_chip_config(struct bma180_data *data)
379 {
380 int ret = bma180_chip_init(data);
381
382 if (ret)
383 goto err;
384 ret = bma180_set_pmode(data, false);
385 if (ret)
386 goto err;
387 ret = bma180_set_bits(data, BMA180_CTRL_REG0, BMA180_DIS_WAKE_UP, 1);
388 if (ret)
389 goto err;
390 ret = bma180_set_ee_writing_state(data, true);
391 if (ret)
392 goto err;
393 ret = bma180_set_bits(data, BMA180_OFFSET_LSB1, BMA180_SMP_SKIP, 1);
394 if (ret)
395 goto err;
396 ret = bma180_set_bw(data, 20); /* 20 Hz */
397 if (ret)
398 goto err;
399 ret = bma180_set_scale(data, 2452); /* 2 G */
400 if (ret)
401 goto err;
402
403 return 0;
404
405 err:
406 dev_err(&data->client->dev, "failed to config the chip\n");
407 return ret;
408 }
409
bma250_chip_config(struct bma180_data * data)410 static int bma250_chip_config(struct bma180_data *data)
411 {
412 int ret = bma180_chip_init(data);
413
414 if (ret)
415 goto err;
416 ret = bma180_set_pmode(data, false);
417 if (ret)
418 goto err;
419 ret = bma180_set_bw(data, 16); /* 16 Hz */
420 if (ret)
421 goto err;
422 ret = bma180_set_scale(data, 38344); /* 2 G */
423 if (ret)
424 goto err;
425 /*
426 * This enables dataready interrupt on the INT1 pin
427 * FIXME: support using the INT2 pin
428 */
429 ret = bma180_set_bits(data, BMA250_INT_MAP_REG, BMA250_INT1_DATA_MASK, 1);
430 if (ret)
431 goto err;
432
433 return 0;
434
435 err:
436 dev_err(&data->client->dev, "failed to config the chip\n");
437 return ret;
438 }
439
bma023_chip_disable(struct bma180_data * data)440 static void bma023_chip_disable(struct bma180_data *data)
441 {
442 if (bma180_set_sleep_state(data, true))
443 goto err;
444
445 return;
446
447 err:
448 dev_err(&data->client->dev, "failed to disable the chip\n");
449 }
450
bma180_chip_disable(struct bma180_data * data)451 static void bma180_chip_disable(struct bma180_data *data)
452 {
453 if (bma180_set_new_data_intr_state(data, false))
454 goto err;
455 if (bma180_set_ee_writing_state(data, false))
456 goto err;
457 if (bma180_set_sleep_state(data, true))
458 goto err;
459
460 return;
461
462 err:
463 dev_err(&data->client->dev, "failed to disable the chip\n");
464 }
465
bma250_chip_disable(struct bma180_data * data)466 static void bma250_chip_disable(struct bma180_data *data)
467 {
468 if (bma180_set_new_data_intr_state(data, false))
469 goto err;
470 if (bma180_set_sleep_state(data, true))
471 goto err;
472
473 return;
474
475 err:
476 dev_err(&data->client->dev, "failed to disable the chip\n");
477 }
478
bma180_show_avail(char * buf,const int * vals,unsigned int n,bool micros)479 static ssize_t bma180_show_avail(char *buf, const int *vals, unsigned int n,
480 bool micros)
481 {
482 size_t len = 0;
483 int i;
484
485 for (i = 0; i < n; i++) {
486 if (!vals[i])
487 continue;
488 len += scnprintf(buf + len, PAGE_SIZE - len,
489 micros ? "0.%06d " : "%d ", vals[i]);
490 }
491 buf[len - 1] = '\n';
492
493 return len;
494 }
495
bma180_show_filter_freq_avail(struct device * dev,struct device_attribute * attr,char * buf)496 static ssize_t bma180_show_filter_freq_avail(struct device *dev,
497 struct device_attribute *attr, char *buf)
498 {
499 struct bma180_data *data = iio_priv(dev_to_iio_dev(dev));
500
501 return bma180_show_avail(buf, data->part_info->bw_table,
502 data->part_info->num_bw, false);
503 }
504
bma180_show_scale_avail(struct device * dev,struct device_attribute * attr,char * buf)505 static ssize_t bma180_show_scale_avail(struct device *dev,
506 struct device_attribute *attr, char *buf)
507 {
508 struct bma180_data *data = iio_priv(dev_to_iio_dev(dev));
509
510 return bma180_show_avail(buf, data->part_info->scale_table,
511 data->part_info->num_scales, true);
512 }
513
514 static IIO_DEVICE_ATTR(in_accel_filter_low_pass_3db_frequency_available,
515 S_IRUGO, bma180_show_filter_freq_avail, NULL, 0);
516
517 static IIO_DEVICE_ATTR(in_accel_scale_available,
518 S_IRUGO, bma180_show_scale_avail, NULL, 0);
519
520 static struct attribute *bma180_attributes[] = {
521 &iio_dev_attr_in_accel_filter_low_pass_3db_frequency_available.
522 dev_attr.attr,
523 &iio_dev_attr_in_accel_scale_available.dev_attr.attr,
524 NULL,
525 };
526
527 static const struct attribute_group bma180_attrs_group = {
528 .attrs = bma180_attributes,
529 };
530
bma180_read_raw(struct iio_dev * indio_dev,struct iio_chan_spec const * chan,int * val,int * val2,long mask)531 static int bma180_read_raw(struct iio_dev *indio_dev,
532 struct iio_chan_spec const *chan, int *val, int *val2,
533 long mask)
534 {
535 struct bma180_data *data = iio_priv(indio_dev);
536 int ret;
537
538 switch (mask) {
539 case IIO_CHAN_INFO_RAW:
540 if (!iio_device_claim_direct(indio_dev))
541 return -EBUSY;
542
543 mutex_lock(&data->mutex);
544 ret = bma180_get_data_reg(data, chan->scan_index);
545 mutex_unlock(&data->mutex);
546 iio_device_release_direct(indio_dev);
547 if (ret < 0)
548 return ret;
549 if (chan->scan_type.sign == 's') {
550 *val = sign_extend32(ret >> chan->scan_type.shift,
551 chan->scan_type.realbits - 1);
552 } else {
553 *val = ret;
554 }
555 return IIO_VAL_INT;
556 case IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY:
557 *val = data->bw;
558 return IIO_VAL_INT;
559 case IIO_CHAN_INFO_SCALE:
560 switch (chan->type) {
561 case IIO_ACCEL:
562 *val = 0;
563 *val2 = data->scale;
564 return IIO_VAL_INT_PLUS_MICRO;
565 case IIO_TEMP:
566 *val = 500;
567 return IIO_VAL_INT;
568 default:
569 return -EINVAL;
570 }
571 case IIO_CHAN_INFO_OFFSET:
572 *val = data->part_info->temp_offset;
573 return IIO_VAL_INT;
574 default:
575 return -EINVAL;
576 }
577 }
578
bma180_write_raw(struct iio_dev * indio_dev,struct iio_chan_spec const * chan,int val,int val2,long mask)579 static int bma180_write_raw(struct iio_dev *indio_dev,
580 struct iio_chan_spec const *chan, int val, int val2, long mask)
581 {
582 struct bma180_data *data = iio_priv(indio_dev);
583 int ret;
584
585 switch (mask) {
586 case IIO_CHAN_INFO_SCALE:
587 if (val)
588 return -EINVAL;
589 mutex_lock(&data->mutex);
590 ret = bma180_set_scale(data, val2);
591 mutex_unlock(&data->mutex);
592 return ret;
593 case IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY:
594 if (val2)
595 return -EINVAL;
596 mutex_lock(&data->mutex);
597 ret = bma180_set_bw(data, val);
598 mutex_unlock(&data->mutex);
599 return ret;
600 default:
601 return -EINVAL;
602 }
603 }
604
605 static const struct iio_info bma180_info = {
606 .attrs = &bma180_attrs_group,
607 .read_raw = bma180_read_raw,
608 .write_raw = bma180_write_raw,
609 };
610
611 static const char * const bma180_power_modes[] = { "low_noise", "low_power" };
612
bma180_get_power_mode(struct iio_dev * indio_dev,const struct iio_chan_spec * chan)613 static int bma180_get_power_mode(struct iio_dev *indio_dev,
614 const struct iio_chan_spec *chan)
615 {
616 struct bma180_data *data = iio_priv(indio_dev);
617
618 return data->pmode;
619 }
620
bma180_set_power_mode(struct iio_dev * indio_dev,const struct iio_chan_spec * chan,unsigned int mode)621 static int bma180_set_power_mode(struct iio_dev *indio_dev,
622 const struct iio_chan_spec *chan, unsigned int mode)
623 {
624 struct bma180_data *data = iio_priv(indio_dev);
625 int ret;
626
627 mutex_lock(&data->mutex);
628 ret = bma180_set_pmode(data, mode);
629 mutex_unlock(&data->mutex);
630
631 return ret;
632 }
633
634 static const struct iio_mount_matrix *
bma180_accel_get_mount_matrix(const struct iio_dev * indio_dev,const struct iio_chan_spec * chan)635 bma180_accel_get_mount_matrix(const struct iio_dev *indio_dev,
636 const struct iio_chan_spec *chan)
637 {
638 struct bma180_data *data = iio_priv(indio_dev);
639
640 return &data->orientation;
641 }
642
643 static const struct iio_enum bma180_power_mode_enum = {
644 .items = bma180_power_modes,
645 .num_items = ARRAY_SIZE(bma180_power_modes),
646 .get = bma180_get_power_mode,
647 .set = bma180_set_power_mode,
648 };
649
650 static const struct iio_chan_spec_ext_info bma023_ext_info[] = {
651 IIO_MOUNT_MATRIX(IIO_SHARED_BY_DIR, bma180_accel_get_mount_matrix),
652 { }
653 };
654
655 static const struct iio_chan_spec_ext_info bma180_ext_info[] = {
656 IIO_ENUM("power_mode", IIO_SHARED_BY_TYPE, &bma180_power_mode_enum),
657 IIO_ENUM_AVAILABLE("power_mode", IIO_SHARED_BY_TYPE, &bma180_power_mode_enum),
658 IIO_MOUNT_MATRIX(IIO_SHARED_BY_DIR, bma180_accel_get_mount_matrix),
659 { }
660 };
661
662 #define BMA023_ACC_CHANNEL(_axis, _bits) { \
663 .type = IIO_ACCEL, \
664 .modified = 1, \
665 .channel2 = IIO_MOD_##_axis, \
666 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
667 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
668 BIT(IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY), \
669 .scan_index = AXIS_##_axis, \
670 .scan_type = { \
671 .sign = 's', \
672 .realbits = _bits, \
673 .storagebits = 16, \
674 .shift = 16 - _bits, \
675 }, \
676 .ext_info = bma023_ext_info, \
677 }
678
679 #define BMA150_TEMP_CHANNEL { \
680 .type = IIO_TEMP, \
681 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
682 BIT(IIO_CHAN_INFO_SCALE) | BIT(IIO_CHAN_INFO_OFFSET), \
683 .scan_index = TEMP, \
684 .scan_type = { \
685 .sign = 'u', \
686 .realbits = 8, \
687 .storagebits = 16, \
688 }, \
689 }
690
691 #define BMA180_ACC_CHANNEL(_axis, _bits) { \
692 .type = IIO_ACCEL, \
693 .modified = 1, \
694 .channel2 = IIO_MOD_##_axis, \
695 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
696 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
697 BIT(IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY), \
698 .scan_index = AXIS_##_axis, \
699 .scan_type = { \
700 .sign = 's', \
701 .realbits = _bits, \
702 .storagebits = 16, \
703 .shift = 16 - _bits, \
704 }, \
705 .ext_info = bma180_ext_info, \
706 }
707
708 #define BMA180_TEMP_CHANNEL { \
709 .type = IIO_TEMP, \
710 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
711 BIT(IIO_CHAN_INFO_SCALE) | BIT(IIO_CHAN_INFO_OFFSET), \
712 .scan_index = TEMP, \
713 .scan_type = { \
714 .sign = 's', \
715 .realbits = 8, \
716 .storagebits = 16, \
717 }, \
718 }
719
720 static const struct iio_chan_spec bma023_channels[] = {
721 BMA023_ACC_CHANNEL(X, 10),
722 BMA023_ACC_CHANNEL(Y, 10),
723 BMA023_ACC_CHANNEL(Z, 10),
724 IIO_CHAN_SOFT_TIMESTAMP(4),
725 };
726
727 static const struct iio_chan_spec bma150_channels[] = {
728 BMA023_ACC_CHANNEL(X, 10),
729 BMA023_ACC_CHANNEL(Y, 10),
730 BMA023_ACC_CHANNEL(Z, 10),
731 BMA150_TEMP_CHANNEL,
732 IIO_CHAN_SOFT_TIMESTAMP(4),
733 };
734
735 static const struct iio_chan_spec bma180_channels[] = {
736 BMA180_ACC_CHANNEL(X, 14),
737 BMA180_ACC_CHANNEL(Y, 14),
738 BMA180_ACC_CHANNEL(Z, 14),
739 BMA180_TEMP_CHANNEL,
740 IIO_CHAN_SOFT_TIMESTAMP(4),
741 };
742
743 static const struct iio_chan_spec bma250_channels[] = {
744 BMA180_ACC_CHANNEL(X, 10),
745 BMA180_ACC_CHANNEL(Y, 10),
746 BMA180_ACC_CHANNEL(Z, 10),
747 BMA180_TEMP_CHANNEL,
748 IIO_CHAN_SOFT_TIMESTAMP(4),
749 };
750
751 static const struct bma180_part_info bma180_part_info[] = {
752 [BMA023] = {
753 .chip_id = BMA023_ID_REG_VAL,
754 .channels = bma023_channels,
755 .num_channels = ARRAY_SIZE(bma023_channels),
756 .scale_table = bma023_scale_table,
757 .num_scales = ARRAY_SIZE(bma023_scale_table),
758 .bw_table = bma023_bw_table,
759 .num_bw = ARRAY_SIZE(bma023_bw_table),
760 /* No temperature channel */
761 .temp_offset = 0,
762 .int_reset_reg = BMA023_CTRL_REG0,
763 .int_reset_mask = BMA023_INT_RESET_MASK,
764 .sleep_reg = BMA023_CTRL_REG0,
765 .sleep_mask = BMA023_SLEEP,
766 .bw_reg = BMA023_CTRL_REG2,
767 .bw_mask = BMA023_BW_MASK,
768 .scale_reg = BMA023_CTRL_REG2,
769 .scale_mask = BMA023_RANGE_MASK,
770 /* No power mode on bma023 */
771 .power_reg = 0,
772 .power_mask = 0,
773 .lowpower_val = 0,
774 .int_enable_reg = BMA023_CTRL_REG3,
775 .int_enable_mask = BMA023_NEW_DATA_INT,
776 .softreset_reg = BMA023_CTRL_REG0,
777 .softreset_val = BMA023_RESET_VAL,
778 .chip_config = bma023_chip_config,
779 .chip_disable = bma023_chip_disable,
780 },
781 [BMA150] = {
782 .chip_id = BMA023_ID_REG_VAL,
783 .channels = bma150_channels,
784 .num_channels = ARRAY_SIZE(bma150_channels),
785 .scale_table = bma023_scale_table,
786 .num_scales = ARRAY_SIZE(bma023_scale_table),
787 .bw_table = bma023_bw_table,
788 .num_bw = ARRAY_SIZE(bma023_bw_table),
789 .temp_offset = -60, /* 0 LSB @ -30 degree C */
790 .int_reset_reg = BMA023_CTRL_REG0,
791 .int_reset_mask = BMA023_INT_RESET_MASK,
792 .sleep_reg = BMA023_CTRL_REG0,
793 .sleep_mask = BMA023_SLEEP,
794 .bw_reg = BMA023_CTRL_REG2,
795 .bw_mask = BMA023_BW_MASK,
796 .scale_reg = BMA023_CTRL_REG2,
797 .scale_mask = BMA023_RANGE_MASK,
798 /* No power mode on bma150 */
799 .power_reg = 0,
800 .power_mask = 0,
801 .lowpower_val = 0,
802 .int_enable_reg = BMA023_CTRL_REG3,
803 .int_enable_mask = BMA023_NEW_DATA_INT,
804 .softreset_reg = BMA023_CTRL_REG0,
805 .softreset_val = BMA023_RESET_VAL,
806 .chip_config = bma023_chip_config,
807 .chip_disable = bma023_chip_disable,
808 },
809 [BMA180] = {
810 .chip_id = BMA180_ID_REG_VAL,
811 .channels = bma180_channels,
812 .num_channels = ARRAY_SIZE(bma180_channels),
813 .scale_table = bma180_scale_table,
814 .num_scales = ARRAY_SIZE(bma180_scale_table),
815 .bw_table = bma180_bw_table,
816 .num_bw = ARRAY_SIZE(bma180_bw_table),
817 .temp_offset = 48, /* 0 LSB @ 24 degree C */
818 .int_reset_reg = BMA180_CTRL_REG0,
819 .int_reset_mask = BMA180_RESET_INT,
820 .sleep_reg = BMA180_CTRL_REG0,
821 .sleep_mask = BMA180_SLEEP,
822 .bw_reg = BMA180_BW_TCS,
823 .bw_mask = BMA180_BW,
824 .scale_reg = BMA180_OFFSET_LSB1,
825 .scale_mask = BMA180_RANGE,
826 .power_reg = BMA180_TCO_Z,
827 .power_mask = BMA180_MODE_CONFIG,
828 .lowpower_val = BMA180_LOW_POWER,
829 .int_enable_reg = BMA180_CTRL_REG3,
830 .int_enable_mask = BMA180_NEW_DATA_INT,
831 .softreset_reg = BMA180_RESET,
832 .softreset_val = BMA180_RESET_VAL,
833 .chip_config = bma180_chip_config,
834 .chip_disable = bma180_chip_disable,
835 },
836 [BMA250] = {
837 .chip_id = BMA250_ID_REG_VAL,
838 .channels = bma250_channels,
839 .num_channels = ARRAY_SIZE(bma250_channels),
840 .scale_table = bma250_scale_table,
841 .num_scales = ARRAY_SIZE(bma250_scale_table),
842 .bw_table = bma250_bw_table,
843 .num_bw = ARRAY_SIZE(bma250_bw_table),
844 .temp_offset = 48, /* 0 LSB @ 24 degree C */
845 .int_reset_reg = BMA250_INT_RESET_REG,
846 .int_reset_mask = BMA250_INT_RESET_MASK,
847 .sleep_reg = BMA250_POWER_REG,
848 .sleep_mask = BMA250_SUSPEND_MASK,
849 .bw_reg = BMA250_BW_REG,
850 .bw_mask = BMA250_BW_MASK,
851 .bw_offset = BMA250_BW_OFFSET,
852 .scale_reg = BMA250_RANGE_REG,
853 .scale_mask = BMA250_RANGE_MASK,
854 .power_reg = BMA250_POWER_REG,
855 .power_mask = BMA250_LOWPOWER_MASK,
856 .lowpower_val = 1,
857 .int_enable_reg = BMA250_INT_ENABLE_REG,
858 .int_enable_mask = BMA250_DATA_INTEN_MASK,
859 .softreset_reg = BMA250_RESET_REG,
860 .softreset_val = BMA180_RESET_VAL,
861 .chip_config = bma250_chip_config,
862 .chip_disable = bma250_chip_disable,
863 },
864 };
865
bma180_trigger_handler(int irq,void * p)866 static irqreturn_t bma180_trigger_handler(int irq, void *p)
867 {
868 struct iio_poll_func *pf = p;
869 struct iio_dev *indio_dev = pf->indio_dev;
870 struct bma180_data *data = iio_priv(indio_dev);
871 s64 time_ns = iio_get_time_ns(indio_dev);
872 int bit, ret, i = 0;
873
874 mutex_lock(&data->mutex);
875
876 iio_for_each_active_channel(indio_dev, bit) {
877 ret = bma180_get_data_reg(data, bit);
878 if (ret < 0) {
879 mutex_unlock(&data->mutex);
880 goto err;
881 }
882 data->scan.chan[i++] = ret;
883 }
884
885 mutex_unlock(&data->mutex);
886
887 iio_push_to_buffers_with_ts(indio_dev, &data->scan, sizeof(data->scan), time_ns);
888 err:
889 iio_trigger_notify_done(indio_dev->trig);
890
891 return IRQ_HANDLED;
892 }
893
bma180_data_rdy_trigger_set_state(struct iio_trigger * trig,bool state)894 static int bma180_data_rdy_trigger_set_state(struct iio_trigger *trig,
895 bool state)
896 {
897 struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
898 struct bma180_data *data = iio_priv(indio_dev);
899
900 return bma180_set_new_data_intr_state(data, state);
901 }
902
bma180_trig_reen(struct iio_trigger * trig)903 static void bma180_trig_reen(struct iio_trigger *trig)
904 {
905 struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
906 struct bma180_data *data = iio_priv(indio_dev);
907 int ret;
908
909 ret = bma180_reset_intr(data);
910 if (ret)
911 dev_err(&data->client->dev, "failed to reset interrupt\n");
912 }
913
914 static const struct iio_trigger_ops bma180_trigger_ops = {
915 .set_trigger_state = bma180_data_rdy_trigger_set_state,
916 .reenable = bma180_trig_reen,
917 };
918
bma180_probe(struct i2c_client * client)919 static int bma180_probe(struct i2c_client *client)
920 {
921 const struct i2c_device_id *id = i2c_client_get_device_id(client);
922 struct device *dev = &client->dev;
923 struct bma180_data *data;
924 struct iio_dev *indio_dev;
925 int ret;
926
927 indio_dev = devm_iio_device_alloc(dev, sizeof(*data));
928 if (!indio_dev)
929 return -ENOMEM;
930
931 data = iio_priv(indio_dev);
932 i2c_set_clientdata(client, indio_dev);
933 data->client = client;
934 data->part_info = i2c_get_match_data(client);
935
936 ret = iio_read_mount_matrix(dev, &data->orientation);
937 if (ret)
938 return ret;
939
940 data->vdd_supply = devm_regulator_get(dev, "vdd");
941 if (IS_ERR(data->vdd_supply))
942 return dev_err_probe(dev, PTR_ERR(data->vdd_supply),
943 "Failed to get vdd regulator\n");
944
945 data->vddio_supply = devm_regulator_get(dev, "vddio");
946 if (IS_ERR(data->vddio_supply))
947 return dev_err_probe(dev, PTR_ERR(data->vddio_supply),
948 "Failed to get vddio regulator\n");
949
950 /* Typical voltage 2.4V these are min and max */
951 ret = regulator_set_voltage(data->vdd_supply, 1620000, 3600000);
952 if (ret)
953 return ret;
954 ret = regulator_set_voltage(data->vddio_supply, 1200000, 3600000);
955 if (ret)
956 return ret;
957 ret = regulator_enable(data->vdd_supply);
958 if (ret) {
959 dev_err(dev, "Failed to enable vdd regulator: %d\n", ret);
960 return ret;
961 }
962 ret = regulator_enable(data->vddio_supply);
963 if (ret) {
964 dev_err(dev, "Failed to enable vddio regulator: %d\n", ret);
965 goto err_disable_vdd;
966 }
967 /* Wait to make sure we started up properly (3 ms at least) */
968 usleep_range(3000, 5000);
969
970 ret = data->part_info->chip_config(data);
971 if (ret < 0)
972 goto err_chip_disable;
973
974 mutex_init(&data->mutex);
975 indio_dev->channels = data->part_info->channels;
976 indio_dev->num_channels = data->part_info->num_channels;
977 indio_dev->name = id->name;
978 indio_dev->modes = INDIO_DIRECT_MODE;
979 indio_dev->info = &bma180_info;
980
981 if (client->irq > 0) {
982 data->trig = iio_trigger_alloc(dev, "%s-dev%d", indio_dev->name,
983 iio_device_id(indio_dev));
984 if (!data->trig) {
985 ret = -ENOMEM;
986 goto err_chip_disable;
987 }
988
989 ret = devm_request_irq(dev, client->irq,
990 iio_trigger_generic_data_rdy_poll, IRQF_TRIGGER_RISING,
991 "bma180_event", data->trig);
992 if (ret) {
993 dev_err(dev, "unable to request IRQ\n");
994 goto err_trigger_free;
995 }
996
997 data->trig->ops = &bma180_trigger_ops;
998 iio_trigger_set_drvdata(data->trig, indio_dev);
999
1000 ret = iio_trigger_register(data->trig);
1001 if (ret)
1002 goto err_trigger_free;
1003
1004 indio_dev->trig = iio_trigger_get(data->trig);
1005 }
1006
1007 ret = iio_triggered_buffer_setup(indio_dev, NULL,
1008 bma180_trigger_handler, NULL);
1009 if (ret < 0) {
1010 dev_err(dev, "unable to setup iio triggered buffer\n");
1011 goto err_trigger_unregister;
1012 }
1013
1014 ret = iio_device_register(indio_dev);
1015 if (ret < 0) {
1016 dev_err(dev, "unable to register iio device\n");
1017 goto err_buffer_cleanup;
1018 }
1019
1020 return 0;
1021
1022 err_buffer_cleanup:
1023 iio_triggered_buffer_cleanup(indio_dev);
1024 err_trigger_unregister:
1025 if (data->trig)
1026 iio_trigger_unregister(data->trig);
1027 err_trigger_free:
1028 iio_trigger_free(data->trig);
1029 err_chip_disable:
1030 data->part_info->chip_disable(data);
1031 regulator_disable(data->vddio_supply);
1032 err_disable_vdd:
1033 regulator_disable(data->vdd_supply);
1034
1035 return ret;
1036 }
1037
bma180_remove(struct i2c_client * client)1038 static void bma180_remove(struct i2c_client *client)
1039 {
1040 struct iio_dev *indio_dev = i2c_get_clientdata(client);
1041 struct bma180_data *data = iio_priv(indio_dev);
1042
1043 iio_device_unregister(indio_dev);
1044 iio_triggered_buffer_cleanup(indio_dev);
1045 if (data->trig) {
1046 iio_trigger_unregister(data->trig);
1047 iio_trigger_free(data->trig);
1048 }
1049
1050 mutex_lock(&data->mutex);
1051 data->part_info->chip_disable(data);
1052 mutex_unlock(&data->mutex);
1053 regulator_disable(data->vddio_supply);
1054 regulator_disable(data->vdd_supply);
1055 }
1056
bma180_suspend(struct device * dev)1057 static int bma180_suspend(struct device *dev)
1058 {
1059 struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1060 struct bma180_data *data = iio_priv(indio_dev);
1061 int ret;
1062
1063 mutex_lock(&data->mutex);
1064 ret = bma180_set_sleep_state(data, true);
1065 mutex_unlock(&data->mutex);
1066
1067 return ret;
1068 }
1069
bma180_resume(struct device * dev)1070 static int bma180_resume(struct device *dev)
1071 {
1072 struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1073 struct bma180_data *data = iio_priv(indio_dev);
1074 int ret;
1075
1076 mutex_lock(&data->mutex);
1077 ret = bma180_set_sleep_state(data, false);
1078 mutex_unlock(&data->mutex);
1079
1080 return ret;
1081 }
1082
1083 static DEFINE_SIMPLE_DEV_PM_OPS(bma180_pm_ops, bma180_suspend, bma180_resume);
1084
1085 static const struct i2c_device_id bma180_ids[] = {
1086 { "bma023", (kernel_ulong_t)&bma180_part_info[BMA023] },
1087 { "bma150", (kernel_ulong_t)&bma180_part_info[BMA150] },
1088 { "bma180", (kernel_ulong_t)&bma180_part_info[BMA180] },
1089 { "bma250", (kernel_ulong_t)&bma180_part_info[BMA250] },
1090 { "smb380", (kernel_ulong_t)&bma180_part_info[BMA150] },
1091 { }
1092 };
1093
1094 MODULE_DEVICE_TABLE(i2c, bma180_ids);
1095
1096 static const struct of_device_id bma180_of_match[] = {
1097 {
1098 .compatible = "bosch,bma023",
1099 .data = &bma180_part_info[BMA023]
1100 },
1101 {
1102 .compatible = "bosch,bma150",
1103 .data = &bma180_part_info[BMA150]
1104 },
1105 {
1106 .compatible = "bosch,bma180",
1107 .data = &bma180_part_info[BMA180]
1108 },
1109 {
1110 .compatible = "bosch,bma250",
1111 .data = &bma180_part_info[BMA250]
1112 },
1113 {
1114 .compatible = "bosch,smb380",
1115 .data = &bma180_part_info[BMA150]
1116 },
1117 { }
1118 };
1119 MODULE_DEVICE_TABLE(of, bma180_of_match);
1120
1121 static struct i2c_driver bma180_driver = {
1122 .driver = {
1123 .name = "bma180",
1124 .pm = pm_sleep_ptr(&bma180_pm_ops),
1125 .of_match_table = bma180_of_match,
1126 },
1127 .probe = bma180_probe,
1128 .remove = bma180_remove,
1129 .id_table = bma180_ids,
1130 };
1131
1132 module_i2c_driver(bma180_driver);
1133
1134 MODULE_AUTHOR("Kravchenko Oleksandr <x0199363@ti.com>");
1135 MODULE_AUTHOR("Texas Instruments, Inc.");
1136 MODULE_DESCRIPTION("Bosch BMA023/BMA1x0/BMA250 triaxial acceleration sensor");
1137 MODULE_LICENSE("GPL");
1138