drivers/iio/accel/kxcjk-1013.c

   1 /*
   2  * KXCJK-1013 3-axis accelerometer driver
   3  * Copyright (c) 2014, Intel Corporation.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms and conditions of the GNU General Public License,
   7  * version 2, as published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  */
  14
  15 #include <linux/module.h>
  16 #include <linux/i2c.h>
  17 #include <linux/interrupt.h>
  18 #include <linux/delay.h>
  19 #include <linux/bitops.h>
  20 #include <linux/slab.h>
  21 #include <linux/string.h>
  22 #include <linux/acpi.h>
  23 #include <linux/gpio/consumer.h>
  24 #include <linux/pm.h>
  25 #include <linux/pm_runtime.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/events.h>
  31 #include <linux/iio/trigger_consumer.h>
  32 #include <linux/iio/triggered_buffer.h>
  33 #include <linux/iio/accel/kxcjk_1013.h>
  34
  35 #define KXCJK1013_DRV_NAME "kxcjk1013"
  36 #define KXCJK1013_IRQ_NAME "kxcjk1013_event"
  37
  38 #define KXCJK1013_REG_XOUT_L            0x06
  39 /*
  40  * From low byte X axis register, all the other addresses of Y and Z can be
  41  * obtained by just applying axis offset. The following axis defines are just
  42  * provide clarity, but not used.
  43  */
  44 #define KXCJK1013_REG_XOUT_H            0x07
  45 #define KXCJK1013_REG_YOUT_L            0x08
  46 #define KXCJK1013_REG_YOUT_H            0x09
  47 #define KXCJK1013_REG_ZOUT_L            0x0A
  48 #define KXCJK1013_REG_ZOUT_H            0x0B
  49
  50 #define KXCJK1013_REG_DCST_RESP         0x0C
  51 #define KXCJK1013_REG_WHO_AM_I          0x0F
  52 #define KXCJK1013_REG_INT_SRC1          0x16
  53 #define KXCJK1013_REG_INT_SRC2          0x17
  54 #define KXCJK1013_REG_STATUS_REG        0x18
  55 #define KXCJK1013_REG_INT_REL           0x1A
  56 #define KXCJK1013_REG_CTRL1             0x1B
  57 #define KXCJK1013_REG_CTRL2             0x1D
  58 #define KXCJK1013_REG_INT_CTRL1         0x1E
  59 #define KXCJK1013_REG_INT_CTRL2         0x1F
  60 #define KXCJK1013_REG_DATA_CTRL         0x21
  61 #define KXCJK1013_REG_WAKE_TIMER        0x29
  62 #define KXCJK1013_REG_SELF_TEST         0x3A
  63 #define KXCJK1013_REG_WAKE_THRES        0x6A
  64
  65 #define KXCJK1013_REG_CTRL1_BIT_PC1     BIT(7)
  66 #define KXCJK1013_REG_CTRL1_BIT_RES     BIT(6)
  67 #define KXCJK1013_REG_CTRL1_BIT_DRDY    BIT(5)
  68 #define KXCJK1013_REG_CTRL1_BIT_GSEL1   BIT(4)
  69 #define KXCJK1013_REG_CTRL1_BIT_GSEL0   BIT(3)
  70 #define KXCJK1013_REG_CTRL1_BIT_WUFE    BIT(1)
  71 #define KXCJK1013_REG_INT_REG1_BIT_IEA  BIT(4)
  72 #define KXCJK1013_REG_INT_REG1_BIT_IEN  BIT(5)
  73
  74 #define KXCJK1013_DATA_MASK_12_BIT      0x0FFF
  75 #define KXCJK1013_MAX_STARTUP_TIME_US   100000
  76
  77 #define KXCJK1013_SLEEP_DELAY_MS        2000
  78
  79 #define KXCJK1013_REG_INT_SRC2_BIT_ZP   BIT(0)
  80 #define KXCJK1013_REG_INT_SRC2_BIT_ZN   BIT(1)
  81 #define KXCJK1013_REG_INT_SRC2_BIT_YP   BIT(2)
  82 #define KXCJK1013_REG_INT_SRC2_BIT_YN   BIT(3)
  83 #define KXCJK1013_REG_INT_SRC2_BIT_XP   BIT(4)
  84 #define KXCJK1013_REG_INT_SRC2_BIT_XN   BIT(5)
  85
  86 #define KXCJK1013_DEFAULT_WAKE_THRES    1
  87
  88 enum kx_chipset {
  89         KXCJK1013,
  90         KXCJ91008,
  91         KXTJ21009,
  92         KX_MAX_CHIPS /* this must be last */
  93 };
  94
  95 struct kxcjk1013_data {
  96         struct i2c_client *client;
  97         struct iio_trigger *dready_trig;
  98         struct iio_trigger *motion_trig;
  99         struct mutex mutex;
 100         s16 buffer[8];
 101         u8 odr_bits;
 102         u8 range;
 103         int wake_thres;
 104         int wake_dur;
 105         bool active_high_intr;
 106         bool dready_trigger_on;
 107         int ev_enable_state;
 108         bool motion_trigger_on;
 109         int64_t timestamp;
 110         enum kx_chipset chipset;
 111         bool is_smo8500_device;
 112 };
 113
 114 enum kxcjk1013_axis {
 115         AXIS_X,
 116         AXIS_Y,
 117         AXIS_Z,
 118         AXIS_MAX,
 119 };
 120
 121 enum kxcjk1013_mode {
 122         STANDBY,
 123         OPERATION,
 124 };
 125
 126 enum kxcjk1013_range {
 127         KXCJK1013_RANGE_2G,
 128         KXCJK1013_RANGE_4G,
 129         KXCJK1013_RANGE_8G,
 130 };
 131
 132 static const struct {
 133         int val;
 134         int val2;
 135         int odr_bits;
 136 } samp_freq_table[] = { {0, 781000, 0x08}, {1, 563000, 0x09},
 137                         {3, 125000, 0x0A}, {6, 250000, 0x0B}, {12, 500000, 0},
 138                         {25, 0, 0x01}, {50, 0, 0x02}, {100, 0, 0x03},
 139                         {200, 0, 0x04}, {400, 0, 0x05}, {800, 0, 0x06},
 140                         {1600, 0, 0x07} };
 141
 142 /* Refer to section 4 of the specification */
 143 static const struct {
 144         int odr_bits;
 145         int usec;
 146 } odr_start_up_times[KX_MAX_CHIPS][12] = {
 147         /* KXCJK-1013 */
 148         {
 149                 {0x08, 100000},
 150                 {0x09, 100000},
 151                 {0x0A, 100000},
 152                 {0x0B, 100000},
 153                 {0, 80000},
 154                 {0x01, 41000},
 155                 {0x02, 21000},
 156                 {0x03, 11000},
 157                 {0x04, 6400},
 158                 {0x05, 3900},
 159                 {0x06, 2700},
 160                 {0x07, 2100},
 161         },
 162         /* KXCJ9-1008 */
 163         {
 164                 {0x08, 100000},
 165                 {0x09, 100000},
 166                 {0x0A, 100000},
 167                 {0x0B, 100000},
 168                 {0, 80000},
 169                 {0x01, 41000},
 170                 {0x02, 21000},
 171                 {0x03, 11000},
 172                 {0x04, 6400},
 173                 {0x05, 3900},
 174                 {0x06, 2700},
 175                 {0x07, 2100},
 176         },
 177         /* KXCTJ2-1009 */
 178         {
 179                 {0x08, 1240000},
 180                 {0x09, 621000},
 181                 {0x0A, 309000},
 182                 {0x0B, 151000},
 183                 {0, 80000},
 184                 {0x01, 41000},
 185                 {0x02, 21000},
 186                 {0x03, 11000},
 187                 {0x04, 6000},
 188                 {0x05, 4000},
 189                 {0x06, 3000},
 190                 {0x07, 2000},
 191         },
 192 };
 193
 194 static const struct {
 195         u16 scale;
 196         u8 gsel_0;
 197         u8 gsel_1;
 198 } KXCJK1013_scale_table[] = { {9582, 0, 0},
 199                               {19163, 1, 0},
 200                               {38326, 0, 1} };
 201
 202 static const struct {
 203         int val;
 204         int val2;
 205         int odr_bits;
 206 } wake_odr_data_rate_table[] = { {0, 781000, 0x00},
 207                                  {1, 563000, 0x01},
 208                                  {3, 125000, 0x02},
 209                                  {6, 250000, 0x03},
 210                                  {12, 500000, 0x04},
 211                                  {25, 0, 0x05},
 212                                  {50, 0, 0x06},
 213                                  {100, 0, 0x06},
 214                                  {200, 0, 0x06},
 215                                  {400, 0, 0x06},
 216                                  {800, 0, 0x06},
 217                                  {1600, 0, 0x06} };
 218
 219 static int kxcjk1013_set_mode(struct kxcjk1013_data *data,
 220                               enum kxcjk1013_mode mode)
 221 {
 222         int ret;
 223
 224         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
 225         if (ret < 0) {
 226                 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
 227                 return ret;
 228         }
 229
 230         if (mode == STANDBY)
 231                 ret &= ~KXCJK1013_REG_CTRL1_BIT_PC1;
 232         else
 233                 ret |= KXCJK1013_REG_CTRL1_BIT_PC1;
 234
 235         ret = i2c_smbus_write_byte_data(data->client,
 236                                         KXCJK1013_REG_CTRL1, ret);
 237         if (ret < 0) {
 238                 dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
 239                 return ret;
 240         }
 241
 242         return 0;
 243 }
 244
 245 static int kxcjk1013_get_mode(struct kxcjk1013_data *data,
 246                               enum kxcjk1013_mode *mode)
 247 {
 248         int ret;
 249
 250         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
 251         if (ret < 0) {
 252                 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
 253                 return ret;
 254         }
 255
 256         if (ret & KXCJK1013_REG_CTRL1_BIT_PC1)
 257                 *mode = OPERATION;
 258         else
 259                 *mode = STANDBY;
 260
 261         return 0;
 262 }
 263
 264 static int kxcjk1013_set_range(struct kxcjk1013_data *data, int range_index)
 265 {
 266         int ret;
 267
 268         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
 269         if (ret < 0) {
 270                 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
 271                 return ret;
 272         }
 273
 274         ret &= ~(KXCJK1013_REG_CTRL1_BIT_GSEL0 |
 275                  KXCJK1013_REG_CTRL1_BIT_GSEL1);
 276         ret |= (KXCJK1013_scale_table[range_index].gsel_0 << 3);
 277         ret |= (KXCJK1013_scale_table[range_index].gsel_1 << 4);
 278
 279         ret = i2c_smbus_write_byte_data(data->client,
 280                                         KXCJK1013_REG_CTRL1,
 281                                         ret);
 282         if (ret < 0) {
 283                 dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
 284                 return ret;
 285         }
 286
 287         data->range = range_index;
 288
 289         return 0;
 290 }
 291
 292 static int kxcjk1013_chip_init(struct kxcjk1013_data *data)
 293 {
 294         int ret;
 295
 296         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_WHO_AM_I);
 297         if (ret < 0) {
 298                 dev_err(&data->client->dev, "Error reading who_am_i\n");
 299                 return ret;
 300         }
 301
 302         dev_dbg(&data->client->dev, "KXCJK1013 Chip Id %x\n", ret);
 303
 304         ret = kxcjk1013_set_mode(data, STANDBY);
 305         if (ret < 0)
 306                 return ret;
 307
 308         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
 309         if (ret < 0) {
 310                 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
 311                 return ret;
 312         }
 313
 314         /* Set 12 bit mode */
 315         ret |= KXCJK1013_REG_CTRL1_BIT_RES;
 316
 317         ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_CTRL1,
 318                                         ret);
 319         if (ret < 0) {
 320                 dev_err(&data->client->dev, "Error reading reg_ctrl\n");
 321                 return ret;
 322         }
 323
 324         /* Setting range to 4G */
 325         ret = kxcjk1013_set_range(data, KXCJK1013_RANGE_4G);
 326         if (ret < 0)
 327                 return ret;
 328
 329         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_DATA_CTRL);
 330         if (ret < 0) {
 331                 dev_err(&data->client->dev, "Error reading reg_data_ctrl\n");
 332                 return ret;
 333         }
 334
 335         data->odr_bits = ret;
 336
 337         /* Set up INT polarity */
 338         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_CTRL1);
 339         if (ret < 0) {
 340                 dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n");
 341                 return ret;
 342         }
 343
 344         if (data->active_high_intr)
 345                 ret |= KXCJK1013_REG_INT_REG1_BIT_IEA;
 346         else
 347                 ret &= ~KXCJK1013_REG_INT_REG1_BIT_IEA;
 348
 349         ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_INT_CTRL1,
 350                                         ret);
 351         if (ret < 0) {
 352                 dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n");
 353                 return ret;
 354         }
 355
 356         ret = kxcjk1013_set_mode(data, OPERATION);
 357         if (ret < 0)
 358                 return ret;
 359
 360         data->wake_thres = KXCJK1013_DEFAULT_WAKE_THRES;
 361
 362         return 0;
 363 }
 364
 365 #ifdef CONFIG_PM
 366 static int kxcjk1013_get_startup_times(struct kxcjk1013_data *data)
 367 {
 368         int i;
 369         int idx = data->chipset;
 370
 371         for (i = 0; i < ARRAY_SIZE(odr_start_up_times[idx]); ++i) {
 372                 if (odr_start_up_times[idx][i].odr_bits == data->odr_bits)
 373                         return odr_start_up_times[idx][i].usec;
 374         }
 375
 376         return KXCJK1013_MAX_STARTUP_TIME_US;
 377 }
 378 #endif
 379
 380 static int kxcjk1013_set_power_state(struct kxcjk1013_data *data, bool on)
 381 {
 382 #ifdef CONFIG_PM
 383         int ret;
 384
 385         if (on)
 386                 ret = pm_runtime_get_sync(&data->client->dev);
 387         else {
 388                 pm_runtime_mark_last_busy(&data->client->dev);
 389                 ret = pm_runtime_put_autosuspend(&data->client->dev);
 390         }
 391         if (ret < 0) {
 392                 dev_err(&data->client->dev,
 393                         "Failed: kxcjk1013_set_power_state for %d\n", on);
 394                 if (on)
 395                         pm_runtime_put_noidle(&data->client->dev);
 396                 return ret;
 397         }
 398 #endif
 399
 400         return 0;
 401 }
 402
 403 static int kxcjk1013_chip_update_thresholds(struct kxcjk1013_data *data)
 404 {
 405         int ret;
 406
 407         ret = i2c_smbus_write_byte_data(data->client,
 408                                         KXCJK1013_REG_WAKE_TIMER,
 409                                         data->wake_dur);
 410         if (ret < 0) {
 411                 dev_err(&data->client->dev,
 412                         "Error writing reg_wake_timer\n");
 413                 return ret;
 414         }
 415
 416         ret = i2c_smbus_write_byte_data(data->client,
 417                                         KXCJK1013_REG_WAKE_THRES,
 418                                         data->wake_thres);
 419         if (ret < 0) {
 420                 dev_err(&data->client->dev, "Error writing reg_wake_thres\n");
 421                 return ret;
 422         }
 423
 424         return 0;
 425 }
 426
 427 static int kxcjk1013_setup_any_motion_interrupt(struct kxcjk1013_data *data,
 428                                                 bool status)
 429 {
 430         int ret;
 431         enum kxcjk1013_mode store_mode;
 432
 433         ret = kxcjk1013_get_mode(data, &store_mode);
 434         if (ret < 0)
 435                 return ret;
 436
 437         /* This is requirement by spec to change state to STANDBY */
 438         ret = kxcjk1013_set_mode(data, STANDBY);
 439         if (ret < 0)
 440                 return ret;
 441
 442         ret = kxcjk1013_chip_update_thresholds(data);
 443         if (ret < 0)
 444                 return ret;
 445
 446         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_CTRL1);
 447         if (ret < 0) {
 448                 dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n");
 449                 return ret;
 450         }
 451
 452         if (status)
 453                 ret |= KXCJK1013_REG_INT_REG1_BIT_IEN;
 454         else
 455                 ret &= ~KXCJK1013_REG_INT_REG1_BIT_IEN;
 456
 457         ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_INT_CTRL1,
 458                                         ret);
 459         if (ret < 0) {
 460                 dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n");
 461                 return ret;
 462         }
 463
 464         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
 465         if (ret < 0) {
 466                 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
 467                 return ret;
 468         }
 469
 470         if (status)
 471                 ret |= KXCJK1013_REG_CTRL1_BIT_WUFE;
 472         else
 473                 ret &= ~KXCJK1013_REG_CTRL1_BIT_WUFE;
 474
 475         ret = i2c_smbus_write_byte_data(data->client,
 476                                         KXCJK1013_REG_CTRL1, ret);
 477         if (ret < 0) {
 478                 dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
 479                 return ret;
 480         }
 481
 482         if (store_mode == OPERATION) {
 483                 ret = kxcjk1013_set_mode(data, OPERATION);
 484                 if (ret < 0)
 485                         return ret;
 486         }
 487
 488         return 0;
 489 }
 490
 491 static int kxcjk1013_setup_new_data_interrupt(struct kxcjk1013_data *data,
 492                                               bool status)
 493 {
 494         int ret;
 495         enum kxcjk1013_mode store_mode;
 496
 497         ret = kxcjk1013_get_mode(data, &store_mode);
 498         if (ret < 0)
 499                 return ret;
 500
 501         /* This is requirement by spec to change state to STANDBY */
 502         ret = kxcjk1013_set_mode(data, STANDBY);
 503         if (ret < 0)
 504                 return ret;
 505
 506         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_CTRL1);
 507         if (ret < 0) {
 508                 dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n");
 509                 return ret;
 510         }
 511
 512         if (status)
 513                 ret |= KXCJK1013_REG_INT_REG1_BIT_IEN;
 514         else
 515                 ret &= ~KXCJK1013_REG_INT_REG1_BIT_IEN;
 516
 517         ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_INT_CTRL1,
 518                                         ret);
 519         if (ret < 0) {
 520                 dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n");
 521                 return ret;
 522         }
 523
 524         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
 525         if (ret < 0) {
 526                 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
 527                 return ret;
 528         }
 529
 530         if (status)
 531                 ret |= KXCJK1013_REG_CTRL1_BIT_DRDY;
 532         else
 533                 ret &= ~KXCJK1013_REG_CTRL1_BIT_DRDY;
 534
 535         ret = i2c_smbus_write_byte_data(data->client,
 536                                         KXCJK1013_REG_CTRL1, ret);
 537         if (ret < 0) {
 538                 dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
 539                 return ret;
 540         }
 541
 542         if (store_mode == OPERATION) {
 543                 ret = kxcjk1013_set_mode(data, OPERATION);
 544                 if (ret < 0)
 545                         return ret;
 546         }
 547
 548         return 0;
 549 }
 550
 551 static int kxcjk1013_convert_freq_to_bit(int val, int val2)
 552 {
 553         int i;
 554
 555         for (i = 0; i < ARRAY_SIZE(samp_freq_table); ++i) {
 556                 if (samp_freq_table[i].val == val &&
 557                         samp_freq_table[i].val2 == val2) {
 558                         return samp_freq_table[i].odr_bits;
 559                 }
 560         }
 561
 562         return -EINVAL;
 563 }
 564
 565 static int kxcjk1013_convert_wake_odr_to_bit(int val, int val2)
 566 {
 567         int i;
 568
 569         for (i = 0; i < ARRAY_SIZE(wake_odr_data_rate_table); ++i) {
 570                 if (wake_odr_data_rate_table[i].val == val &&
 571                         wake_odr_data_rate_table[i].val2 == val2) {
 572                         return wake_odr_data_rate_table[i].odr_bits;
 573                 }
 574         }
 575
 576         return -EINVAL;
 577 }
 578
 579 static int kxcjk1013_set_odr(struct kxcjk1013_data *data, int val, int val2)
 580 {
 581         int ret;
 582         int odr_bits;
 583         enum kxcjk1013_mode store_mode;
 584
 585         ret = kxcjk1013_get_mode(data, &store_mode);
 586         if (ret < 0)
 587                 return ret;
 588
 589         odr_bits = kxcjk1013_convert_freq_to_bit(val, val2);
 590         if (odr_bits < 0)
 591                 return odr_bits;
 592
 593         /* To change ODR, the chip must be set to STANDBY as per spec */
 594         ret = kxcjk1013_set_mode(data, STANDBY);
 595         if (ret < 0)
 596                 return ret;
 597
 598         ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_DATA_CTRL,
 599                                         odr_bits);
 600         if (ret < 0) {
 601                 dev_err(&data->client->dev, "Error writing data_ctrl\n");
 602                 return ret;
 603         }
 604
 605         data->odr_bits = odr_bits;
 606
 607         odr_bits = kxcjk1013_convert_wake_odr_to_bit(val, val2);
 608         if (odr_bits < 0)
 609                 return odr_bits;
 610
 611         ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_CTRL2,
 612                                         odr_bits);
 613         if (ret < 0) {
 614                 dev_err(&data->client->dev, "Error writing reg_ctrl2\n");
 615                 return ret;
 616         }
 617
 618         if (store_mode == OPERATION) {
 619                 ret = kxcjk1013_set_mode(data, OPERATION);
 620                 if (ret < 0)
 621                         return ret;
 622         }
 623
 624         return 0;
 625 }
 626
 627 static int kxcjk1013_get_odr(struct kxcjk1013_data *data, int *val, int *val2)
 628 {
 629         int i;
 630
 631         for (i = 0; i < ARRAY_SIZE(samp_freq_table); ++i) {
 632                 if (samp_freq_table[i].odr_bits == data->odr_bits) {
 633                         *val = samp_freq_table[i].val;
 634                         *val2 = samp_freq_table[i].val2;
 635                         return IIO_VAL_INT_PLUS_MICRO;
 636                 }
 637         }
 638
 639         return -EINVAL;
 640 }
 641
 642 static int kxcjk1013_get_acc_reg(struct kxcjk1013_data *data, int axis)
 643 {
 644         u8 reg = KXCJK1013_REG_XOUT_L + axis * 2;
 645         int ret;
 646
 647         ret = i2c_smbus_read_word_data(data->client, reg);
 648         if (ret < 0) {
 649                 dev_err(&data->client->dev,
 650                         "failed to read accel_%c registers\n", 'x' + axis);
 651                 return ret;
 652         }
 653
 654         return ret;
 655 }
 656
 657 static int kxcjk1013_set_scale(struct kxcjk1013_data *data, int val)
 658 {
 659         int ret, i;
 660         enum kxcjk1013_mode store_mode;
 661
 662         for (i = 0; i < ARRAY_SIZE(KXCJK1013_scale_table); ++i) {
 663                 if (KXCJK1013_scale_table[i].scale == val) {
 664                         ret = kxcjk1013_get_mode(data, &store_mode);
 665                         if (ret < 0)
 666                                 return ret;
 667
 668                         ret = kxcjk1013_set_mode(data, STANDBY);
 669                         if (ret < 0)
 670                                 return ret;
 671
 672                         ret = kxcjk1013_set_range(data, i);
 673                         if (ret < 0)
 674                                 return ret;
 675
 676                         if (store_mode == OPERATION) {
 677                                 ret = kxcjk1013_set_mode(data, OPERATION);
 678                                 if (ret)
 679                                         return ret;
 680                         }
 681
 682                         return 0;
 683                 }
 684         }
 685
 686         return -EINVAL;
 687 }
 688
 689 static int kxcjk1013_read_raw(struct iio_dev *indio_dev,
 690                               struct iio_chan_spec const *chan, int *val,
 691                               int *val2, long mask)
 692 {
 693         struct kxcjk1013_data *data = iio_priv(indio_dev);
 694         int ret;
 695
 696         switch (mask) {
 697         case IIO_CHAN_INFO_RAW:
 698                 mutex_lock(&data->mutex);
 699                 if (iio_buffer_enabled(indio_dev))
 700                         ret = -EBUSY;
 701                 else {
 702                         ret = kxcjk1013_set_power_state(data, true);
 703                         if (ret < 0) {
 704                                 mutex_unlock(&data->mutex);
 705                                 return ret;
 706                         }
 707                         ret = kxcjk1013_get_acc_reg(data, chan->scan_index);
 708                         if (ret < 0) {
 709                                 kxcjk1013_set_power_state(data, false);
 710                                 mutex_unlock(&data->mutex);
 711                                 return ret;
 712                         }
 713                         *val = sign_extend32(ret >> 4, 11);
 714                         ret = kxcjk1013_set_power_state(data, false);
 715                 }
 716                 mutex_unlock(&data->mutex);
 717
 718                 if (ret < 0)
 719                         return ret;
 720
 721                 return IIO_VAL_INT;
 722
 723         case IIO_CHAN_INFO_SCALE:
 724                 *val = 0;
 725                 *val2 = KXCJK1013_scale_table[data->range].scale;
 726                 return IIO_VAL_INT_PLUS_MICRO;
 727
 728         case IIO_CHAN_INFO_SAMP_FREQ:
 729                 mutex_lock(&data->mutex);
 730                 ret = kxcjk1013_get_odr(data, val, val2);
 731                 mutex_unlock(&data->mutex);
 732                 return ret;
 733
 734         default:
 735                 return -EINVAL;
 736         }
 737 }
 738
 739 static int kxcjk1013_write_raw(struct iio_dev *indio_dev,
 740                                struct iio_chan_spec const *chan, int val,
 741                                int val2, long mask)
 742 {
 743         struct kxcjk1013_data *data = iio_priv(indio_dev);
 744         int ret;
 745
 746         switch (mask) {
 747         case IIO_CHAN_INFO_SAMP_FREQ:
 748                 mutex_lock(&data->mutex);
 749                 ret = kxcjk1013_set_odr(data, val, val2);
 750                 mutex_unlock(&data->mutex);
 751                 break;
 752         case IIO_CHAN_INFO_SCALE:
 753                 if (val)
 754                         return -EINVAL;
 755
 756                 mutex_lock(&data->mutex);
 757                 ret = kxcjk1013_set_scale(data, val2);
 758                 mutex_unlock(&data->mutex);
 759                 break;
 760         default:
 761                 ret = -EINVAL;
 762         }
 763
 764         return ret;
 765 }
 766
 767 static int kxcjk1013_read_event(struct iio_dev *indio_dev,
 768                                    const struct iio_chan_spec *chan,
 769                                    enum iio_event_type type,
 770                                    enum iio_event_direction dir,
 771                                    enum iio_event_info info,
 772                                    int *val, int *val2)
 773 {
 774         struct kxcjk1013_data *data = iio_priv(indio_dev);
 775
 776         *val2 = 0;
 777         switch (info) {
 778         case IIO_EV_INFO_VALUE:
 779                 *val = data->wake_thres;
 780                 break;
 781         case IIO_EV_INFO_PERIOD:
 782                 *val = data->wake_dur;
 783                 break;
 784         default:
 785                 return -EINVAL;
 786         }
 787
 788         return IIO_VAL_INT;
 789 }
 790
 791 static int kxcjk1013_write_event(struct iio_dev *indio_dev,
 792                                     const struct iio_chan_spec *chan,
 793                                     enum iio_event_type type,
 794                                     enum iio_event_direction dir,
 795                                     enum iio_event_info info,
 796                                     int val, int val2)
 797 {
 798         struct kxcjk1013_data *data = iio_priv(indio_dev);
 799
 800         if (data->ev_enable_state)
 801                 return -EBUSY;
 802
 803         switch (info) {
 804         case IIO_EV_INFO_VALUE:
 805                 data->wake_thres = val;
 806                 break;
 807         case IIO_EV_INFO_PERIOD:
 808                 data->wake_dur = val;
 809                 break;
 810         default:
 811                 return -EINVAL;
 812         }
 813
 814         return 0;
 815 }
 816
 817 static int kxcjk1013_read_event_config(struct iio_dev *indio_dev,
 818                                           const struct iio_chan_spec *chan,
 819                                           enum iio_event_type type,
 820                                           enum iio_event_direction dir)
 821 {
 822         struct kxcjk1013_data *data = iio_priv(indio_dev);
 823
 824         return data->ev_enable_state;
 825 }
 826
 827 static int kxcjk1013_write_event_config(struct iio_dev *indio_dev,
 828                                            const struct iio_chan_spec *chan,
 829                                            enum iio_event_type type,
 830                                            enum iio_event_direction dir,
 831                                            int state)
 832 {
 833         struct kxcjk1013_data *data = iio_priv(indio_dev);
 834         int ret;
 835
 836         if (state && data->ev_enable_state)
 837                 return 0;
 838
 839         mutex_lock(&data->mutex);
 840
 841         if (!state && data->motion_trigger_on) {
 842                 data->ev_enable_state = 0;
 843                 mutex_unlock(&data->mutex);
 844                 return 0;
 845         }
 846
 847         /*
 848          * We will expect the enable and disable to do operation in
 849          * in reverse order. This will happen here anyway as our
 850          * resume operation uses sync mode runtime pm calls, the
 851          * suspend operation will be delayed by autosuspend delay
 852          * So the disable operation will still happen in reverse of
 853          * enable operation. When runtime pm is disabled the mode
 854          * is always on so sequence doesn't matter
 855          */
 856         ret = kxcjk1013_set_power_state(data, state);
 857         if (ret < 0) {
 858                 mutex_unlock(&data->mutex);
 859                 return ret;
 860         }
 861
 862         ret =  kxcjk1013_setup_any_motion_interrupt(data, state);
 863         if (ret < 0) {
 864                 kxcjk1013_set_power_state(data, false);
 865                 data->ev_enable_state = 0;
 866                 mutex_unlock(&data->mutex);
 867                 return ret;
 868         }
 869
 870         data->ev_enable_state = state;
 871         mutex_unlock(&data->mutex);
 872
 873         return 0;
 874 }
 875
 876 static int kxcjk1013_buffer_preenable(struct iio_dev *indio_dev)
 877 {
 878         struct kxcjk1013_data *data = iio_priv(indio_dev);
 879
 880         return kxcjk1013_set_power_state(data, true);
 881 }
 882
 883 static int kxcjk1013_buffer_postdisable(struct iio_dev *indio_dev)
 884 {
 885         struct kxcjk1013_data *data = iio_priv(indio_dev);
 886
 887         return kxcjk1013_set_power_state(data, false);
 888 }
 889
 890 static IIO_CONST_ATTR_SAMP_FREQ_AVAIL(
 891         "0.781000 1.563000 3.125000 6.250000 12.500000 25 50 100 200 400 800 1600");
 892
 893 static IIO_CONST_ATTR(in_accel_scale_available, "0.009582 0.019163 0.038326");
 894
 895 static struct attribute *kxcjk1013_attributes[] = {
 896         &iio_const_attr_sampling_frequency_available.dev_attr.attr,
 897         &iio_const_attr_in_accel_scale_available.dev_attr.attr,
 898         NULL,
 899 };
 900
 901 static const struct attribute_group kxcjk1013_attrs_group = {
 902         .attrs = kxcjk1013_attributes,
 903 };
 904
 905 static const struct iio_event_spec kxcjk1013_event = {
 906                 .type = IIO_EV_TYPE_THRESH,
 907                 .dir = IIO_EV_DIR_EITHER,
 908                 .mask_separate = BIT(IIO_EV_INFO_VALUE) |
 909                                  BIT(IIO_EV_INFO_ENABLE) |
 910                                  BIT(IIO_EV_INFO_PERIOD)
 911 };
 912
 913 #define KXCJK1013_CHANNEL(_axis) {                                      \
 914         .type = IIO_ACCEL,                                              \
 915         .modified = 1,                                                  \
 916         .channel2 = IIO_MOD_##_axis,                                    \
 917         .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),                   \
 918         .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) |          \
 919                                 BIT(IIO_CHAN_INFO_SAMP_FREQ),           \
 920         .scan_index = AXIS_##_axis,                                     \
 921         .scan_type = {                                                  \
 922                 .sign = 's',                                            \
 923                 .realbits = 12,                                         \
 924                 .storagebits = 16,                                      \
 925                 .shift = 4,                                             \
 926                 .endianness = IIO_LE,                                   \
 927         },                                                              \
 928         .event_spec = &kxcjk1013_event,                         \
 929         .num_event_specs = 1                                            \
 930 }
 931
 932 static const struct iio_chan_spec kxcjk1013_channels[] = {
 933         KXCJK1013_CHANNEL(X),
 934         KXCJK1013_CHANNEL(Y),
 935         KXCJK1013_CHANNEL(Z),
 936         IIO_CHAN_SOFT_TIMESTAMP(3),
 937 };
 938
 939 static const struct iio_buffer_setup_ops kxcjk1013_buffer_setup_ops = {
 940         .preenable              = kxcjk1013_buffer_preenable,
 941         .postenable             = iio_triggered_buffer_postenable,
 942         .postdisable            = kxcjk1013_buffer_postdisable,
 943         .predisable             = iio_triggered_buffer_predisable,
 944 };
 945
 946 static const struct iio_info kxcjk1013_info = {
 947         .attrs                  = &kxcjk1013_attrs_group,
 948         .read_raw               = kxcjk1013_read_raw,
 949         .write_raw              = kxcjk1013_write_raw,
 950         .read_event_value       = kxcjk1013_read_event,
 951         .write_event_value      = kxcjk1013_write_event,
 952         .write_event_config     = kxcjk1013_write_event_config,
 953         .read_event_config      = kxcjk1013_read_event_config,
 954         .driver_module          = THIS_MODULE,
 955 };
 956
 957 static const unsigned long kxcjk1013_scan_masks[] = {0x7, 0};
 958
 959 static irqreturn_t kxcjk1013_trigger_handler(int irq, void *p)
 960 {
 961         struct iio_poll_func *pf = p;
 962         struct iio_dev *indio_dev = pf->indio_dev;
 963         struct kxcjk1013_data *data = iio_priv(indio_dev);
 964         int ret;
 965
 966         mutex_lock(&data->mutex);
 967         ret = i2c_smbus_read_i2c_block_data_or_emulated(data->client,
 968                                                         KXCJK1013_REG_XOUT_L,
 969                                                         AXIS_MAX * 2,
 970                                                         (u8 *)data->buffer);
 971         mutex_unlock(&data->mutex);
 972         if (ret < 0)
 973                 goto err;
 974
 975         iio_push_to_buffers_with_timestamp(indio_dev, data->buffer,
 976                                            data->timestamp);
 977 err:
 978         iio_trigger_notify_done(indio_dev->trig);
 979
 980         return IRQ_HANDLED;
 981 }
 982
 983 static int kxcjk1013_trig_try_reen(struct iio_trigger *trig)
 984 {
 985         struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
 986         struct kxcjk1013_data *data = iio_priv(indio_dev);
 987         int ret;
 988
 989         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_REL);
 990         if (ret < 0) {
 991                 dev_err(&data->client->dev, "Error reading reg_int_rel\n");
 992                 return ret;
 993         }
 994
 995         return 0;
 996 }
 997
 998 static int kxcjk1013_data_rdy_trigger_set_state(struct iio_trigger *trig,
 999                                                 bool state)
