1 /* 2 * bma180.c - IIO driver for Bosch BMA180 triaxial acceleration sensor 3 * 4 * Copyright 2013 Oleksandr Kravchenko <x0199363@ti.com> 5 * 6 * Support for BMA250 (c) Peter Meerwald <pmeerw@pmeerw.net> 7 * 8 * This file is subject to the terms and conditions of version 2 of 9 * the GNU General Public License. See the file COPYING in the main 10 * directory of this archive for more details. 11 * 12 * SPI is not supported by driver 13 * BMA180: 7-bit I2C slave address 0x40 or 0x41 14 * BMA250: 7-bit I2C slave address 0x18 or 0x19 15 */ 16 17 #include <linux/module.h> 18 #include <linux/i2c.h> 19 #include <linux/interrupt.h> 20 #include <linux/delay.h> 21 #include <linux/of_device.h> 22 #include <linux/of.h> 23 #include <linux/bitops.h> 24 #include <linux/slab.h> 25 #include <linux/string.h> 26 #include <linux/iio/iio.h> 27 #include <linux/iio/sysfs.h> 28 #include <linux/iio/buffer.h> 29 #include <linux/iio/trigger.h> 30 #include <linux/iio/trigger_consumer.h> 31 #include <linux/iio/triggered_buffer.h> 32 33 #define BMA180_DRV_NAME "bma180" 34 #define BMA180_IRQ_NAME "bma180_event" 35 36 enum chip_ids { 37 BMA180, 38 BMA250, 39 }; 40 41 struct bma180_data; 42 43 struct bma180_part_info { 44 const struct iio_chan_spec *channels; 45 unsigned int num_channels; 46 const int *scale_table; 47 unsigned int num_scales; 48 const int *bw_table; 49 unsigned int num_bw; 50 51 u8 int_reset_reg, int_reset_mask; 52 u8 sleep_reg, sleep_mask; 53 u8 bw_reg, bw_mask; 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; 58 59 int (*chip_config)(struct bma180_data *data); 60 void (*chip_disable)(struct bma180_data *data); 61 }; 62 63 /* Register set */ 64 #define BMA180_CHIP_ID 0x00 /* Need to distinguish BMA180 from other */ 65 #define BMA180_ACC_X_LSB 0x02 /* First of 6 registers of accel data */ 66 #define BMA180_TEMP 0x08 67 #define BMA180_CTRL_REG0 0x0d 68 #define BMA180_RESET 0x10 69 #define BMA180_BW_TCS 0x20 70 #define BMA180_CTRL_REG3 0x21 71 #define BMA180_TCO_Z 0x30 72 #define BMA180_OFFSET_LSB1 0x35 73 74 /* BMA180_CTRL_REG0 bits */ 75 #define BMA180_DIS_WAKE_UP BIT(0) /* Disable wake up mode */ 76 #define BMA180_SLEEP BIT(1) /* 1 - chip will sleep */ 77 #define BMA180_EE_W BIT(4) /* Unlock writing to addr from 0x20 */ 78 #define BMA180_RESET_INT BIT(6) /* Reset pending interrupts */ 79 80 /* BMA180_CTRL_REG3 bits */ 81 #define BMA180_NEW_DATA_INT BIT(1) /* Intr every new accel data is ready */ 82 83 /* BMA180_OFFSET_LSB1 skipping mode bit */ 84 #define BMA180_SMP_SKIP BIT(0) 85 86 /* Bit masks for registers bit fields */ 87 #define BMA180_RANGE 0x0e /* Range of measured accel values */ 88 #define BMA180_BW 0xf0 /* Accel bandwidth */ 89 #define BMA180_MODE_CONFIG 0x03 /* Config operation modes */ 90 91 /* We have to write this value in reset register to do soft reset */ 92 #define BMA180_RESET_VAL 0xb6 93 94 #define BMA180_ID_REG_VAL 0x03 95 96 /* Chip power modes */ 97 #define BMA180_LOW_POWER 0x03 98 99 #define BMA250_RANGE_REG 0x0f 100 #define BMA250_BW_REG 0x10 101 #define BMA250_POWER_REG 0x11 102 #define BMA250_RESET_REG 0x14 103 #define BMA250_INT_ENABLE_REG 0x17 104 #define BMA250_INT_MAP_REG 0x1a 105 #define BMA250_INT_RESET_REG 0x21 106 107 #define BMA250_RANGE_MASK GENMASK(3, 0) /* Range of accel values */ 108 #define BMA250_BW_MASK GENMASK(4, 0) /* Accel bandwidth */ 109 #define BMA250_SUSPEND_MASK BIT(7) /* chip will sleep */ 110 #define BMA250_LOWPOWER_MASK BIT(6) 111 #define BMA250_DATA_INTEN_MASK BIT(4) 112 #define BMA250_INT1_DATA_MASK BIT(0) 113 #define BMA250_INT_RESET_MASK BIT(7) /* Reset pending interrupts */ 114 115 struct bma180_data { 116 struct i2c_client *client; 117 struct iio_trigger *trig; 118 const struct bma180_part_info *part_info; 119 struct mutex mutex; 120 bool sleep_state; 121 int scale; 122 int bw; 123 bool pmode; 124 u8 buff[16]; /* 3x 16-bit + 8-bit + padding + timestamp */ 125 }; 126 127 enum bma180_chan { 128 AXIS_X, 129 AXIS_Y, 130 AXIS_Z, 131 TEMP 132 }; 133 134 static int bma180_bw_table[] = { 10, 20, 40, 75, 150, 300 }; /* Hz */ 135 static int bma180_scale_table[] = { 1275, 1863, 2452, 3727, 4903, 9709, 19417 }; 136 137 static int bma250_bw_table[] = { 8, 16, 31, 63, 125, 250 }; /* Hz */ 138 static int bma250_scale_table[] = { 0, 0, 0, 38344, 0, 76590, 0, 0, 153180, 0, 139 0, 0, 306458 }; 140 141 static int bma180_get_data_reg(struct bma180_data *data, enum bma180_chan chan) 142 { 143 int ret; 144 145 if (data->sleep_state) 146 return -EBUSY; 147 148 switch (chan) { 149 case TEMP: 150 ret = i2c_smbus_read_byte_data(data->client, BMA180_TEMP); 151 if (ret < 0) 152 dev_err(&data->client->dev, "failed to read temp register\n"); 153 break; 154 default: 155 ret = i2c_smbus_read_word_data(data->client, 156 BMA180_ACC_X_LSB + chan * 2); 157 if (ret < 0) 158 dev_err(&data->client->dev, 159 "failed to read accel_%c register\n", 160 'x' + chan); 161 } 162 163 return ret; 164 } 165 166 static int bma180_set_bits(struct bma180_data *data, u8 reg, u8 mask, u8 val) 167 { 168 int ret = i2c_smbus_read_byte_data(data->client, reg); 169 u8 reg_val = (ret & ~mask) | (val << (ffs(mask) - 1)); 170 171 if (ret < 0) 172 return ret; 173 174 return i2c_smbus_write_byte_data(data->client, reg, reg_val); 175 } 176 177 static int bma180_reset_intr(struct bma180_data *data) 178 { 179 int ret = bma180_set_bits(data, data->part_info->int_reset_reg, 180 data->part_info->int_reset_mask, 1); 181 182 if (ret) 183 dev_err(&data->client->dev, "failed to reset interrupt\n"); 184 185 return ret; 186 } 187 188 static int bma180_set_new_data_intr_state(struct bma180_data *data, bool state) 189 { 190 int ret = bma180_set_bits(data, data->part_info->int_enable_reg, 191 data->part_info->int_enable_mask, state); 192 if (ret) 193 goto err; 194 ret = bma180_reset_intr(data); 195 if (ret) 196 goto err; 197 198 return 0; 199 200 err: 201 dev_err(&data->client->dev, 202 "failed to set new data interrupt state %d\n", state); 203 return ret; 204 } 205 206 static int bma180_set_sleep_state(struct bma180_data *data, bool state) 207 { 208 int ret = bma180_set_bits(data, data->part_info->sleep_reg, 209 data->part_info->sleep_mask, state); 210 211 if (ret) { 212 dev_err(&data->client->dev, 213 "failed to set sleep state %d\n", state); 214 return ret; 215 } 216 data->sleep_state = state; 217 218 return 0; 219 } 220 221 static int bma180_set_ee_writing_state(struct bma180_data *data, bool state) 222 { 223 int ret = bma180_set_bits(data, BMA180_CTRL_REG0, BMA180_EE_W, state); 224 225 if (ret) 226 dev_err(&data->client->dev, 227 "failed to set ee writing state %d\n", state); 228 229 return ret; 230 } 231 232 static int bma180_set_bw(struct bma180_data *data, int val) 233 { 234 int ret, i; 235 236 if (data->sleep_state) 237 return -EBUSY; 238 239 for (i = 0; i < data->part_info->num_bw; ++i) { 240 if (data->part_info->bw_table[i] == val) { 241 ret = bma180_set_bits(data, data->part_info->bw_reg, 242 data->part_info->bw_mask, i); 243 if (ret) { 244 dev_err(&data->client->dev, 245 "failed to set bandwidth\n"); 246 return ret; 247 } 248 data->bw = val; 249 return 0; 250 } 251 } 252 253 return -EINVAL; 254 } 255 256 static int bma180_set_scale(struct bma180_data *data, int val) 257 { 258 int ret, i; 259 260 if (data->sleep_state) 261 return -EBUSY; 262 263 for (i = 0; i < data->part_info->num_scales; ++i) 264 if (data->part_info->scale_table[i] == val) { 265 ret = bma180_set_bits(data, data->part_info->scale_reg, 266 data->part_info->scale_mask, i); 267 if (ret) { 268 dev_err(&data->client->dev, 269 "failed to set scale\n"); 270 return ret; 271 } 272 data->scale = val; 273 return 0; 274 } 275 276 return -EINVAL; 277 } 278 279 static int bma180_set_pmode(struct bma180_data *data, bool mode) 280 { 281 u8 reg_val = mode ? data->part_info->lowpower_val : 0; 282 int ret = bma180_set_bits(data, data->part_info->power_reg, 283 data->part_info->power_mask, reg_val); 284 285 if (ret) { 286 dev_err(&data->client->dev, "failed to set power mode\n"); 287 return ret; 288 } 289 data->pmode = mode; 290 291 return 0; 292 } 293 294 static int bma180_soft_reset(struct bma180_data *data) 295 { 296 int ret = i2c_smbus_write_byte_data(data->client, 297 data->part_info->softreset_reg, BMA180_RESET_VAL); 298 299 if (ret) 300 dev_err(&data->client->dev, "failed to reset the chip\n"); 301 302 return ret; 303 } 304 305 static int bma180_chip_init(struct bma180_data *data) 306 { 307 /* Try to read chip_id register. It must return 0x03. */ 308 int ret = i2c_smbus_read_byte_data(data->client, BMA180_CHIP_ID); 309 310 if (ret < 0) 311 return ret; 312 if (ret != BMA180_ID_REG_VAL) 313 return -ENODEV; 314 315 ret = bma180_soft_reset(data); 316 if (ret) 317 return ret; 318 /* 319 * No serial transaction should occur within minimum 10 us 320 * after soft_reset command 321 */ 322 msleep(20); 323 324 ret = bma180_set_new_data_intr_state(data, false); 325 if (ret) 326 return ret; 327 328 return bma180_set_pmode(data, false); 329 } 330 331 static int bma180_chip_config(struct bma180_data *data) 332 { 333 int ret = bma180_chip_init(data); 334 335 if (ret) 336 goto err; 337 ret = bma180_set_bits(data, BMA180_CTRL_REG0, BMA180_DIS_WAKE_UP, 1); 338 if (ret) 339 goto err; 340 ret = bma180_set_ee_writing_state(data, true); 341 if (ret) 342 goto err; 343 ret = bma180_set_bits(data, BMA180_OFFSET_LSB1, BMA180_SMP_SKIP, 1); 344 if (ret) 345 goto err; 346 ret = bma180_set_bw(data, 20); /* 20 Hz */ 347 if (ret) 348 goto err; 349 ret = bma180_set_scale(data, 2452); /* 2 G */ 350 if (ret) 351 goto err; 352 353 return 0; 354 355 err: 356 dev_err(&data->client->dev, "failed to config the chip\n"); 357 return ret; 358 } 359 360 static int bma250_chip_config(struct bma180_data *data) 361 { 362 int ret = bma180_chip_init(data); 363 364 if (ret) 365 goto err; 366 ret = bma180_set_bw(data, 16); /* 16 Hz */ 367 if (ret) 368 goto err; 369 ret = bma180_set_scale(data, 38344); /* 2 G */ 370 if (ret) 371 goto err; 372 ret = bma180_set_bits(data, BMA250_INT_MAP_REG, 373 BMA250_INT1_DATA_MASK, 1); 374 if (ret) 375 goto err; 376 377 return 0; 378 379 err: 380 dev_err(&data->client->dev, "failed to config the chip\n"); 381 return ret; 382 } 383 384 static void bma180_chip_disable(struct bma180_data *data) 385 { 386 if (bma180_set_new_data_intr_state(data, false)) 387 goto err; 388 if (bma180_set_ee_writing_state(data, false)) 389 goto err; 390 if (bma180_set_sleep_state(data, true)) 391 goto err; 392 393 return; 394 395 err: 396 dev_err(&data->client->dev, "failed to disable the chip\n"); 397 } 398 399 static void bma250_chip_disable(struct bma180_data *data) 400 { 401 if (bma180_set_new_data_intr_state(data, false)) 402 goto err; 403 if (bma180_set_sleep_state(data, true)) 404 goto err; 405 406 return; 407 408 err: 409 dev_err(&data->client->dev, "failed to disable the chip\n"); 410 } 411 412 static ssize_t bma180_show_avail(char *buf, const int *vals, unsigned int n, 413 bool micros) 414 { 415 size_t len = 0; 416 int i; 417 418 for (i = 0; i < n; i++) { 419 if (!vals[i]) 420 continue; 421 len += scnprintf(buf + len, PAGE_SIZE - len, 422 micros ? "0.%06d " : "%d ", vals[i]); 423 } 424 buf[len - 1] = '\n'; 425 426 return len; 427 } 428 429 static ssize_t bma180_show_filter_freq_avail(struct device *dev, 430 struct device_attribute *attr, char *buf) 431 { 432 struct bma180_data *data = iio_priv(dev_to_iio_dev(dev)); 433 434 return bma180_show_avail(buf, data->part_info->bw_table, 435 data->part_info->num_bw, false); 436 } 437 438 static ssize_t bma180_show_scale_avail(struct device *dev, 439 struct device_attribute *attr, char *buf) 440 { 441 struct bma180_data *data = iio_priv(dev_to_iio_dev(dev)); 442 443 return bma180_show_avail(buf, data->part_info->scale_table, 444 data->part_info->num_scales, true); 445 } 446 447 static IIO_DEVICE_ATTR(in_accel_filter_low_pass_3db_frequency_available, 448 S_IRUGO, bma180_show_filter_freq_avail, NULL, 0); 449 450 static IIO_DEVICE_ATTR(in_accel_scale_available, 451 S_IRUGO, bma180_show_scale_avail, NULL, 0); 452 453 static struct attribute *bma180_attributes[] = { 454 &iio_dev_attr_in_accel_filter_low_pass_3db_frequency_available. 455 dev_attr.attr, 456 &iio_dev_attr_in_accel_scale_available.dev_attr.attr, 457 NULL, 458 }; 459 460 static const struct attribute_group bma180_attrs_group = { 461 .attrs = bma180_attributes, 462 }; 463 464 static int bma180_read_raw(struct iio_dev *indio_dev, 465 struct iio_chan_spec const *chan, int *val, int *val2, 466 long mask) 467 { 468 struct bma180_data *data = iio_priv(indio_dev); 469 int ret; 470 471 switch (mask) { 472 case IIO_CHAN_INFO_RAW: 473 ret = iio_device_claim_direct_mode(indio_dev); 474 if (ret) 475 return ret; 476 477 mutex_lock(&data->mutex); 478 ret = bma180_get_data_reg(data, chan->scan_index); 479 mutex_unlock(&data->mutex); 480 iio_device_release_direct_mode(indio_dev); 481 if (ret < 0) 482 return ret; 483 *val = sign_extend32(ret >> chan->scan_type.shift, 484 chan->scan_type.realbits - 1); 485 return IIO_VAL_INT; 486 case IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY: 487 *val = data->bw; 488 return IIO_VAL_INT; 489 case IIO_CHAN_INFO_SCALE: 490 switch (chan->type) { 491 case IIO_ACCEL: 492 *val = 0; 493 *val2 = data->scale; 494 return IIO_VAL_INT_PLUS_MICRO; 495 case IIO_TEMP: 496 *val = 500; 497 return IIO_VAL_INT; 498 default: 499 return -EINVAL; 500 } 501 case IIO_CHAN_INFO_OFFSET: 502 *val = 48; /* 0 LSB @ 24 degree C */ 503 return IIO_VAL_INT; 504 default: 505 return -EINVAL; 506 } 507 } 508 509 static int bma180_write_raw(struct iio_dev *indio_dev, 510 struct iio_chan_spec const *chan, int val, int val2, long mask) 511 { 512 struct bma180_data *data = iio_priv(indio_dev); 513 int ret; 514 515 switch (mask) { 516 case IIO_CHAN_INFO_SCALE: 517 if (val) 518 return -EINVAL; 519 mutex_lock(&data->mutex); 520 ret = bma180_set_scale(data, val2); 521 mutex_unlock(&data->mutex); 522 return ret; 523 case IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY: 524 if (val2) 525 return -EINVAL; 526 mutex_lock(&data->mutex); 527 ret = bma180_set_bw(data, val); 528 mutex_unlock(&data->mutex); 529 return ret; 530 default: 531 return -EINVAL; 532 } 533 } 534 535 static const struct iio_info bma180_info = { 536 .attrs = &bma180_attrs_group, 537 .read_raw = bma180_read_raw, 538 .write_raw = bma180_write_raw, 539 .driver_module = THIS_MODULE, 540 }; 541 542 static const char * const bma180_power_modes[] = { "low_noise", "low_power" }; 543 544 static int bma180_get_power_mode(struct iio_dev *indio_dev, 545 const struct iio_chan_spec *chan) 546 { 547 struct bma180_data *data = iio_priv(indio_dev); 548 549 return data->pmode; 550 } 551 552 static int bma180_set_power_mode(struct iio_dev *indio_dev, 553 const struct iio_chan_spec *chan, unsigned int mode) 554 { 555 struct bma180_data *data = iio_priv(indio_dev); 556 int ret; 557 558 mutex_lock(&data->mutex); 559 ret = bma180_set_pmode(data, mode); 560 mutex_unlock(&data->mutex); 561 562 return ret; 563 } 564 565 static const struct iio_enum bma180_power_mode_enum = { 566 .items = bma180_power_modes, 567 .num_items = ARRAY_SIZE(bma180_power_modes), 568 .get = bma180_get_power_mode, 569 .set = bma180_set_power_mode, 570 }; 571 572 static const struct iio_chan_spec_ext_info bma180_ext_info[] = { 573 IIO_ENUM("power_mode", true, &bma180_power_mode_enum), 574 IIO_ENUM_AVAILABLE("power_mode", &bma180_power_mode_enum), 575 { }, 576 }; 577 578 #define BMA180_ACC_CHANNEL(_axis, _bits) { \ 579 .type = IIO_ACCEL, \ 580 .modified = 1, \ 581 .channel2 = IIO_MOD_##_axis, \ 582 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \ 583 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \ 584 BIT(IIO_CHAN_INFO_LOW_PASS_FILTER_3DB_FREQUENCY), \ 585 .scan_index = AXIS_##_axis, \ 586 .scan_type = { \ 587 .sign = 's', \ 588 .realbits = _bits, \ 589 .storagebits = 16, \ 590 .shift = 16 - _bits, \ 591 }, \ 592 .ext_info = bma180_ext_info, \ 593 } 594 595 #define BMA180_TEMP_CHANNEL { \ 596 .type = IIO_TEMP, \ 597 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ 598 BIT(IIO_CHAN_INFO_SCALE) | BIT(IIO_CHAN_INFO_OFFSET), \ 599 .scan_index = TEMP, \ 600 .scan_type = { \ 601 .sign = 's', \ 602 .realbits = 8, \ 603 .storagebits = 16, \ 604 }, \ 605 } 606 607 static const struct iio_chan_spec bma180_channels[] = { 608 BMA180_ACC_CHANNEL(X, 14), 609 BMA180_ACC_CHANNEL(Y, 14), 610 BMA180_ACC_CHANNEL(Z, 14), 611 BMA180_TEMP_CHANNEL, 612 IIO_CHAN_SOFT_TIMESTAMP(4), 613 }; 614 615 static const struct iio_chan_spec bma250_channels[] = { 616 BMA180_ACC_CHANNEL(X, 10), 617 BMA180_ACC_CHANNEL(Y, 10), 618 BMA180_ACC_CHANNEL(Z, 10), 619 BMA180_TEMP_CHANNEL, 620 IIO_CHAN_SOFT_TIMESTAMP(4), 621 }; 622 623 static const struct bma180_part_info bma180_part_info[] = { 624 [BMA180] = { 625 bma180_channels, ARRAY_SIZE(bma180_channels), 626 bma180_scale_table, ARRAY_SIZE(bma180_scale_table), 627 bma180_bw_table, ARRAY_SIZE(bma180_bw_table), 628 BMA180_CTRL_REG0, BMA180_RESET_INT, 629 BMA180_CTRL_REG0, BMA180_SLEEP, 630 BMA180_BW_TCS, BMA180_BW, 631 BMA180_OFFSET_LSB1, BMA180_RANGE, 632 BMA180_TCO_Z, BMA180_MODE_CONFIG, BMA180_LOW_POWER, 633 BMA180_CTRL_REG3, BMA180_NEW_DATA_INT, 634 BMA180_RESET, 635 bma180_chip_config, 636 bma180_chip_disable, 637 }, 638 [BMA250] = { 639 bma250_channels, ARRAY_SIZE(bma250_channels), 640 bma250_scale_table, ARRAY_SIZE(bma250_scale_table), 641 bma250_bw_table, ARRAY_SIZE(bma250_bw_table), 642 BMA250_INT_RESET_REG, BMA250_INT_RESET_MASK, 643 BMA250_POWER_REG, BMA250_SUSPEND_MASK, 644 BMA250_BW_REG, BMA250_BW_MASK, 645 BMA250_RANGE_REG, BMA250_RANGE_MASK, 646 BMA250_POWER_REG, BMA250_LOWPOWER_MASK, 1, 647 BMA250_INT_ENABLE_REG, BMA250_DATA_INTEN_MASK, 648 BMA250_RESET_REG, 649 bma250_chip_config, 650 bma250_chip_disable, 651 }, 652 }; 653 654 static irqreturn_t bma180_trigger_handler(int irq, void *p) 655 { 656 struct iio_poll_func *pf = p; 657 struct iio_dev *indio_dev = pf->indio_dev; 658 struct bma180_data *data = iio_priv(indio_dev); 659 s64 time_ns = iio_get_time_ns(indio_dev); 660 int bit, ret, i = 0; 661 662 mutex_lock(&data->mutex); 663 664 for_each_set_bit(bit, indio_dev->active_scan_mask, 665 indio_dev->masklength) { 666 ret = bma180_get_data_reg(data, bit); 667 if (ret < 0) { 668 mutex_unlock(&data->mutex); 669 goto err; 670 } 671 ((s16 *)data->buff)[i++] = ret; 672 } 673 674 mutex_unlock(&data->mutex); 675 676 iio_push_to_buffers_with_timestamp(indio_dev, data->buff, time_ns); 677 err: 678 iio_trigger_notify_done(indio_dev->trig); 679 680 return IRQ_HANDLED; 681 } 682 683 static int bma180_data_rdy_trigger_set_state(struct iio_trigger *trig, 684 bool state) 685 { 686 struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); 687 struct bma180_data *data = iio_priv(indio_dev); 688 689 return bma180_set_new_data_intr_state(data, state); 690 } 691 692 static int bma180_trig_try_reen(struct iio_trigger *trig) 693 { 694 struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); 695 struct bma180_data *data = iio_priv(indio_dev); 696 697 return bma180_reset_intr(data); 698 } 699 700 static const struct iio_trigger_ops bma180_trigger_ops = { 701 .set_trigger_state = bma180_data_rdy_trigger_set_state, 702 .try_reenable = bma180_trig_try_reen, 703 .owner = THIS_MODULE, 704 }; 705 706 static int bma180_probe(struct i2c_client *client, 707 const struct i2c_device_id *id) 708 { 709 struct bma180_data *data; 710 struct iio_dev *indio_dev; 711 enum chip_ids chip; 712 int ret; 713 714 indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 715 if (!indio_dev) 716 return -ENOMEM; 717 718 data = iio_priv(indio_dev); 719 i2c_set_clientdata(client, indio_dev); 720 data->client = client; 721 if (client->dev.of_node) 722 chip = (enum chip_ids)of_device_get_match_data(&client->dev); 723 else 724 chip = id->driver_data; 725 data->part_info = &bma180_part_info[chip]; 726 727 ret = data->part_info->chip_config(data); 728 if (ret < 0) 729 goto err_chip_disable; 730 731 mutex_init(&data->mutex); 732 indio_dev->dev.parent = &client->dev; 733 indio_dev->channels = data->part_info->channels; 734 indio_dev->num_channels = data->part_info->num_channels; 735 indio_dev->name = id->name; 736 indio_dev->modes = INDIO_DIRECT_MODE; 737 indio_dev->info = &bma180_info; 738 739 if (client->irq > 0) { 740 data->trig = iio_trigger_alloc("%s-dev%d", indio_dev->name, 741 indio_dev->id); 742 if (!data->trig) { 743 ret = -ENOMEM; 744 goto err_chip_disable; 745 } 746 747 ret = devm_request_irq(&client->dev, client->irq, 748 iio_trigger_generic_data_rdy_poll, IRQF_TRIGGER_RISING, 749 "bma180_event", data->trig); 750 if (ret) { 751 dev_err(&client->dev, "unable to request IRQ\n"); 752 goto err_trigger_free; 753 } 754 755 data->trig->dev.parent = &client->dev; 756 data->trig->ops = &bma180_trigger_ops; 757 iio_trigger_set_drvdata(data->trig, indio_dev); 758 indio_dev->trig = iio_trigger_get(data->trig); 759 760 ret = iio_trigger_register(data->trig); 761 if (ret) 762 goto err_trigger_free; 763 } 764 765 ret = iio_triggered_buffer_setup(indio_dev, NULL, 766 bma180_trigger_handler, NULL); 767 if (ret < 0) { 768 dev_err(&client->dev, "unable to setup iio triggered buffer\n"); 769 goto err_trigger_unregister; 770 } 771 772 ret = iio_device_register(indio_dev); 773 if (ret < 0) { 774 dev_err(&client->dev, "unable to register iio device\n"); 775 goto err_buffer_cleanup; 776 } 777 778 return 0; 779 780 err_buffer_cleanup: 781 iio_triggered_buffer_cleanup(indio_dev); 782 err_trigger_unregister: 783 if (data->trig) 784 iio_trigger_unregister(data->trig); 785 err_trigger_free: 786 iio_trigger_free(data->trig); 787 err_chip_disable: 788 data->part_info->chip_disable(data); 789 790 return ret; 791 } 792 793 static int bma180_remove(struct i2c_client *client) 794 { 795 struct iio_dev *indio_dev = i2c_get_clientdata(client); 796 struct bma180_data *data = iio_priv(indio_dev); 797 798 iio_device_unregister(indio_dev); 799 iio_triggered_buffer_cleanup(indio_dev); 800 if (data->trig) { 801 iio_trigger_unregister(data->trig); 802 iio_trigger_free(data->trig); 803 } 804 805 mutex_lock(&data->mutex); 806 data->part_info->chip_disable(data); 807 mutex_unlock(&data->mutex); 808 809 return 0; 810 } 811 812 #ifdef CONFIG_PM_SLEEP 813 static int bma180_suspend(struct device *dev) 814 { 815 struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 816 struct bma180_data *data = iio_priv(indio_dev); 817 int ret; 818 819 mutex_lock(&data->mutex); 820 ret = bma180_set_sleep_state(data, true); 821 mutex_unlock(&data->mutex); 822 823 return ret; 824 } 825 826 static int bma180_resume(struct device *dev) 827 { 828 struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 829 struct bma180_data *data = iio_priv(indio_dev); 830 int ret; 831 832 mutex_lock(&data->mutex); 833 ret = bma180_set_sleep_state(data, false); 834 mutex_unlock(&data->mutex); 835 836 return ret; 837 } 838 839 static SIMPLE_DEV_PM_OPS(bma180_pm_ops, bma180_suspend, bma180_resume); 840 #define BMA180_PM_OPS (&bma180_pm_ops) 841 #else 842 #define BMA180_PM_OPS NULL 843 #endif 844 845 static struct i2c_device_id bma180_ids[] = { 846 { "bma180", BMA180 }, 847 { "bma250", BMA250 }, 848 { } 849 }; 850 851 MODULE_DEVICE_TABLE(i2c, bma180_ids); 852 853 static const struct of_device_id bma180_of_match[] = { 854 { 855 .compatible = "bosch,bma180", 856 .data = (void *)BMA180 857 }, 858 { 859 .compatible = "bosch,bma250", 860 .data = (void *)BMA250 861 }, 862 { } 863 }; 864 MODULE_DEVICE_TABLE(of, bma180_of_match); 865 866 static struct i2c_driver bma180_driver = { 867 .driver = { 868 .name = "bma180", 869 .pm = BMA180_PM_OPS, 870 .of_match_table = bma180_of_match, 871 }, 872 .probe = bma180_probe, 873 .remove = bma180_remove, 874 .id_table = bma180_ids, 875 }; 876 877 module_i2c_driver(bma180_driver); 878 879 MODULE_AUTHOR("Kravchenko Oleksandr <x0199363@ti.com>"); 880 MODULE_AUTHOR("Texas Instruments, Inc."); 881 MODULE_DESCRIPTION("Bosch BMA180/BMA250 triaxial acceleration sensor"); 882 MODULE_LICENSE("GPL"); 883