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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 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 * 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 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 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 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 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 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 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 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