1000 {
1001         struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
1002         struct kxcjk1013_data *data = iio_priv(indio_dev);
1003         int ret;
1004
1005         mutex_lock(&data->mutex);
1006
1007         if (!state && data->ev_enable_state && data->motion_trigger_on) {
1008                 data->motion_trigger_on = false;
1009                 mutex_unlock(&data->mutex);
1010                 return 0;
1011         }
1012
1013         ret = kxcjk1013_set_power_state(data, state);
1014         if (ret < 0) {
1015                 mutex_unlock(&data->mutex);
1016                 return ret;
1017         }
1018         if (data->motion_trig == trig)
1019                 ret = kxcjk1013_setup_any_motion_interrupt(data, state);
1020         else
1021                 ret = kxcjk1013_setup_new_data_interrupt(data, state);
1022         if (ret < 0) {
1023                 kxcjk1013_set_power_state(data, false);
1024                 mutex_unlock(&data->mutex);
1025                 return ret;
1026         }
1027         if (data->motion_trig == trig)
1028                 data->motion_trigger_on = state;
1029         else
1030                 data->dready_trigger_on = state;
1031
1032         mutex_unlock(&data->mutex);
1033
1034         return 0;
1035 }
1036
1037 static const struct iio_trigger_ops kxcjk1013_trigger_ops = {
1038         .set_trigger_state = kxcjk1013_data_rdy_trigger_set_state,
1039         .try_reenable = kxcjk1013_trig_try_reen,
1040         .owner = THIS_MODULE,
1041 };
1042
1043 static irqreturn_t kxcjk1013_event_handler(int irq, void *private)
1044 {
1045         struct iio_dev *indio_dev = private;
1046         struct kxcjk1013_data *data = iio_priv(indio_dev);
1047         int ret;
1048
1049         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_SRC1);
1050         if (ret < 0) {
1051                 dev_err(&data->client->dev, "Error reading reg_int_src1\n");
1052                 goto ack_intr;
1053         }
1054
1055         if (ret & 0x02) {
1056                 ret = i2c_smbus_read_byte_data(data->client,
1057                                                KXCJK1013_REG_INT_SRC2);
1058                 if (ret < 0) {
1059                         dev_err(&data->client->dev,
1060                                 "Error reading reg_int_src2\n");
1061                         goto ack_intr;
1062                 }
1063
1064                 if (ret & KXCJK1013_REG_INT_SRC2_BIT_XN)
1065                         iio_push_event(indio_dev,
1066                                        IIO_MOD_EVENT_CODE(IIO_ACCEL,
1067                                        0,
1068                                        IIO_MOD_X,
1069                                        IIO_EV_TYPE_THRESH,
1070                                        IIO_EV_DIR_FALLING),
1071                                        data->timestamp);
1072                 if (ret & KXCJK1013_REG_INT_SRC2_BIT_XP)
1073                         iio_push_event(indio_dev,
1074                                        IIO_MOD_EVENT_CODE(IIO_ACCEL,
1075                                        0,
1076                                        IIO_MOD_X,
1077                                        IIO_EV_TYPE_THRESH,
1078                                        IIO_EV_DIR_RISING),
1079                                        data->timestamp);
1080
1081
1082                 if (ret & KXCJK1013_REG_INT_SRC2_BIT_YN)
1083                         iio_push_event(indio_dev,
1084                                        IIO_MOD_EVENT_CODE(IIO_ACCEL,
1085                                        0,
1086                                        IIO_MOD_Y,
1087                                        IIO_EV_TYPE_THRESH,
1088                                        IIO_EV_DIR_FALLING),
1089                                        data->timestamp);
1090                 if (ret & KXCJK1013_REG_INT_SRC2_BIT_YP)
1091                         iio_push_event(indio_dev,
1092                                        IIO_MOD_EVENT_CODE(IIO_ACCEL,
1093                                        0,
1094                                        IIO_MOD_Y,
1095                                        IIO_EV_TYPE_THRESH,
1096                                        IIO_EV_DIR_RISING),
1097                                        data->timestamp);
1098
1099                 if (ret & KXCJK1013_REG_INT_SRC2_BIT_ZN)
1100                         iio_push_event(indio_dev,
1101                                        IIO_MOD_EVENT_CODE(IIO_ACCEL,
1102                                        0,
1103                                        IIO_MOD_Z,
1104                                        IIO_EV_TYPE_THRESH,
1105                                        IIO_EV_DIR_FALLING),
1106                                        data->timestamp);
1107                 if (ret & KXCJK1013_REG_INT_SRC2_BIT_ZP)
1108                         iio_push_event(indio_dev,
1109                                        IIO_MOD_EVENT_CODE(IIO_ACCEL,
1110                                        0,
1111                                        IIO_MOD_Z,
1112                                        IIO_EV_TYPE_THRESH,
1113                                        IIO_EV_DIR_RISING),
1114                                        data->timestamp);
1115         }
1116
1117 ack_intr:
1118         if (data->dready_trigger_on)
1119                 return IRQ_HANDLED;
1120
1121         ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_REL);
1122         if (ret < 0)
1123                 dev_err(&data->client->dev, "Error reading reg_int_rel\n");
1124
1125         return IRQ_HANDLED;
1126 }
1127
1128 static irqreturn_t kxcjk1013_data_rdy_trig_poll(int irq, void *private)
1129 {
1130         struct iio_dev *indio_dev = private;
1131         struct kxcjk1013_data *data = iio_priv(indio_dev);
1132
1133         data->timestamp = iio_get_time_ns();
1134
1135         if (data->dready_trigger_on)
1136                 iio_trigger_poll(data->dready_trig);
1137         else if (data->motion_trigger_on)
1138                 iio_trigger_poll(data->motion_trig);
1139
1140         if (data->ev_enable_state)
1141                 return IRQ_WAKE_THREAD;
1142         else
1143                 return IRQ_HANDLED;
1144 }
1145
1146 static const char *kxcjk1013_match_acpi_device(struct device *dev,
1147                                                enum kx_chipset *chipset,
1148                                                bool *is_smo8500_device)
1149 {
1150         const struct acpi_device_id *id;
1151
1152         id = acpi_match_device(dev->driver->acpi_match_table, dev);
1153         if (!id)
1154                 return NULL;
1155
1156         if (strcmp(id->id, "SMO8500") == 0)
1157                 *is_smo8500_device = true;
1158
1159         *chipset = (enum kx_chipset)id->driver_data;
1160
1161         return dev_name(dev);
1162 }
1163
1164 static int kxcjk1013_probe(struct i2c_client *client,
1165                            const struct i2c_device_id *id)
1166 {
1167         struct kxcjk1013_data *data;
1168         struct iio_dev *indio_dev;
1169         struct kxcjk_1013_platform_data *pdata;
1170         const char *name;
1171         int ret;
1172
1173         indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
1174         if (!indio_dev)
1175                 return -ENOMEM;
1176
1177         data = iio_priv(indio_dev);
1178         i2c_set_clientdata(client, indio_dev);
1179         data->client = client;
1180
1181         pdata = dev_get_platdata(&client->dev);
1182         if (pdata)
1183                 data->active_high_intr = pdata->active_high_intr;
1184         else
1185                 data->active_high_intr = true; /* default polarity */
1186
1187         if (id) {
1188                 data->chipset = (enum kx_chipset)(id->driver_data);
1189                 name = id->name;
1190         } else if (ACPI_HANDLE(&client->dev)) {
1191                 name = kxcjk1013_match_acpi_device(&client->dev,
1192                                                    &data->chipset,
1193                                                    &data->is_smo8500_device);
1194         } else
1195                 return -ENODEV;
1196
1197         ret = kxcjk1013_chip_init(data);
1198         if (ret < 0)
1199                 return ret;
1200
1201         mutex_init(&data->mutex);
1202
1203         indio_dev->dev.parent = &client->dev;
1204         indio_dev->channels = kxcjk1013_channels;
1205         indio_dev->num_channels = ARRAY_SIZE(kxcjk1013_channels);
1206         indio_dev->available_scan_masks = kxcjk1013_scan_masks;
1207         indio_dev->name = name;
1208         indio_dev->modes = INDIO_DIRECT_MODE;
1209         indio_dev->info = &kxcjk1013_info;
1210
1211         if (client->irq > 0 && !data->is_smo8500_device) {
1212                 ret = devm_request_threaded_irq(&client->dev, client->irq,
1213                                                 kxcjk1013_data_rdy_trig_poll,
1214                                                 kxcjk1013_event_handler,
1215                                                 IRQF_TRIGGER_RISING,
1216                                                 KXCJK1013_IRQ_NAME,
1217                                                 indio_dev);
1218                 if (ret)
1219                         goto err_poweroff;
1220
1221                 data->dready_trig = devm_iio_trigger_alloc(&client->dev,
1222                                                            "%s-dev%d",
1223                                                            indio_dev->name,
1224                                                            indio_dev->id);
1225                 if (!data->dready_trig) {
1226                         ret = -ENOMEM;
1227                         goto err_poweroff;
1228                 }
1229
1230                 data->motion_trig = devm_iio_trigger_alloc(&client->dev,
1231                                                           "%s-any-motion-dev%d",
1232                                                           indio_dev->name,
1233                                                           indio_dev->id);
1234                 if (!data->motion_trig) {
1235                         ret = -ENOMEM;
1236                         goto err_poweroff;
1237                 }
1238
1239                 data->dready_trig->dev.parent = &client->dev;
1240                 data->dready_trig->ops = &kxcjk1013_trigger_ops;
1241                 iio_trigger_set_drvdata(data->dready_trig, indio_dev);
1242                 indio_dev->trig = data->dready_trig;
1243                 iio_trigger_get(indio_dev->trig);
1244                 ret = iio_trigger_register(data->dready_trig);
1245                 if (ret)
1246                         goto err_poweroff;
1247
1248                 data->motion_trig->dev.parent = &client->dev;
1249                 data->motion_trig->ops = &kxcjk1013_trigger_ops;
1250                 iio_trigger_set_drvdata(data->motion_trig, indio_dev);
1251                 ret = iio_trigger_register(data->motion_trig);
1252                 if (ret) {
1253                         data->motion_trig = NULL;
1254                         goto err_trigger_unregister;
1255                 }
1256         }
1257
1258         ret = iio_triggered_buffer_setup(indio_dev,
1259                                          &iio_pollfunc_store_time,
1260                                          kxcjk1013_trigger_handler,
1261                                          &kxcjk1013_buffer_setup_ops);
1262         if (ret < 0) {
1263                 dev_err(&client->dev, "iio triggered buffer setup failed\n");
1264                 goto err_trigger_unregister;
1265         }
1266
1267         ret = pm_runtime_set_active(&client->dev);
1268         if (ret)
1269                 goto err_buffer_cleanup;
1270
1271         pm_runtime_enable(&client->dev);
1272         pm_runtime_set_autosuspend_delay(&client->dev,
1273                                          KXCJK1013_SLEEP_DELAY_MS);
1274         pm_runtime_use_autosuspend(&client->dev);
1275
1276         ret = iio_device_register(indio_dev);
1277         if (ret < 0) {
1278                 dev_err(&client->dev, "unable to register iio device\n");
1279                 goto err_buffer_cleanup;
1280         }
1281
1282         return 0;
1283
1284 err_buffer_cleanup:
1285         if (data->dready_trig)
1286                 iio_triggered_buffer_cleanup(indio_dev);
1287 err_trigger_unregister:
1288         if (data->dready_trig)
1289                 iio_trigger_unregister(data->dready_trig);
1290         if (data->motion_trig)
1291                 iio_trigger_unregister(data->motion_trig);
1292 err_poweroff:
1293         kxcjk1013_set_mode(data, STANDBY);
1294
1295         return ret;
1296 }
1297
1298 static int kxcjk1013_remove(struct i2c_client *client)
1299 {
1300         struct iio_dev *indio_dev = i2c_get_clientdata(client);
1301         struct kxcjk1013_data *data = iio_priv(indio_dev);
1302
1303         iio_device_unregister(indio_dev);
1304
1305         pm_runtime_disable(&client->dev);
1306         pm_runtime_set_suspended(&client->dev);
1307         pm_runtime_put_noidle(&client->dev);
1308
1309         if (data->dready_trig) {
1310                 iio_triggered_buffer_cleanup(indio_dev);
1311                 iio_trigger_unregister(data->dready_trig);
1312                 iio_trigger_unregister(data->motion_trig);
1313         }
1314
1315         mutex_lock(&data->mutex);
1316         kxcjk1013_set_mode(data, STANDBY);
1317         mutex_unlock(&data->mutex);
1318
1319         return 0;
1320 }
1321
1322 #ifdef CONFIG_PM_SLEEP
1323 static int kxcjk1013_suspend(struct device *dev)
1324 {
1325         struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1326         struct kxcjk1013_data *data = iio_priv(indio_dev);
1327         int ret;
1328
1329         mutex_lock(&data->mutex);
1330         ret = kxcjk1013_set_mode(data, STANDBY);
1331         mutex_unlock(&data->mutex);
1332
1333         return ret;
1334 }
1335
1336 static int kxcjk1013_resume(struct device *dev)
1337 {
1338         struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1339         struct kxcjk1013_data *data = iio_priv(indio_dev);
1340         int ret = 0;
1341
1342         mutex_lock(&data->mutex);
1343         ret = kxcjk1013_set_mode(data, OPERATION);
1344         mutex_unlock(&data->mutex);
1345
1346         return ret;
1347 }
1348 #endif
1349
1350 #ifdef CONFIG_PM
1351 static int kxcjk1013_runtime_suspend(struct device *dev)
1352 {
1353         struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1354         struct kxcjk1013_data *data = iio_priv(indio_dev);
1355         int ret;
1356
1357         ret = kxcjk1013_set_mode(data, STANDBY);
1358         if (ret < 0) {
1359                 dev_err(&data->client->dev, "powering off device failed\n");
1360                 return -EAGAIN;
1361         }
1362         return 0;
1363 }
1364
1365 static int kxcjk1013_runtime_resume(struct device *dev)
1366 {
1367         struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1368         struct kxcjk1013_data *data = iio_priv(indio_dev);
1369         int ret;
1370         int sleep_val;
1371
1372         ret = kxcjk1013_set_mode(data, OPERATION);
1373         if (ret < 0)
1374                 return ret;
1375
1376         sleep_val = kxcjk1013_get_startup_times(data);
1377         if (sleep_val < 20000)
1378                 usleep_range(sleep_val, 20000);
1379         else
1380                 msleep_interruptible(sleep_val/1000);
1381
1382         return 0;
1383 }
1384 #endif
1385
1386 static const struct dev_pm_ops kxcjk1013_pm_ops = {
1387         SET_SYSTEM_SLEEP_PM_OPS(kxcjk1013_suspend, kxcjk1013_resume)
1388         SET_RUNTIME_PM_OPS(kxcjk1013_runtime_suspend,
1389                            kxcjk1013_runtime_resume, NULL)
1390 };
1391
1392 static const struct acpi_device_id kx_acpi_match[] = {
1393         {"KXCJ1013", KXCJK1013},
1394         {"KXCJ1008", KXCJ91008},
1395         {"KXCJ9000", KXCJ91008},
1396         {"KXTJ1009", KXTJ21009},
1397         {"SMO8500",  KXCJ91008},
1398         { },
1399 };
1400 MODULE_DEVICE_TABLE(acpi, kx_acpi_match);
1401
1402 static const struct i2c_device_id kxcjk1013_id[] = {
1403         {"kxcjk1013", KXCJK1013},
1404         {"kxcj91008", KXCJ91008},
1405         {"kxtj21009", KXTJ21009},
1406         {"SMO8500",   KXCJ91008},
1407         {}
1408 };
1409
1410 MODULE_DEVICE_TABLE(i2c, kxcjk1013_id);
1411
1412 static struct i2c_driver kxcjk1013_driver = {
1413         .driver = {
1414                 .name   = KXCJK1013_DRV_NAME,
1415                 .acpi_match_table = ACPI_PTR(kx_acpi_match),
1416                 .pm     = &kxcjk1013_pm_ops,
1417         },
1418         .probe          = kxcjk1013_probe,
1419         .remove         = kxcjk1013_remove,
1420         .id_table       = kxcjk1013_id,
1421 };
1422 module_i2c_driver(kxcjk1013_driver);
1423
1424 MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
1425 MODULE_LICENSE("GPL v2");
1426 MODULE_DESCRIPTION("KXCJK1013 accelerometer driver");