drivers/iio/accel/bma180.c

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