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