drivers/iio/accel/bma180.c

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