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