drivers/iio/accel/mma8452.c

   1 /*
   2  * mma8452.c - Support for Freescale MMA8452Q 3-axis 12-bit accelerometer
   3  *
   4  * Copyright 2014 Peter Meerwald <pmeerw@pmeerw.net>
   5  *
   6  * This file is subject to the terms and conditions of version 2 of
   7  * the GNU General Public License.  See the file COPYING in the main
   8  * directory of this archive for more details.
   9  *
  10  * 7-bit I2C slave address 0x1c/0x1d (pin selectable)
  11  *
  12  * TODO: orientation / freefall events, autosleep
  13  */
  14
  15 #include <linux/module.h>
  16 #include <linux/i2c.h>
  17 #include <linux/iio/iio.h>
  18 #include <linux/iio/sysfs.h>
  19 #include <linux/iio/buffer.h>
  20 #include <linux/iio/trigger.h>
  21 #include <linux/iio/trigger_consumer.h>
  22 #include <linux/iio/triggered_buffer.h>
  23 #include <linux/iio/events.h>
  24 #include <linux/delay.h>
  25
  26 #define MMA8452_STATUS 0x00
  27 #define MMA8452_OUT_X 0x01 /* MSB first, 12-bit  */
  28 #define MMA8452_OUT_Y 0x03
  29 #define MMA8452_OUT_Z 0x05
  30 #define MMA8452_INT_SRC 0x0c
  31 #define MMA8452_WHO_AM_I 0x0d
  32 #define MMA8452_DATA_CFG 0x0e
  33 #define MMA8452_HP_FILTER_CUTOFF 0x0f
  34 #define MMA8452_HP_FILTER_CUTOFF_SEL_MASK       (BIT(0) | BIT(1))
  35 #define MMA8452_TRANSIENT_CFG 0x1d
  36 #define MMA8452_TRANSIENT_CFG_ELE               BIT(4)
  37 #define MMA8452_TRANSIENT_CFG_CHAN(chan)        BIT(chan + 1)
  38 #define MMA8452_TRANSIENT_CFG_HPF_BYP           BIT(0)
  39 #define MMA8452_TRANSIENT_SRC 0x1e
  40 #define MMA8452_TRANSIENT_SRC_XTRANSE           BIT(1)
  41 #define MMA8452_TRANSIENT_SRC_YTRANSE           BIT(3)
  42 #define MMA8452_TRANSIENT_SRC_ZTRANSE           BIT(5)
  43 #define MMA8452_TRANSIENT_THS 0x1f
  44 #define MMA8452_TRANSIENT_THS_MASK      0x7f
  45 #define MMA8452_TRANSIENT_COUNT 0x20
  46 #define MMA8452_OFF_X 0x2f
  47 #define MMA8452_OFF_Y 0x30
  48 #define MMA8452_OFF_Z 0x31
  49 #define MMA8452_CTRL_REG1 0x2a
  50 #define MMA8452_CTRL_REG2 0x2b
  51 #define MMA8452_CTRL_REG2_RST           BIT(6)
  52 #define MMA8452_CTRL_REG4 0x2d
  53 #define MMA8452_CTRL_REG5 0x2e
  54
  55 #define MMA8452_MAX_REG 0x31
  56
  57 #define MMA8452_STATUS_DRDY (BIT(2) | BIT(1) | BIT(0))
  58
  59 #define MMA8452_CTRL_DR_MASK (BIT(5) | BIT(4) | BIT(3))
  60 #define MMA8452_CTRL_DR_SHIFT 3
  61 #define MMA8452_CTRL_DR_DEFAULT 0x4 /* 50 Hz sample frequency */
  62 #define MMA8452_CTRL_ACTIVE BIT(0)
  63
  64 #define MMA8452_DATA_CFG_FS_MASK (BIT(1) | BIT(0))
  65 #define MMA8452_DATA_CFG_FS_2G 0
  66 #define MMA8452_DATA_CFG_FS_4G 1
  67 #define MMA8452_DATA_CFG_FS_8G 2
  68 #define MMA8452_DATA_CFG_HPF_MASK BIT(4)
  69
  70 #define MMA8452_INT_DRDY        BIT(0)
  71 #define MMA8452_INT_TRANS       BIT(5)
  72
  73 #define MMA8452_DEVICE_ID 0x2a
  74
  75 struct mma8452_data {
  76         struct i2c_client *client;
  77         struct mutex lock;
  78         u8 ctrl_reg1;
  79         u8 data_cfg;
  80 };
  81
  82 static int mma8452_drdy(struct mma8452_data *data)
  83 {
  84         int tries = 150;
  85
  86         while (tries-- > 0) {
  87                 int ret = i2c_smbus_read_byte_data(data->client,
  88                         MMA8452_STATUS);
  89                 if (ret < 0)
  90                         return ret;
  91                 if ((ret & MMA8452_STATUS_DRDY) == MMA8452_STATUS_DRDY)
  92                         return 0;
  93                 msleep(20);
  94         }
  95
  96         dev_err(&data->client->dev, "data not ready\n");
  97         return -EIO;
  98 }
  99
 100 static int mma8452_read(struct mma8452_data *data, __be16 buf[3])
 101 {
 102         int ret = mma8452_drdy(data);
 103         if (ret < 0)
 104                 return ret;
 105         return i2c_smbus_read_i2c_block_data(data->client,
 106                 MMA8452_OUT_X, 3 * sizeof(__be16), (u8 *) buf);
 107 }
 108
 109 static ssize_t mma8452_show_int_plus_micros(char *buf,
 110         const int (*vals)[2], int n)
 111 {
 112         size_t len = 0;
 113
 114         while (n-- > 0)
 115                 len += scnprintf(buf + len, PAGE_SIZE - len,
 116                         "%d.%06d ", vals[n][0], vals[n][1]);
 117
 118         /* replace trailing space by newline */
 119         buf[len - 1] = '\n';
 120
 121         return len;
 122 }
 123
 124 static int mma8452_get_int_plus_micros_index(const int (*vals)[2], int n,
 125                                         int val, int val2)
 126 {
 127         while (n-- > 0)
 128                 if (val == vals[n][0] && val2 == vals[n][1])
 129                         return n;
 130
 131         return -EINVAL;
 132 }
 133
 134 static int mma8452_get_odr_index(struct mma8452_data *data)
 135 {
 136         return (data->ctrl_reg1 & MMA8452_CTRL_DR_MASK) >>
 137                         MMA8452_CTRL_DR_SHIFT;
 138 }
 139
 140 static const int mma8452_samp_freq[8][2] = {
 141         {800, 0}, {400, 0}, {200, 0}, {100, 0}, {50, 0}, {12, 500000},
 142         {6, 250000}, {1, 560000}
 143 };
 144
 145 /*
 146  * Hardware has fullscale of -2G, -4G, -8G corresponding to raw value -2048
 147  * The userspace interface uses m/s^2 and we declare micro units
 148  * So scale factor is given by:
 149  *      g * N * 1000000 / 2048 for N = 2, 4, 8 and g=9.80665
 150  */
 151 static const int mma8452_scales[3][2] = {
 152         {0, 9577}, {0, 19154}, {0, 38307}
 153 };
 154
 155 /* Datasheet table 35  (step time vs sample frequency) */
 156 static const int mma8452_transient_time_step_us[8] = {
 157         1250,
 158         2500,
 159         5000,
 160         10000,
 161         20000,
 162         20000,
 163         20000,
 164         20000
 165 };
 166
 167 /* Datasheet table 18 (normal mode) */
 168 static const int mma8452_hp_filter_cutoff[8][4][2] = {
 169         { {16, 0}, {8, 0}, {4, 0}, {2, 0} },            /* 800 Hz sample */
 170         { {16, 0}, {8, 0}, {4, 0}, {2, 0} },            /* 400 Hz sample */
 171         { {8, 0}, {4, 0}, {2, 0}, {1, 0} },             /* 200 Hz sample */
 172         { {4, 0}, {2, 0}, {1, 0}, {0, 500000} },        /* 100 Hz sample */
 173         { {2, 0}, {1, 0}, {0, 500000}, {0, 250000} },   /* 50 Hz sample */
 174         { {2, 0}, {1, 0}, {0, 500000}, {0, 250000} },   /* 12.5 Hz sample */
 175         { {2, 0}, {1, 0}, {0, 500000}, {0, 250000} },   /* 6.25 Hz sample */
 176         { {2, 0}, {1, 0}, {0, 500000}, {0, 250000} }    /* 1.56 Hz sample */
 177 };
 178
 179 static ssize_t mma8452_show_samp_freq_avail(struct device *dev,
 180                                 struct device_attribute *attr, char *buf)
 181 {
 182         return mma8452_show_int_plus_micros(buf, mma8452_samp_freq,
 183                 ARRAY_SIZE(mma8452_samp_freq));
 184 }
 185
 186 static ssize_t mma8452_show_scale_avail(struct device *dev,
 187                                 struct device_attribute *attr, char *buf)
 188 {
 189         return mma8452_show_int_plus_micros(buf, mma8452_scales,
 190                 ARRAY_SIZE(mma8452_scales));
 191 }
 192
 193 static ssize_t mma8452_show_hp_cutoff_avail(struct device *dev,
 194                                             struct device_attribute *attr,
 195                                             char *buf)
 196 {
 197         struct iio_dev *indio_dev = dev_to_iio_dev(dev);
 198         struct mma8452_data *data = iio_priv(indio_dev);
 199         int i = mma8452_get_odr_index(data);
 200
 201         return mma8452_show_int_plus_micros(buf, mma8452_hp_filter_cutoff[i],
 202                 ARRAY_SIZE(mma8452_hp_filter_cutoff[0]));
 203 }
 204
 205 static IIO_DEV_ATTR_SAMP_FREQ_AVAIL(mma8452_show_samp_freq_avail);
 206 static IIO_DEVICE_ATTR(in_accel_scale_available, S_IRUGO,
 207         mma8452_show_scale_avail, NULL, 0);
 208 static IIO_DEVICE_ATTR(in_accel_filter_high_pass_3db_frequency_available,
 209                         S_IRUGO, mma8452_show_hp_cutoff_avail, NULL, 0);
 210
 211 static int mma8452_get_samp_freq_index(struct mma8452_data *data,
 212         int val, int val2)
 213 {
 214         return mma8452_get_int_plus_micros_index(mma8452_samp_freq,
 215                 ARRAY_SIZE(mma8452_samp_freq), val, val2);
 216 }
 217
 218 static int mma8452_get_scale_index(struct mma8452_data *data,
 219         int val, int val2)
 220 {
 221         return mma8452_get_int_plus_micros_index(mma8452_scales,
 222                 ARRAY_SIZE(mma8452_scales), val, val2);
 223 }
 224
 225 static int mma8452_get_hp_filter_index(struct mma8452_data *data,
 226                                        int val, int val2)
 227 {
 228         int i = mma8452_get_odr_index(data);
 229
 230         return mma8452_get_int_plus_micros_index(mma8452_hp_filter_cutoff[i],
 231                 ARRAY_SIZE(mma8452_hp_filter_cutoff[0]), val, val2);
 232 }
 233
 234 static int mma8452_read_hp_filter(struct mma8452_data *data, int *hz, int *uHz)
 235 {
 236         int i, ret;
 237
 238         ret = i2c_smbus_read_byte_data(data->client, MMA8452_HP_FILTER_CUTOFF);
 239         if (ret < 0)
 240                 return ret;
 241
 242         i = mma8452_get_odr_index(data);
 243         ret &= MMA8452_HP_FILTER_CUTOFF_SEL_MASK;
 244         *hz = mma8452_hp_filter_cutoff[i][ret][0];
 245         *uHz = mma8452_hp_filter_cutoff[i][ret][1];
 246
 247         return 0;
 248 }
 249
 250 static int mma8452_read_raw(struct iio_dev *indio_dev,
 251                             struct iio_chan_spec const *chan,
 252                             int *val, int *val2, long mask)
 253 {
 254         struct mma8452_data *data = iio_priv(indio_dev);
 255         __be16 buffer[3];
 256         int i, ret;
 257
 258         switch (mask) {
 259         case IIO_CHAN_INFO_RAW:
 260                 if (iio_buffer_enabled(indio_dev))
 261                         return -EBUSY;
 262
 263                 mutex_lock(&data->lock);
 264                 ret = mma8452_read(data, buffer);
 265                 mutex_unlock(&data->lock);
 266                 if (ret < 0)
 267                         return ret;
 268                 *val = sign_extend32(
 269                         be16_to_cpu(buffer[chan->scan_index]) >> 4, 11);
 270                 return IIO_VAL_INT;
 271         case IIO_CHAN_INFO_SCALE:
 272                 i = data->data_cfg & MMA8452_DATA_CFG_FS_MASK;
 273                 *val = mma8452_scales[i][0];
 274                 *val2 = mma8452_scales[i][1];
 275                 return IIO_VAL_INT_PLUS_MICRO;
 276         case IIO_CHAN_INFO_SAMP_FREQ:
 277                 i = mma8452_get_odr_index(data);
 278                 *val = mma8452_samp_freq[i][0];
 279                 *val2 = mma8452_samp_freq[i][1];
 280                 return IIO_VAL_INT_PLUS_MICRO;
 281         case IIO_CHAN_INFO_CALIBBIAS:
 282                 ret = i2c_smbus_read_byte_data(data->client, MMA8452_OFF_X +
 283                         chan->scan_index);
 284                 if (ret < 0)
 285                         return ret;
 286                 *val = sign_extend32(ret, 7);
 287                 return IIO_VAL_INT;
 288         case IIO_CHAN_INFO_HIGH_PASS_FILTER_3DB_FREQUENCY:
 289                 if (data->data_cfg & MMA8452_DATA_CFG_HPF_MASK) {
 290                         ret = mma8452_read_hp_filter(data, val, val2);
 291                         if (ret < 0)
 292                                 return ret;
 293                 } else {
 294                         *val = 0;
 295                         *val2 = 0;
 296                 }
 297                 return IIO_VAL_INT_PLUS_MICRO;
 298         }
 299         return -EINVAL;
 300 }
 301
 302 static int mma8452_standby(struct mma8452_data *data)
 303 {
 304         return i2c_smbus_write_byte_data(data->client, MMA8452_CTRL_REG1,
 305                 data->ctrl_reg1 & ~MMA8452_CTRL_ACTIVE);
 306 }
 307
 308 static int mma8452_active(struct mma8452_data *data)
 309 {
 310         return i2c_smbus_write_byte_data(data->client, MMA8452_CTRL_REG1,
 311                 data->ctrl_reg1);
 312 }
 313
 314 static int mma8452_change_config(struct mma8452_data *data, u8 reg, u8 val)
 315 {
 316         int ret;
 317
 318         mutex_lock(&data->lock);
 319
 320         /* config can only be changed when in standby */
 321         ret = mma8452_standby(data);
 322         if (ret < 0)
 323                 goto fail;
 324
 325         ret = i2c_smbus_write_byte_data(data->client, reg, val);
 326         if (ret < 0)
 327                 goto fail;
 328
 329         ret = mma8452_active(data);
 330         if (ret < 0)
 331                 goto fail;
 332
 333         ret = 0;
 334 fail:
 335         mutex_unlock(&data->lock);
 336         return ret;
 337 }
 338
 339 static int mma8452_set_hp_filter_frequency(struct mma8452_data *data,
 340                                            int val, int val2)
 341 {
 342         int i, reg;
 343
 344         i = mma8452_get_hp_filter_index(data, val, val2);
 345         if (i < 0)
 346                 return -EINVAL;
 347
 348         reg = i2c_smbus_read_byte_data(data->client,
 349                                        MMA8452_HP_FILTER_CUTOFF);
 350         if (reg < 0)
 351                 return reg;
 352         reg &= ~MMA8452_HP_FILTER_CUTOFF_SEL_MASK;
 353         reg |= i;
 354
 355         return mma8452_change_config(data, MMA8452_HP_FILTER_CUTOFF, reg);
 356 }
 357
 358 static int mma8452_write_raw(struct iio_dev *indio_dev,
 359                              struct iio_chan_spec const *chan,
 360                              int val, int val2, long mask)
 361 {
 362         struct mma8452_data *data = iio_priv(indio_dev);
 363         int i, ret;
 364
 365         if (iio_buffer_enabled(indio_dev))
 366                 return -EBUSY;
 367
 368         switch (mask) {
 369         case IIO_CHAN_INFO_SAMP_FREQ:
 370                 i = mma8452_get_samp_freq_index(data, val, val2);
 371                 if (i < 0)
 372                         return -EINVAL;
 373
 374                 data->ctrl_reg1 &= ~MMA8452_CTRL_DR_MASK;
 375                 data->ctrl_reg1 |= i << MMA8452_CTRL_DR_SHIFT;
 376                 return mma8452_change_config(data, MMA8452_CTRL_REG1,
 377                         data->ctrl_reg1);
 378         case IIO_CHAN_INFO_SCALE:
 379                 i = mma8452_get_scale_index(data, val, val2);
 380                 if (i < 0)
 381                         return -EINVAL;
 382                 data->data_cfg &= ~MMA8452_DATA_CFG_FS_MASK;
 383                 data->data_cfg |= i;
 384                 return mma8452_change_config(data, MMA8452_DATA_CFG,
 385                         data->data_cfg);
 386         case IIO_CHAN_INFO_CALIBBIAS:
 387                 if (val < -128 || val > 127)
 388                         return -EINVAL;
 389                 return mma8452_change_config(data, MMA8452_OFF_X +
 390                         chan->scan_index, val);
 391
 392         case IIO_CHAN_INFO_HIGH_PASS_FILTER_3DB_FREQUENCY:
 393                 if (val == 0 && val2 == 0) {
 394                         data->data_cfg &= ~MMA8452_DATA_CFG_HPF_MASK;
 395                 } else {
 396                         data->data_cfg |= MMA8452_DATA_CFG_HPF_MASK;
 397                         ret = mma8452_set_hp_filter_frequency(data, val, val2);
 398                         if (ret < 0)
 399                                 return ret;
 400                 }
 401                 return mma8452_change_config(data, MMA8452_DATA_CFG,
 402                                                 data->data_cfg);
 403
 404         default:
 405                 return -EINVAL;
 406         }
 407 }
 408
 409 static int mma8452_read_thresh(struct iio_dev *indio_dev,
 410                                const struct iio_chan_spec *chan,
 411                                enum iio_event_type type,
 412                                enum iio_event_direction dir,
 413                                enum iio_event_info info,
 414                                int *val, int *val2)
 415 {
 416         struct mma8452_data *data = iio_priv(indio_dev);
 417         int ret, us;
 418
 419         switch (info) {
 420         case IIO_EV_INFO_VALUE:
 421                 ret = i2c_smbus_read_byte_data(data->client,
 422                                                MMA8452_TRANSIENT_THS);
 423                 if (ret < 0)
 424                         return ret;
 425
 426                 *val = ret & MMA8452_TRANSIENT_THS_MASK;
 427                 return IIO_VAL_INT;
 428
 429         case IIO_EV_INFO_PERIOD:
 430                 ret = i2c_smbus_read_byte_data(data->client,
 431                                                MMA8452_TRANSIENT_COUNT);
 432                 if (ret < 0)
 433                         return ret;
 434
 435                 us = ret * mma8452_transient_time_step_us[
 436                                 mma8452_get_odr_index(data)];
 437                 *val = us / USEC_PER_SEC;
 438                 *val2 = us % USEC_PER_SEC;
 439                 return IIO_VAL_INT_PLUS_MICRO;
 440
 441         case IIO_EV_INFO_HIGH_PASS_FILTER_3DB:
 442                 ret = i2c_smbus_read_byte_data(data->client,
 443                                                MMA8452_TRANSIENT_CFG);
 444                 if (ret < 0)
 445                         return ret;
 446
 447                 if (ret & MMA8452_TRANSIENT_CFG_HPF_BYP) {
 448                         *val = 0;
 449                         *val2 = 0;
 450                 } else {
 451                         ret = mma8452_read_hp_filter(data, val, val2);
 452                         if (ret < 0)
 453                                 return ret;
 454                 }
 455                 return IIO_VAL_INT_PLUS_MICRO;
 456
 457         default:
 458                 return -EINVAL;
 459         }
 460 }
 461
 462 static int mma8452_write_thresh(struct iio_dev *indio_dev,
 463                                 const struct iio_chan_spec *chan,
 464                                 enum iio_event_type type,
 465                                 enum iio_event_direction dir,
 466                                 enum iio_event_info info,
 467                                 int val, int val2)
 468 {
 469         struct mma8452_data *data = iio_priv(indio_dev);
 470         int ret, reg, steps;
 471
 472         switch (info) {
 473         case IIO_EV_INFO_VALUE:
 474                 return mma8452_change_config(data, MMA8452_TRANSIENT_THS,
 475                                              val & MMA8452_TRANSIENT_THS_MASK);
 476
 477         case IIO_EV_INFO_PERIOD:
 478                 steps = (val * USEC_PER_SEC + val2) /
 479                                 mma8452_transient_time_step_us[
 480                                         mma8452_get_odr_index(data)];
 481
 482                 if (steps > 0xff)
 483                         return -EINVAL;
 484
 485                 return mma8452_change_config(data, MMA8452_TRANSIENT_COUNT,
 486                                              steps);
 487         case IIO_EV_INFO_HIGH_PASS_FILTER_3DB:
 488                 reg = i2c_smbus_read_byte_data(data->client,
 489                                                MMA8452_TRANSIENT_CFG);
 490                 if (reg < 0)
 491                         return reg;
 492
 493                 if (val == 0 && val2 == 0) {
 494                         reg |= MMA8452_TRANSIENT_CFG_HPF_BYP;
 495                 } else {
 496                         reg &= ~MMA8452_TRANSIENT_CFG_HPF_BYP;
 497                         ret = mma8452_set_hp_filter_frequency(data, val, val2);
 498                         if (ret < 0)
 499                                 return ret;
 500                 }
 501                 return mma8452_change_config(data, MMA8452_TRANSIENT_CFG, reg);
 502
 503         default:
 504                 return -EINVAL;
 505         }
 506 }
 507
 508 static int mma8452_read_event_config(struct iio_dev *indio_dev,
 509                                      const struct iio_chan_spec *chan,
 510                                      enum iio_event_type type,
 511                                      enum iio_event_direction dir)
 512 {
 513         struct mma8452_data *data = iio_priv(indio_dev);
 514         int ret;
 515
 516         ret = i2c_smbus_read_byte_data(data->client, MMA8452_TRANSIENT_CFG);
 517         if (ret < 0)
 518                 return ret;
 519
 520         return ret & MMA8452_TRANSIENT_CFG_CHAN(chan->scan_index) ? 1 : 0;
 521 }
 522
 523 static int mma8452_write_event_config(struct iio_dev *indio_dev,
 524                                       const struct iio_chan_spec *chan,
 525                                       enum iio_event_type type,
 526                                       enum iio_event_direction dir,
 527                                       int state)
 528 {
 529         struct mma8452_data *data = iio_priv(indio_dev);
 530         int val;
 531
 532         val = i2c_smbus_read_byte_data(data->client, MMA8452_TRANSIENT_CFG);
 533         if (val < 0)
 534                 return val;
 535
 536         if (state)
 537                 val |= MMA8452_TRANSIENT_CFG_CHAN(chan->scan_index);
 538         else
 539                 val &= ~MMA8452_TRANSIENT_CFG_CHAN(chan->scan_index);
 540
 541         val |= MMA8452_TRANSIENT_CFG_ELE;
 542
 543         return mma8452_change_config(data, MMA8452_TRANSIENT_CFG, val);
 544 }
 545
 546 static void mma8452_transient_interrupt(struct iio_dev *indio_dev)
 547 {
 548         struct mma8452_data *data = iio_priv(indio_dev);
 549         s64 ts = iio_get_time_ns();
 550         int src;
 551
 552         src = i2c_smbus_read_byte_data(data->client, MMA8452_TRANSIENT_SRC);
 553         if (src < 0)
 554                 return;
 555
 556         if (src & MMA8452_TRANSIENT_SRC_XTRANSE)
 557                 iio_push_event(indio_dev,
 558                                IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_X,
 559                                                   IIO_EV_TYPE_THRESH,
 560                                                   IIO_EV_DIR_RISING),
 561                                ts);
 562
 563         if (src & MMA8452_TRANSIENT_SRC_YTRANSE)
 564                 iio_push_event(indio_dev,
 565                                IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_Y,
 566                                                   IIO_EV_TYPE_THRESH,
 567                                                   IIO_EV_DIR_RISING),
 568                                ts);
 569
 570         if (src & MMA8452_TRANSIENT_SRC_ZTRANSE)
 571                 iio_push_event(indio_dev,
 572                                IIO_MOD_EVENT_CODE(IIO_ACCEL, 0, IIO_MOD_Z,
 573                                                   IIO_EV_TYPE_THRESH,
 574                                                   IIO_EV_DIR_RISING),
 575                                ts);
 576 }
 577
 578 static irqreturn_t mma8452_interrupt(int irq, void *p)
 579 {
 580         struct iio_dev *indio_dev = p;
 581         struct mma8452_data *data = iio_priv(indio_dev);
 582         int ret = IRQ_NONE;
 583         int src;
 584
 585         src = i2c_smbus_read_byte_data(data->client, MMA8452_INT_SRC);
 586         if (src < 0)
 587                 return IRQ_NONE;
 588
 589         if (src & MMA8452_INT_DRDY) {
 590                 iio_trigger_poll_chained(indio_dev->trig);
 591                 ret = IRQ_HANDLED;
 592         }
 593
 594         if (src & MMA8452_INT_TRANS) {
 595                 mma8452_transient_interrupt(indio_dev);
 596                 ret = IRQ_HANDLED;
 597         }
 598
 599         return ret;
 600 }
 601
 602 static irqreturn_t mma8452_trigger_handler(int irq, void *p)
 603 {
 604         struct iio_poll_func *pf = p;
 605         struct iio_dev *indio_dev = pf->indio_dev;
 606         struct mma8452_data *data = iio_priv(indio_dev);
 607         u8 buffer[16]; /* 3 16-bit channels + padding + ts */
 608         int ret;
 609
 610         ret = mma8452_read(data, (__be16 *) buffer);
 611         if (ret < 0)
 612                 goto done;
 613
 614         iio_push_to_buffers_with_timestamp(indio_dev, buffer,
 615                 iio_get_time_ns());
 616
 617 done:
 618         iio_trigger_notify_done(indio_dev->trig);
 619         return IRQ_HANDLED;
 620 }
 621
 622 static int mma8452_reg_access_dbg(struct iio_dev *indio_dev,
 623                                   unsigned reg, unsigned writeval,
 624                                   unsigned *readval)
 625 {
 626         int ret;
 627         struct mma8452_data *data = iio_priv(indio_dev);
 628
 629         if (reg > MMA8452_MAX_REG)
 630                 return -EINVAL;
 631
 632         if (!readval)
 633                 return mma8452_change_config(data, reg, writeval);
 634
 635         ret = i2c_smbus_read_byte_data(data->client, reg);
 636         if (ret < 0)
 637                 return ret;
 638
 639         *readval = ret;
 640
 641         return 0;
 642 }
 643
 644 static const struct iio_event_spec mma8452_transient_event[] = {
 645         {
 646                 .type = IIO_EV_TYPE_THRESH,
 647                 .dir = IIO_EV_DIR_RISING,
 648                 .mask_separate = BIT(IIO_EV_INFO_ENABLE),
 649                 .mask_shared_by_type = BIT(IIO_EV_INFO_VALUE) |
 650                                         BIT(IIO_EV_INFO_PERIOD) |
 651                                         BIT(IIO_EV_INFO_HIGH_PASS_FILTER_3DB)
 652         },
 653 };
 654
 655 /*
 656  * Threshold is configured in fixed 8G/127 steps regardless of
 657  * currently selected scale for measurement.
 658  */
 659 static IIO_CONST_ATTR_NAMED(accel_transient_scale, in_accel_scale, "0.617742");
 660
 661 static struct attribute *mma8452_event_attributes[] = {
 662         &iio_const_attr_accel_transient_scale.dev_attr.attr,
 663         NULL,
 664 };
 665
 666 static struct attribute_group mma8452_event_attribute_group = {
 667         .attrs = mma8452_event_attributes,
 668         .name = "events",
 669 };
 670
 671 #define MMA8452_CHANNEL(axis, idx) { \
 672         .type = IIO_ACCEL, \
 673         .modified = 1, \
 674         .channel2 = IIO_MOD_##axis, \
 675         .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
 676                 BIT(IIO_CHAN_INFO_CALIBBIAS), \
 677         .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SAMP_FREQ) | \
 678                 BIT(IIO_CHAN_INFO_SCALE) | \
 679                 BIT(IIO_CHAN_INFO_HIGH_PASS_FILTER_3DB_FREQUENCY), \
 680         .scan_index = idx, \
 681         .scan_type = { \
 682                 .sign = 's', \
 683                 .realbits = 12, \
 684                 .storagebits = 16, \
 685                 .shift = 4, \
 686                 .endianness = IIO_BE, \
 687         }, \
 688         .event_spec = mma8452_transient_event, \
 689         .num_event_specs = ARRAY_SIZE(mma8452_transient_event), \
 690 }
 691
 692 static const struct iio_chan_spec mma8452_channels[] = {
 693         MMA8452_CHANNEL(X, 0),
 694         MMA8452_CHANNEL(Y, 1),
 695         MMA8452_CHANNEL(Z, 2),
 696         IIO_CHAN_SOFT_TIMESTAMP(3),
 697 };
 698
 699 static struct attribute *mma8452_attributes[] = {
 700         &iio_dev_attr_sampling_frequency_available.dev_attr.attr,
 701         &iio_dev_attr_in_accel_scale_available.dev_attr.attr,
 702         &iio_dev_attr_in_accel_filter_high_pass_3db_frequency_available.dev_attr.attr,
 703         NULL
 704 };
 705
 706 static const struct attribute_group mma8452_group = {
 707         .attrs = mma8452_attributes,
 708 };
 709
 710 static const struct iio_info mma8452_info = {
 711         .attrs = &mma8452_group,
 712         .read_raw = &mma8452_read_raw,
 713         .write_raw = &mma8452_write_raw,
 714         .event_attrs = &mma8452_event_attribute_group,
 715         .read_event_value = &mma8452_read_thresh,
 716         .write_event_value = &mma8452_write_thresh,
 717         .read_event_config = &mma8452_read_event_config,
 718         .write_event_config = &mma8452_write_event_config,
 719         .debugfs_reg_access = &mma8452_reg_access_dbg,
 720         .driver_module = THIS_MODULE,
 721 };
 722
 723 static const unsigned long mma8452_scan_masks[] = {0x7, 0};
 724
 725 static int mma8452_data_rdy_trigger_set_state(struct iio_trigger *trig,
 726                                               bool state)
 727 {
 728         struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
 729         struct mma8452_data *data = iio_priv(indio_dev);
 730         int reg;
 731
 732         reg = i2c_smbus_read_byte_data(data->client, MMA8452_CTRL_REG4);
 733         if (reg < 0)
 734                 return reg;
 735
 736         if (state)
 737                 reg |= MMA8452_INT_DRDY;
 738         else
 739                 reg &= ~MMA8452_INT_DRDY;
 740
 741         return mma8452_change_config(data, MMA8452_CTRL_REG4, reg);
 742 }
 743
 744 static int mma8452_validate_device(struct iio_trigger *trig,
 745                                    struct iio_dev *indio_dev)
 746 {
 747         struct iio_dev *indio = iio_trigger_get_drvdata(trig);
 748
 749         if (indio != indio_dev)
 750                 return -EINVAL;
 751
 752         return 0;
 753 }
 754
 755 static const struct iio_trigger_ops mma8452_trigger_ops = {
 756         .set_trigger_state = mma8452_data_rdy_trigger_set_state,
 757         .validate_device = mma8452_validate_device,
 758         .owner = THIS_MODULE,
 759 };
 760
 761 static int mma8452_trigger_setup(struct iio_dev *indio_dev)
 762 {
 763         struct mma8452_data *data = iio_priv(indio_dev);
 764         struct iio_trigger *trig;
 765         int ret;
 766
 767         trig = devm_iio_trigger_alloc(&data->client->dev, "%s-dev%d",
 768                                       indio_dev->name,
 769                                       indio_dev->id);
 770         if (!trig)
 771                 return -ENOMEM;
 772
 773         trig->dev.parent = &data->client->dev;
 774         trig->ops = &mma8452_trigger_ops;
 775         iio_trigger_set_drvdata(trig, indio_dev);
 776
 777         ret = iio_trigger_register(trig);
 778         if (ret)
 779                 return ret;
 780
 781         indio_dev->trig = trig;
 782         return 0;
 783 }
 784
 785 static void mma8452_trigger_cleanup(struct iio_dev *indio_dev)
 786 {
 787         if (indio_dev->trig)
 788                 iio_trigger_unregister(indio_dev->trig);
 789 }
 790
 791 static int mma8452_reset(struct i2c_client *client)
 792 {
 793         int i;
 794         int ret;
 795
 796         ret = i2c_smbus_write_byte_data(client, MMA8452_CTRL_REG2,
 797                                         MMA8452_CTRL_REG2_RST);
 798         if (ret < 0)
 799                 return ret;
 800
 801         for (i = 0; i < 10; i++) {
 802                 usleep_range(100, 200);
 803                 ret = i2c_smbus_read_byte_data(client, MMA8452_CTRL_REG2);
 804                 if (ret == -EIO)
 805                         continue; /* I2C comm reset */
 806                 if (ret < 0)
 807                         return ret;
 808                 if (!(ret & MMA8452_CTRL_REG2_RST))
 809                         return 0;
 810         }
 811
 812         return -ETIMEDOUT;
 813 }
 814
 815 static int mma8452_probe(struct i2c_client *client,
 816                          const struct i2c_device_id *id)
 817 {
 818         struct mma8452_data *data;
 819         struct iio_dev *indio_dev;
 820         int ret;
 821
 822         ret = i2c_smbus_read_byte_data(client, MMA8452_WHO_AM_I);
 823         if (ret < 0)
 824                 return ret;
 825         if (ret != MMA8452_DEVICE_ID)
 826                 return -ENODEV;
 827
 828         indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
 829         if (!indio_dev)
 830                 return -ENOMEM;
 831
 832         data = iio_priv(indio_dev);
 833         data->client = client;
 834         mutex_init(&data->lock);
 835
 836         i2c_set_clientdata(client, indio_dev);
 837         indio_dev->info = &mma8452_info;
 838         indio_dev->name = id->name;
 839         indio_dev->dev.parent = &client->dev;
 840         indio_dev->modes = INDIO_DIRECT_MODE;
 841         indio_dev->channels = mma8452_channels;
 842         indio_dev->num_channels = ARRAY_SIZE(mma8452_channels);
 843         indio_dev->available_scan_masks = mma8452_scan_masks;
 844
 845         ret = mma8452_reset(client);
 846         if (ret < 0)
 847                 return ret;
 848
 849         data->data_cfg = MMA8452_DATA_CFG_FS_2G;
 850         ret = i2c_smbus_write_byte_data(client, MMA8452_DATA_CFG,
 851                 data->data_cfg);
 852         if (ret < 0)
 853                 return ret;
 854
 855         /*
 856          * By default set transient threshold to max to avoid events if
 857          * enabling without configuring threshold.
 858          */
 859         ret = i2c_smbus_write_byte_data(client, MMA8452_TRANSIENT_THS,
 860                                         MMA8452_TRANSIENT_THS_MASK);
 861         if (ret < 0)
 862                 return ret;
 863
 864         if (client->irq) {
 865                 /*
 866                  * Although we enable the transient interrupt source once and
 867                  * for all here the transient event detection itself is not
 868                  * enabled until userspace asks for it by
 869                  * mma8452_write_event_config()
 870                  */
 871                 int supported_interrupts = MMA8452_INT_DRDY | MMA8452_INT_TRANS;
 872                 int enabled_interrupts = MMA8452_INT_TRANS;
 873
 874                 /* Assume wired to INT1 pin */
 875                 ret = i2c_smbus_write_byte_data(client,
 876                                                 MMA8452_CTRL_REG5,
 877                                                 supported_interrupts);
 878                 if (ret < 0)
 879                         return ret;
 880
 881                 ret = i2c_smbus_write_byte_data(client,
 882                                                 MMA8452_CTRL_REG4,
 883                                                 enabled_interrupts);
 884                 if (ret < 0)
 885                         return ret;
 886
 887                 ret = mma8452_trigger_setup(indio_dev);
 888                 if (ret < 0)
 889                         return ret;
 890         }
 891
 892         data->ctrl_reg1 = MMA8452_CTRL_ACTIVE |
 893                 (MMA8452_CTRL_DR_DEFAULT << MMA8452_CTRL_DR_SHIFT);
 894         ret = i2c_smbus_write_byte_data(client, MMA8452_CTRL_REG1,
 895                                         data->ctrl_reg1);
 896         if (ret < 0)
 897                 goto trigger_cleanup;
 898
 899         ret = iio_triggered_buffer_setup(indio_dev, NULL,
 900                 mma8452_trigger_handler, NULL);
 901         if (ret < 0)
 902                 goto trigger_cleanup;
 903
 904         if (client->irq) {
 905                 ret = devm_request_threaded_irq(&client->dev,
 906                                                 client->irq,
 907                                                 NULL, mma8452_interrupt,
 908                                                 IRQF_TRIGGER_LOW | IRQF_ONESHOT,
 909                                                 client->name, indio_dev);
 910                 if (ret)
 911                         goto buffer_cleanup;
 912         }
 913
 914         ret = iio_device_register(indio_dev);
 915         if (ret < 0)
 916                 goto buffer_cleanup;
 917
 918         return 0;
 919
 920 buffer_cleanup:
 921         iio_triggered_buffer_cleanup(indio_dev);
 922
 923 trigger_cleanup:
 924         mma8452_trigger_cleanup(indio_dev);
 925
 926         return ret;
 927 }
 928
 929 static int mma8452_remove(struct i2c_client *client)
 930 {
 931         struct iio_dev *indio_dev = i2c_get_clientdata(client);
 932
 933         iio_device_unregister(indio_dev);
 934         iio_triggered_buffer_cleanup(indio_dev);
 935         mma8452_trigger_cleanup(indio_dev);
 936         mma8452_standby(iio_priv(indio_dev));
 937
 938         return 0;
 939 }
 940
 941 #ifdef CONFIG_PM_SLEEP
 942 static int mma8452_suspend(struct device *dev)
 943 {
 944         return mma8452_standby(iio_priv(i2c_get_clientdata(
 945                 to_i2c_client(dev))));
 946 }
 947
 948 static int mma8452_resume(struct device *dev)
 949 {
 950         return mma8452_active(iio_priv(i2c_get_clientdata(
 951                 to_i2c_client(dev))));
 952 }
 953
 954 static SIMPLE_DEV_PM_OPS(mma8452_pm_ops, mma8452_suspend, mma8452_resume);
 955 #define MMA8452_PM_OPS (&mma8452_pm_ops)
 956 #else
 957 #define MMA8452_PM_OPS NULL
 958 #endif
 959
 960 static const struct i2c_device_id mma8452_id[] = {
 961         { "mma8452", 0 },
 962         { }
 963 };
 964 MODULE_DEVICE_TABLE(i2c, mma8452_id);
 965
 966 static const struct of_device_id mma8452_dt_ids[] = {
 967         { .compatible = "fsl,mma8452" },
 968         { }
 969 };
 970 MODULE_DEVICE_TABLE(of, mma8452_dt_ids);
 971
 972 static struct i2c_driver mma8452_driver = {
 973         .driver = {
 974                 .name   = "mma8452",
 975                 .of_match_table = of_match_ptr(mma8452_dt_ids),
 976                 .pm     = MMA8452_PM_OPS,
 977         },
 978         .probe = mma8452_probe,
 979         .remove = mma8452_remove,
 980         .id_table = mma8452_id,
 981 };
 982 module_i2c_driver(mma8452_driver);
 983
 984 MODULE_AUTHOR("Peter Meerwald <pmeerw@pmeerw.net>");
 985 MODULE_DESCRIPTION("Freescale MMA8452 accelerometer driver");
 986 MODULE_LICENSE("GPL");