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