Add support for Freescale MMA9553L Intelligent Pedometer Platform.

The following functionalities are supported:
 - step counter (counts the number of steps using a HW register)
 - step detector (generates an iio event at every step the user takes)
 - activity recognition (rest, walking, jogging, running)
 - speed
 - calories
 - distance

To get accurate pedometer results, the user's height, weight and gender
need to be configured.

The specifications can be downloaded from:
http://www.freescale.com/files/sensors/doc/ref_manual/MMA955xLSWRM.pdf
http://www.freescale.com/files/sensors/doc/ref_manual/MMA9553LSWRM.pdf

Signed-off-by: Irina Tirdea <irina.tir...@intel.com>
---
 drivers/iio/accel/Kconfig        |   12 +-
 drivers/iio/accel/Makefile       |    1 +
 drivers/iio/accel/mma9551_core.c |   88 +++
 drivers/iio/accel/mma9551_core.h |   17 +-
 drivers/iio/accel/mma9553.c      | 1239 ++++++++++++++++++++++++++++++++++++++
 5 files changed, 1355 insertions(+), 2 deletions(-)
 create mode 100644 drivers/iio/accel/mma9553.c

diff --git a/drivers/iio/accel/Kconfig b/drivers/iio/accel/Kconfig
index 0600798..afd50d0 100644
--- a/drivers/iio/accel/Kconfig
+++ b/drivers/iio/accel/Kconfig
@@ -107,7 +107,7 @@ config KXCJK1013
 
 config MMA9551_CORE
        tristate
-       depends on MMA9551
+       depends on MMA9551 || MMA9553
 
 config MMA9551
        tristate "Freescale MMA9551L Intelligent Motion-Sensing Platform Driver"
@@ -121,4 +121,14 @@ config MMA9551
          To compile this driver as a module, choose M here: the module
          will be called mma9551.
 
+config MMA9553
+       tristate "Freescale MMA9553L Intelligent Pedometer Platform Driver"
+       depends on I2C
+       select MMA9551_CORE
+       help
+         Say yes here to build support for the Freescale MMA9553L
+         Intelligent Pedometer Platform Driver.
+
+         To compile this driver as a module, choose M here: the module
+         will be called mma9553.
 endmenu
diff --git a/drivers/iio/accel/Makefile b/drivers/iio/accel/Makefile
index 8105316..f815695 100644
--- a/drivers/iio/accel/Makefile
+++ b/drivers/iio/accel/Makefile
@@ -12,6 +12,7 @@ obj-$(CONFIG_MMA8452) += mma8452.o
 
 obj-$(CONFIG_MMA9551_CORE)     += mma9551_core.o
 obj-$(CONFIG_MMA9551)          += mma9551.o
+obj-$(CONFIG_MMA9553)          += mma9553.o
 
 obj-$(CONFIG_IIO_ST_ACCEL_3AXIS) += st_accel.o
 st_accel-y := st_accel_core.o
diff --git a/drivers/iio/accel/mma9551_core.c b/drivers/iio/accel/mma9551_core.c
index cab481b..743a868 100644
--- a/drivers/iio/accel/mma9551_core.c
+++ b/drivers/iio/accel/mma9551_core.c
@@ -53,6 +53,11 @@
 #define MMA9551_AFE_Y_ACCEL_REG                0x02
 #define MMA9551_AFE_Z_ACCEL_REG                0x04
 
+/* Reset/Suspend/Clear application */
+#define MMA9551_RSC_RESET              0x00
+#define MMA9551_RSC_OFFSET(mask)       (3 - (ffs(mask) - 1) / 8)
+#define MMA9551_RSC_VAL(mask)          (mask >> (((ffs(mask) - 1) / 8) * 8))
+
 /*
  * A response is composed of:
  * - control registers: MB0-3
@@ -215,6 +220,30 @@ int mma9551_read_status_byte(struct i2c_client *client, u8 
app_id,
 }
 EXPORT_SYMBOL(mma9551_read_status_byte);
 
+int mma9551_read_config_word(struct i2c_client *client, u8 app_id,
+                           u16 reg, u16 *val)
+{
+       int ret;
+       __be16 v;
+
+       ret = mma9551_transfer(client, app_id, MMA9551_CMD_READ_CONFIG,
+                              reg, NULL, 0, (u8 *)&v, 2);
+       *val = be16_to_cpu(v);
+
+       return ret;
+}
+EXPORT_SYMBOL(mma9551_read_config_word);
+
+int mma9551_write_config_word(struct i2c_client *client, u8 app_id,
+                            u16 reg, u16 val)
+{
+       __be16 v = cpu_to_be16(val);
+
+       return mma9551_transfer(client, app_id, MMA9551_CMD_WRITE_CONFIG, reg,
+                               (u8 *) &v, 2, NULL, 0);
+}
+EXPORT_SYMBOL(mma9551_write_config_word);
+
 int mma9551_read_status_word(struct i2c_client *client, u8 app_id,
                             u16 reg, u16 *val)
 {
@@ -229,6 +258,56 @@ int mma9551_read_status_word(struct i2c_client *client, u8 
app_id,
 }
 EXPORT_SYMBOL(mma9551_read_status_word);
 
+int mma9551_read_config_words(struct i2c_client *client, u8 app_id,
+                            u16 reg, u8 len, u16 *buf)
+{
+       int ret, i;
+       int len_words = len / sizeof(u16);
+       __be16 be_buf[MMA9551_MAX_MAILBOX_DATA_REGS];
+
+       ret = mma9551_transfer(client, app_id, MMA9551_CMD_READ_CONFIG,
+                              reg, NULL, 0, (u8 *) be_buf, len);
+       if (ret < 0)
+               return ret;
+
+       for (i = 0; i < len_words; i++)
+               buf[i] = be16_to_cpu(be_buf[i]);
+       return 0;
+}
+EXPORT_SYMBOL(mma9551_read_config_words);
+
+int mma9551_read_status_words(struct i2c_client *client, u8 app_id,
+                             u16 reg, u8 len, u16 *buf)
+{
+       int ret, i;
+       int len_words = len / sizeof(u16);
+       __be16 be_buf[MMA9551_MAX_MAILBOX_DATA_REGS];
+
+       ret = mma9551_transfer(client, app_id, MMA9551_CMD_READ_STATUS,
+                              reg, NULL, 0, (u8 *) be_buf, len);
+       if (ret < 0)
+               return ret;
+
+       for (i = 0; i < len_words; i++)
+               buf[i] = be16_to_cpu(be_buf[i]);
+       return 0;
+}
+EXPORT_SYMBOL(mma9551_read_status_words);
+
+int mma9551_write_config_words(struct i2c_client *client, u8 app_id,
+                              u16 reg, u8 len, u16 *buf)
+{
+       int i;
+       int len_words = len / sizeof(u16);
+       __be16 be_buf[MMA9551_MAX_MAILBOX_DATA_REGS];
+
+       for (i = 0; i < len_words; i++)
+               be_buf[i] = cpu_to_be16(buf[i]);
+       return mma9551_transfer(client, app_id, MMA9551_CMD_WRITE_CONFIG,
+                               reg, (u8 *) be_buf, len, NULL, 0);
+}
+EXPORT_SYMBOL(mma9551_write_config_words);
+
 int mma9551_update_config_bits(struct i2c_client *client, u8 app_id,
                               u16 reg, u8 mask, u8 val)
 {
@@ -437,6 +516,15 @@ int mma9551_read_accel_scale(int *val, int *val2)
 }
 EXPORT_SYMBOL(mma9551_read_accel_scale);
 
+int mma9551_app_reset(struct i2c_client *client, u32 app_mask)
+{
+       return mma9551_write_config_byte(client, MMA9551_APPID_RCS,
+                                        MMA9551_RSC_RESET +
+                                        MMA9551_RSC_OFFSET(app_mask),
+                                        MMA9551_RSC_VAL(app_mask));
+}
+EXPORT_SYMBOL(mma9551_app_reset);
+
 MODULE_AUTHOR("Irina Tirdea <irina.tir...@intel.com>");
 MODULE_AUTHOR("Vlad Dogaru <vlad.dog...@intel.com>");
 MODULE_LICENSE("GPL v2");
diff --git a/drivers/iio/accel/mma9551_core.h b/drivers/iio/accel/mma9551_core.h
index 0e1c9bb..19b6253 100644
--- a/drivers/iio/accel/mma9551_core.h
+++ b/drivers/iio/accel/mma9551_core.h
@@ -21,9 +21,13 @@
 #define MMA9551_APPID_AFE              0x06
 #define MMA9551_APPID_TILT             0x0B
 #define MMA9551_APPID_SLEEP_WAKE       0x12
-#define MMA9551_APPID_RESET            0x17
+#define MMA9551_APPID_PEDOMETER                0x15
+#define MMA9551_APPID_RCS              0x17
 #define MMA9551_APPID_NONE             0xff
 
+/* Reset/Suspend/Clear application app masks */
+#define MMA9551_RSC_PED                        BIT(21)
+
 #define MMA9551_AUTO_SUSPEND_DELAY_MS  2000
 
 enum mma9551_gpio_pin {
@@ -56,8 +60,18 @@ int mma9551_write_config_byte(struct i2c_client *client, u8 
app_id,
                              u16 reg, u8 val);
 int mma9551_read_status_byte(struct i2c_client *client, u8 app_id,
                             u16 reg, u8 *val);
+int mma9551_read_config_word(struct i2c_client *client, u8 app_id,
+                           u16 reg, u16 *val);
+int mma9551_write_config_word(struct i2c_client *client, u8 app_id,
+                            u16 reg, u16 val);
 int mma9551_read_status_word(struct i2c_client *client, u8 app_id,
                             u16 reg, u16 *val);
+int mma9551_read_config_words(struct i2c_client *client, u8 app_id,
+                            u16 reg, u8 len, u16 *buf);
+int mma9551_read_status_words(struct i2c_client *client, u8 app_id,
+                             u16 reg, u8 len, u16 *buf);
+int mma9551_write_config_words(struct i2c_client *client, u8 app_id,
+                              u16 reg, u8 len, u16 *buf);
 int mma9551_update_config_bits(struct i2c_client *client, u8 app_id,
                               u16 reg, u8 mask, u8 val);
 int mma9551_gpio_config(struct i2c_client *client, enum mma9551_gpio_pin pin,
@@ -70,5 +84,6 @@ int mma9551_read_accel_chan(struct i2c_client *client,
                            const struct iio_chan_spec *chan,
                            int *val, int *val2);
 int mma9551_read_accel_scale(int *val, int *val2);
+int mma9551_app_reset(struct i2c_client *client, u32 app_mask);
 
 #endif /* _MMA9551_CORE_H_ */
diff --git a/drivers/iio/accel/mma9553.c b/drivers/iio/accel/mma9553.c
new file mode 100644
index 0000000..35b657d
--- /dev/null
+++ b/drivers/iio/accel/mma9553.c
@@ -0,0 +1,1239 @@
+/*
+ * Freescale MMA9553L Intelligent Pedometer driver
+ * Copyright (c) 2014, Intel Corporation.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ */
+
+#include <linux/module.h>
+#include <linux/i2c.h>
+#include <linux/interrupt.h>
+#include <linux/slab.h>
+#include <linux/acpi.h>
+#include <linux/gpio/consumer.h>
+#include <linux/iio/iio.h>
+#include <linux/iio/sysfs.h>
+#include <linux/iio/events.h>
+#include <linux/pm_runtime.h>
+#include "mma9551_core.h"
+
+#define MMA9553_DRV_NAME                       "mma9553"
+#define MMA9553_IRQ_NAME                       "mma9553_event"
+#define MMA9553_GPIO_NAME                      "mma9553_int"
+
+/* Pedometer configuration registers (R/W) */
+#define MMA9553_CONF_SLEEPMIN          0x00
+#define MMA9553_CONF_SLEEPMAX          0x02
+#define MMA9553_CONF_SLEEPTHD          0x04
+#define MMA9553_CONF_WORD              GENMASK(15, 0)
+
+#define MMA9553_CONF_CONF_STEPLEN      0x06
+#define MMA9553_CONF_CONFIG            BIT(15)
+#define MMA9553_CONF_ACT_DBCNTM                BIT(14)
+#define MMA9553_CONF_SLP_DBCNTM                BIT(13)
+#define MMA9553_CONF_STEPLEN           GENMASK(7, 0)
+
+#define MMA9553_CONF_HEIGHT_WEIGHT     0x08
+#define MMA9553_CONF_HEIGHT            GENMASK(15, 8)
+#define MMA9553_CONF_WEIGHT            GENMASK(7, 0)
+
+#define MMA9553_CONF_FILTER            0x0A
+#define MMA9553_CONF_FILTSTEP          GENMASK(15, 8)
+#define MMA9553_CONF_MALE              BIT(7)
+#define MMA9553_CONF_FILTTIME          GENMASK(6, 0)
+
+#define MMA9553_CONF_SPEED_STEP                0x0C
+#define MMA9553_CONF_SPDPRD            GENMASK(15, 8)
+#define MMA9553_CONF_STEPCOALESCE      GENMASK(7, 0)
+
+#define MMA9553_CONF_ACTTHD            0x0E
+
+/* Pedometer status registers (R-only) */
+#define MMA9553_STATUS                 0x00
+#define MMA9553_STATUS_MRGFL           BIT(15)
+#define MMA9553_STATUS_SUSPCHG         BIT(14)
+#define MMA9553_STATUS_STEPCHG         BIT(13)
+#define MMA9553_STATUS_ACTCHG          BIT(12)
+#define MMA9553_STATUS_SUSP            BIT(11)
+#define MMA9553_STATUS_ACTIVITY                (BIT(10) | BIT(9) | BIT(8))
+#define MMA9553_STATUS_VERSION         0x00FF
+
+#define MMA9553_STEPCNT                        0x02
+#define MMA9553_DISTANCE               0x04
+#define MMA9553_SPEED                  0x06
+#define MMA9553_CALORIES               0x08
+#define MMA9553_SLEEPCNT               0x0A
+
+/* Pedometer events are always mapped to this pin. */
+#define MMA9553_DEFAULT_GPIO_PIN       mma9551_gpio6
+#define MMA9553_DEFAULT_GPIO_POLARITY  0
+
+/* Bitnum used for gpio configuration = bit number in high status byte */
+#define STATUS_TO_BITNUM(bit)          (ffs(bit) - 9)
+
+#define MMA9553_DEFAULT_SAMPLE_RATE    30      /* Hz */
+
+/*
+ * The internal activity level must be stable for ACTTHD samples before
+ * ACTIVITY is updated.The ACTIVITY variable contains the current activity
+ * level and is updated every time a step is detected or once a second
+ * if there are no steps. So for 100% confidence level we need to have
+ * the same activity level for about 30 sec.
+ */
+#define MMA9553_MAX_ACTTHD             (MMA9553_DEFAULT_SAMPLE_RATE * 30)
+#define MMA9553_PERCENTAGE_TO_THD(prc) (((prc) * MMA9553_MAX_ACTTHD) / 100)
+#define MMA9553_THD_TO_PERCENTAGE(thr) (((thr) * 100) / MMA9553_MAX_ACTTHD)
+
+/*
+ * Autonomously suspend pedometer if acceleration vector magnitude
+ * is near 1g (4096 at 0.244 mg/LSB resolution) for 30 seconds.
+ */
+#define MMA9553_DEFAULT_SLEEPMIN       3688    /* 0,9 g */
+#define MMA9553_DEFAULT_SLEEPMAX       4508    /* 1,1 g */
+#define MMA9553_DEFAULT_SLEEPTHD       (MMA9553_DEFAULT_SAMPLE_RATE * 30)
+
+#define MMA9553_CONFIG_RETRIES         2
+
+/* Status register - activity field  */
+enum activity_level {
+       ACTIVITY_UNKNOWN,
+       ACTIVITY_REST,
+       ACTIVITY_WALKING,
+       ACTIVITY_JOGGING,
+       ACTIVITY_RUNNING,
+};
+
+struct mma9553_event {
+       enum iio_chan_type type;
+       enum iio_modifier mod;
+       enum iio_event_direction dir;
+       bool enabled;
+};
+
+struct mma9553_conf_regs {
+       u16 sleepmin;
+       u16 sleepmax;
+       u16 sleepthd;
+       u16 config;
+       u16 height_weight;
+       u16 filter;
+       u16 speed_step;
+       u16 actthd;
+} __packed;
+
+struct mma9553_data {
+       struct i2c_client *client;
+       struct mutex mutex;
+       struct mma9553_conf_regs conf;
+       struct mma9553_event *events;
+       int num_events;
+       u8 gpio_bitnum;
+       /*
+        * This is used for all features that depend on step count:
+        * step count, distance, speed, calories.
+        */
+       bool stepcnt_enabled;
+       u16 stepcnt;
+       u8 activity;
+};
+
+static u8 mma9553_get_bits(u16 val, u16 mask)
+{
+       return (val & mask) >> (ffs(mask) - 1);
+}
+
+static u16 mma9553_set_bits(u16 current_val, u16 val, u16 mask)
+{
+       return (current_val & ~mask) | (val << (ffs(mask) - 1));
+}
+
+static enum iio_modifier mma9553_activity_to_mod(enum activity_level activity)
+{
+       switch (activity) {
+       case ACTIVITY_RUNNING:
+               return IIO_MOD_RUNNING;
+       case ACTIVITY_JOGGING:
+               return IIO_MOD_JOGGING;
+       case ACTIVITY_WALKING:
+               return IIO_MOD_WALKING;
+       case ACTIVITY_REST:
+               return IIO_MOD_STILL;
+       case ACTIVITY_UNKNOWN:
+       default:
+               return IIO_NO_MOD;
+       }
+}
+
+static struct mma9553_event *mma9553_get_event(struct mma9553_data *data,
+                                              enum iio_chan_type type,
+                                              enum iio_modifier mod,
+                                              enum iio_event_direction dir)
+{
+       int i;
+
+       for (i = 0; i < data->num_events; i++)
+               if (data->events[i].type == type &&
+                   data->events[i].mod == mod &&
+                   data->events[i].dir == dir)
+                       return &data->events[i];
+       return NULL;
+}
+
+static bool mma9553_is_any_event_enabled(struct mma9553_data *data,
+                                        bool check_type,
+                                        enum iio_chan_type type)
+{
+       int i;
+
+       for (i = 0; i < data->num_events; i++)
+               if ((check_type && data->events[i].type == type &&
+                    data->events[i].enabled) ||
+                    (!check_type && data->events[i].enabled))
+                       return true;
+       return false;
+}
+
+static int mma9553_set_config(struct mma9553_data *data, u16 reg,
+                             u16 *p_reg_val, u16 val, u16 mask)
+{
+       int ret, retries;
+       u16 reg_val, config;
+
+       reg_val = *p_reg_val;
+       if (val == mma9553_get_bits(reg_val, mask))
+               return 0;
+
+       reg_val = mma9553_set_bits(reg_val, val, mask);
+       ret = mma9551_write_config_word(data->client, MMA9551_APPID_PEDOMETER,
+                                       reg, reg_val);
+       if (ret < 0) {
+               dev_err(&data->client->dev,
+                       "error writing config register 0x%x\n", reg);
+               return ret;
+       }
+
+       *p_reg_val = reg_val;
+
+       /* Reinitializes the pedometer with current configuration values */
+       config = mma9553_set_bits(data->conf.config, 1, MMA9553_CONF_CONFIG);
+
+       ret = mma9551_write_config_word(data->client, MMA9551_APPID_PEDOMETER,
+                                       MMA9553_CONF_CONF_STEPLEN, config);
+       if (ret < 0) {
+               dev_err(&data->client->dev,
+                       "error writing config register 0x%x\n",
+                       MMA9553_CONF_CONF_STEPLEN);
+               return ret;
+       }
+
+       retries = MMA9553_CONFIG_RETRIES;
+       do {
+               mma9551_sleep(MMA9553_DEFAULT_SAMPLE_RATE);
+               ret = mma9551_read_config_word(data->client,
+                                              MMA9551_APPID_PEDOMETER,
+                                              MMA9553_CONF_CONF_STEPLEN,
+                                              &config);
+               if (ret < 0)
+                       return ret;
+       } while (mma9553_get_bits(config, MMA9553_CONF_CONFIG) &&
+                --retries > 0);
+
+       return 0;
+}
+
+static int mma9553_read_activity_stepcnt(struct mma9553_data *data,
+                                        u8 *activity, u16 *stepcnt)
+{
+       u32 status_stepcnt;
+       u16 status;
+       int ret;
+
+       ret = mma9551_read_status_words(data->client, MMA9551_APPID_PEDOMETER,
+                                       MMA9553_STATUS, sizeof(u32),
+                                       (u16 *) &status_stepcnt);
+       if (ret < 0) {
+               dev_err(&data->client->dev,
+                       "error reading status and stepcnt\n");
+               return ret;
+       }
+
+       status = status_stepcnt & MMA9553_CONF_WORD;
+       *activity = mma9553_get_bits(status, MMA9553_STATUS_ACTIVITY);
+       *stepcnt = status_stepcnt >> 16;
+       return 0;
+}
+
+static int mma9553_conf_gpio(struct mma9553_data *data)
+{
+       u8 bitnum = 0, appid = MMA9551_APPID_PEDOMETER;
+       int ret;
+       struct mma9553_event *ev_step_detect;
+       bool activity_enabled;
+
+       activity_enabled =
+           mma9553_is_any_event_enabled(data, true, IIO_ACTIVITY);
+       ev_step_detect =
+           mma9553_get_event(data, IIO_STEPS, IIO_NO_MOD, IIO_EV_DIR_NONE);
+
+       /*
+        * If both step detector and activity are enabled, use the MRGFL bit.
+        * This bit is the logical OR of the SUSPCHG, STEPCHG, and ACTCHG flags.
+        */
+       if (activity_enabled && ev_step_detect->enabled) {
+               bitnum = STATUS_TO_BITNUM(MMA9553_STATUS_MRGFL);
+       } else if (ev_step_detect->enabled) {
+               bitnum = STATUS_TO_BITNUM(MMA9553_STATUS_STEPCHG);
+       } else if (activity_enabled) {
+               bitnum = STATUS_TO_BITNUM(MMA9553_STATUS_ACTCHG);
+       } else {                /* Reset */
+               appid = MMA9551_APPID_NONE;
+       }
+
+       if (data->gpio_bitnum == bitnum)
+               return 0;
+
+       /* Save initial values for activity and stepcnt */
+       if (activity_enabled || ev_step_detect->enabled)
+               mma9553_read_activity_stepcnt(data, &data->activity,
+                                             &data->stepcnt);
+
+       ret = mma9551_gpio_config(data->client,
+                                 MMA9553_DEFAULT_GPIO_PIN,
+                                 appid, bitnum, MMA9553_DEFAULT_GPIO_POLARITY);
+       if (ret < 0)
+               return ret;
+       data->gpio_bitnum = bitnum;
+       return 0;
+}
+
+static int mma9553_init(struct mma9553_data *data)
+{
+       int ret;
+
+       ret = mma9551_read_version(data->client);
+       if (ret)
+               return ret;
+
+       /*
+        * Read all the pedometer configuration registers. This is used as
+        * a device identification command to differentiate the MMA9553L
+        * from the MMA9550L.
+        */
+       ret =
+           mma9551_read_config_words(data->client, MMA9551_APPID_PEDOMETER,
+                                     MMA9553_CONF_SLEEPMIN,
+                                     sizeof(data->conf), (u16 *) &data->conf);
+       if (ret < 0) {
+               dev_err(&data->client->dev,
+                       "device is not MMA9553L: failed to read cfg regs.\n");
+               return ret;
+       }
+
+
+       /* Reset gpio */
+       data->gpio_bitnum = -1;
+       ret = mma9553_conf_gpio(data);
+       if (ret < 0)
+               return ret;
+
+       ret = mma9551_app_reset(data->client, MMA9551_RSC_PED);
+       if (ret < 0)
+               return ret;
+
+       /* Init config registers */
+       data->conf.sleepmin = MMA9553_DEFAULT_SLEEPMIN;
+       data->conf.sleepmax = MMA9553_DEFAULT_SLEEPMAX;
+       data->conf.sleepthd = MMA9553_DEFAULT_SLEEPTHD;
+       data->conf.config =
+           mma9553_set_bits(data->conf.config, 1, MMA9553_CONF_CONFIG);
+       /*
+        * Clear the activity debounce counter when the activity level changes,
+        * so that the confidence level applies for any activity level.
+        */
+       data->conf.config =
+           mma9553_set_bits(data->conf.config, 1, MMA9553_CONF_ACT_DBCNTM);
+       ret =
+           mma9551_write_config_words(data->client, MMA9551_APPID_PEDOMETER,
+                                      MMA9553_CONF_SLEEPMIN,
+                                      sizeof(data->conf), (u16 *) &data->conf);
+       if (ret < 0) {
+               dev_err(&data->client->dev,
+                       "failed to write configuration registers.\n");
+               return ret;
+       }
+
+       return mma9551_set_device_state(data->client, true);
+}
+
+static int mma9553_read_raw(struct iio_dev *indio_dev,
+                           struct iio_chan_spec const *chan,
+                           int *val, int *val2, long mask)
+{
+       struct mma9553_data *data = iio_priv(indio_dev);
+       int ret;
+       u16 tmp;
+       u8 activity;
+       bool powered_on;
+
+       switch (mask) {
+       case IIO_CHAN_INFO_PROCESSED:
+               switch (chan->type) {
+               case IIO_STEPS:
+                       /*
+                        * The HW only counts steps and other dependent
+                        * parameters (speed, distance, calories, activity)
+                        * if power is on (from enabling an event or the
+                        * step counter */
+                       powered_on =
+                           mma9553_is_any_event_enabled(data, false, 0) ||
+                           data->stepcnt_enabled;
+                       if (!powered_on)
+                               return -EINVAL;
+                       mutex_lock(&data->mutex);
+                       ret = mma9551_read_status_word(data->client,
+                                                      MMA9551_APPID_PEDOMETER,
+                                                      MMA9553_STEPCNT, &tmp);
+                       mutex_unlock(&data->mutex);
+                       if (ret < 0)
+                               return ret;
+                       *val = tmp;
+                       return IIO_VAL_INT;
+               case IIO_DISTANCE:
+                       powered_on =
+                           mma9553_is_any_event_enabled(data, false, 0) ||
+                           data->stepcnt_enabled;
+                       if (!powered_on)
+                               return -EINVAL;
+                       mutex_lock(&data->mutex);
+                       ret = mma9551_read_status_word(data->client,
+                                                      MMA9551_APPID_PEDOMETER,
+                                                      MMA9553_DISTANCE, &tmp);
+                       mutex_unlock(&data->mutex);
+                       if (ret < 0)
+                               return ret;
+                       *val = tmp;
+                       return IIO_VAL_INT;
+               case IIO_ACTIVITY:
+                       powered_on =
+                           mma9553_is_any_event_enabled(data, false, 0) ||
+                           data->stepcnt_enabled;
+                       if (!powered_on)
+                               return -EINVAL;
+                       mutex_lock(&data->mutex);
+                       ret = mma9551_read_status_word(data->client,
+                                                      MMA9551_APPID_PEDOMETER,
+                                                      MMA9553_STATUS, &tmp);
+                       mutex_unlock(&data->mutex);
+                       if (ret < 0)
+                               return ret;
+
+                       activity =
+                           mma9553_get_bits(tmp, MMA9553_STATUS_ACTIVITY);
+
+                       /*
+                        * The device does not support confidence value levels,
+                        * so we will always have 100% for current activity and
+                        * 0% for the others.
+                        */
+                       if (chan->channel2 == mma9553_activity_to_mod(activity))
+                               *val = 100;
+                       else
+                               *val = 0;
+                       return IIO_VAL_INT;
+               default:
+                       return -EINVAL;
+               }
+       case IIO_CHAN_INFO_RAW:
+               switch (chan->type) {
+               case IIO_SPEED: /* m/h */
+                       powered_on =
+                           mma9553_is_any_event_enabled(data, false, 0) ||
+                           data->stepcnt_enabled;
+                       if (!powered_on)
+                               return -EINVAL;
+                       mutex_lock(&data->mutex);
+                       ret = mma9551_read_status_word(data->client,
+                                                      MMA9551_APPID_PEDOMETER,
+                                                      MMA9553_SPEED, &tmp);
+                       mutex_unlock(&data->mutex);
+                       if (ret < 0)
+                               return ret;
+                       *val = tmp;
+                       return IIO_VAL_INT;
+               case IIO_CALORIES:      /* Cal or kcal */
+                       powered_on =
+                           mma9553_is_any_event_enabled(data, false, 0) ||
+                           data->stepcnt_enabled;
+                       if (!powered_on)
+                               return -EINVAL;
+                       mutex_lock(&data->mutex);
+                       ret = mma9551_read_status_word(data->client,
+                                                      MMA9551_APPID_PEDOMETER,
+                                                      MMA9553_CALORIES, &tmp);
+                       mutex_unlock(&data->mutex);
+                       if (ret < 0)
+                               return ret;
+                       *val = tmp;
+                       return IIO_VAL_INT;
+               case IIO_ACCEL:
+                       mutex_lock(&data->mutex);
+                       ret = mma9551_read_accel_chan(data->client,
+                                                     chan, val, val2);
+                       mutex_unlock(&data->mutex);
+                       return ret;
+               default:
+                       return -EINVAL;
+               }
+       case IIO_CHAN_INFO_SCALE:
+               switch (chan->type) {
+               case IIO_SPEED: /* m/h to m/s */
+                       *val = 0;
+                       *val2 = 277;    /* 0.000277 */
+                       return IIO_VAL_INT_PLUS_MICRO;
+               case IIO_CALORIES:      /* Cal or kcal to J */
+                       *val = 4184;
+                       return IIO_VAL_INT;
+               case IIO_ACCEL:
+                       return mma9551_read_accel_scale(val, val2);
+               default:
+                       return -EINVAL;
+               }
+       case IIO_CHAN_INFO_ENABLE:
+               *val = data->stepcnt_enabled;
+               return IIO_VAL_INT;
+       case IIO_CHAN_INFO_CALIBHEIGHT:
+               *val = mma9553_get_bits(data->conf.height_weight,
+                                       MMA9553_CONF_HEIGHT);
+               return IIO_VAL_INT;
+       case IIO_CHAN_INFO_CALIBWEIGHT:
+               *val = mma9553_get_bits(data->conf.height_weight,
+                                       MMA9553_CONF_WEIGHT);
+               return IIO_VAL_INT;
+       case IIO_CHAN_INFO_CALIBGENDER:
+               *val = mma9553_get_bits(data->conf.filter, MMA9553_CONF_MALE);
+               return IIO_VAL_INT;
+       case IIO_CHAN_INFO_OFFSET:
+               switch (chan->type) {
+               case IIO_STEPS:
+                       *val = mma9553_get_bits(data->conf.filter,
+                                               MMA9553_CONF_FILTSTEP);
+                       return IIO_VAL_INT;
+               default:
+                       return -EINVAL;
+               }
+       case IIO_CHAN_INFO_INT_TIME:
+               switch (chan->type) {
+               case IIO_STEPS:
+                       *val = mma9553_get_bits(data->conf.filter,
+                                               MMA9553_CONF_FILTTIME);
+                       return IIO_VAL_INT;
+               case IIO_SPEED:
+                       *val = mma9553_get_bits(data->conf.speed_step,
+                                               MMA9553_CONF_SPDPRD);
+                       return IIO_VAL_INT;
+               default:
+                       return -EINVAL;
+               }
+       default:
+               return -EINVAL;
+       }
+}
+
+static int mma9553_write_raw(struct iio_dev *indio_dev,
+                            struct iio_chan_spec const *chan,
+                            int val, int val2, long mask)
+{
+       struct mma9553_data *data = iio_priv(indio_dev);
+       int ret;
+
+       switch (mask) {
+       case IIO_CHAN_INFO_ENABLE:
+               if (data->stepcnt_enabled == !!val)
+                       return 0;
+               mutex_lock(&data->mutex);
+               ret = mma9551_set_power_state(data->client, val);
+               if (ret < 0) {
+                       mutex_unlock(&data->mutex);
+                       return ret;
+               }
+               data->stepcnt_enabled = val;
+               mutex_unlock(&data->mutex);
+               return 0;
+       case IIO_CHAN_INFO_CALIBHEIGHT:
+               if (val < 0 || val > 255)
+                       return -EINVAL;
+               mutex_lock(&data->mutex);
+               ret = mma9553_set_config(data,
+                                        MMA9553_CONF_HEIGHT_WEIGHT,
+                                        &data->conf.height_weight,
+                                        val, MMA9553_CONF_HEIGHT);
+               mutex_unlock(&data->mutex);
+               return ret;
+       case IIO_CHAN_INFO_CALIBWEIGHT:
+               if (val < 0 || val > 255)
+                       return -EINVAL;
+               mutex_lock(&data->mutex);
+               ret = mma9553_set_config(data,
+                                        MMA9553_CONF_HEIGHT_WEIGHT,
+                                        &data->conf.height_weight,
+                                        val, MMA9553_CONF_WEIGHT);
+               mutex_unlock(&data->mutex);
+               return ret;
+       case IIO_CHAN_INFO_CALIBGENDER:
+               /* Gender can only be 0(female) or 1(male) */
+               if ((val != 0) && (val != 1))
+                       return -EINVAL;
+               mutex_lock(&data->mutex);
+               ret = mma9553_set_config(data, MMA9553_CONF_FILTER,
+                                        &data->conf.filter, val,
+                                        MMA9553_CONF_MALE);
+               mutex_unlock(&data->mutex);
+               return ret;
+       case IIO_CHAN_INFO_OFFSET:
+               switch (chan->type) {
+               case IIO_STEPS:
+                       /*
+                        * Set to 0 to disable step filtering. If the value
+                        * specified is greater than 6, then 6 will be used.
+                        */
+                       if (val < 0)
+                               return -EINVAL;
+                       if (val > 6)
+                               val = 6;
+                       mutex_lock(&data->mutex);
+                       ret = mma9553_set_config(data, MMA9553_CONF_FILTER,
+                                                &data->conf.filter, val,
+                                                MMA9553_CONF_FILTSTEP);
+                       mutex_unlock(&data->mutex);
+                       return ret;
+               default:
+                       return -EINVAL;
+               }
+       case IIO_CHAN_INFO_INT_TIME:
+               switch (chan->type) {
+               case IIO_STEPS:
+                       if (val < 0 || val > 127)
+                               return -EINVAL;
+                       mutex_lock(&data->mutex);
+                       ret = mma9553_set_config(data, MMA9553_CONF_FILTER,
+                                                &data->conf.filter, val,
+                                                MMA9553_CONF_FILTTIME);
+                       mutex_unlock(&data->mutex);
+                       return ret;
+               case IIO_SPEED:
+                       /*
+                        * If set to a value greater than 5, then 5 will be
+                        * used. Warning: Do not set SPDPRD to 0 or 1 as
+                        * this may cause undesirable behavior.
+                        */
+                       if (val < 2)
+                               return -EINVAL;
+                       if (val > 5)
+                               val = 5;
+                       mutex_lock(&data->mutex);
+                       ret = mma9553_set_config(data, MMA9553_CONF_SPEED_STEP,
+                                                &data->conf.speed_step, val,
+                                                MMA9553_CONF_SPDPRD);
+                       mutex_unlock(&data->mutex);
+                       return ret;
+               default:
+                       return -EINVAL;
+               }
+       default:
+               return -EINVAL;
+       }
+}
+
+static int mma9553_read_event_config(struct iio_dev *indio_dev,
+                                    const struct iio_chan_spec *chan,
+                                    enum iio_event_type type,
+                                    enum iio_event_direction dir)
+{
+
+       struct mma9553_data *data = iio_priv(indio_dev);
+       struct mma9553_event *event;
+
+       event = mma9553_get_event(data, chan->type, chan->channel2, dir);
+       if (!event)
+               return -EINVAL;
+       return event->enabled;
+}
+
+static int mma9553_write_event_config(struct iio_dev *indio_dev,
+                                     const struct iio_chan_spec *chan,
+                                     enum iio_event_type type,
+                                     enum iio_event_direction dir, int state)
+{
+       struct mma9553_data *data = iio_priv(indio_dev);
+       struct mma9553_event *event;
+       int ret;
+
+       event = mma9553_get_event(data, chan->type, chan->channel2, dir);
+       if (!event)
+               return -EINVAL;
+
+       if (event->enabled == state)
+               return 0;
+
+       mutex_lock(&data->mutex);
+
+       ret = mma9551_set_power_state(data->client, state);
+       if (ret < 0)
+               goto out;
+       event->enabled = state;
+
+       ret = mma9553_conf_gpio(data);
+       if (ret < 0)
+               goto err_conf_gpio;
+
+       goto out;
+
+err_conf_gpio:
+       if (state) {
+               event->enabled = false;
+               mma9551_set_power_state(data->client, false);
+       }
+out:
+       mutex_unlock(&data->mutex);
+       return ret;
+}
+
+static int mma9553_read_event_value(struct iio_dev *indio_dev,
+                                   const struct iio_chan_spec *chan,
+                                   enum iio_event_type type,
+                                   enum iio_event_direction dir,
+                                   enum iio_event_info info,
+                                   int *val, int *val2)
+{
+       struct mma9553_data *data = iio_priv(indio_dev);
+       int prc;
+
+       *val2 = 0;
+       switch (info) {
+       case IIO_EV_INFO_VALUE:
+               switch (chan->type) {
+               case IIO_ACTIVITY:
+                       prc = MMA9553_THD_TO_PERCENTAGE(data->conf.actthd);
+                       if (dir == IIO_EV_DIR_RISING)
+                               *val = prc;
+                       else if (dir == IIO_EV_DIR_FALLING)
+                               *val = 100 - prc;
+                       else
+                               return -EINVAL;
+                       return IIO_VAL_INT;
+               default:
+                       return -EINVAL;
+               }
+       case IIO_EV_INFO_PERIOD:
+               switch (chan->type) {
+               case IIO_STEPS:
+                       *val = mma9553_get_bits(data->conf.speed_step,
+                                               MMA9553_CONF_STEPCOALESCE);
+                       return IIO_VAL_INT;
+               default:
+                       return -EINVAL;
+               }
+       default:
+               return -EINVAL;
+       }
+}
+
+static int mma9553_write_event_value(struct iio_dev *indio_dev,
+                                    const struct iio_chan_spec *chan,
+                                    enum iio_event_type type,
+                                    enum iio_event_direction dir,
+                                    enum iio_event_info info,
+                                    int val, int val2)
+{
+       struct mma9553_data *data = iio_priv(indio_dev);
+       int prc, thd;
+       int ret;
+
+       switch (info) {
+       case IIO_EV_INFO_VALUE:
+               switch (chan->type) {
+               case IIO_ACTIVITY:
+                       if (val < 0 || val > 100)
+                               return -EINVAL;
+
+                       if (dir == IIO_EV_DIR_RISING)
+                               prc = val;
+                       else if (dir == IIO_EV_DIR_FALLING)
+                               prc = 100 - val;
+                       else
+                               return -EINVAL;
+                       thd = MMA9553_PERCENTAGE_TO_THD(prc);
+
+                       mutex_lock(&data->mutex);
+                       ret = mma9553_set_config(data, MMA9553_CONF_ACTTHD,
+                                                &data->conf.actthd, thd,
+                                                MMA9553_CONF_WORD);
+                       mutex_unlock(&data->mutex);
+                       return ret;
+               default:
+                       return -EINVAL;
+               }
+       case IIO_EV_INFO_PERIOD:
+               switch (chan->type) {
+               case IIO_STEPS:
+                       if (val < 0 || val > 255)
+                               return -EINVAL;
+                       mutex_lock(&data->mutex);
+                       ret = mma9553_set_config(data, MMA9553_CONF_SPEED_STEP,
+                                                &data->conf.speed_step, val,
+                                                MMA9553_CONF_STEPCOALESCE);
+                       mutex_unlock(&data->mutex);
+                       return ret;
+               default:
+                       return -EINVAL;
+               }
+       default:
+               return -EINVAL;
+       }
+}
+
+static const struct iio_event_spec mma9553_step_event = {
+       .type = IIO_EV_TYPE_INSTANCE,
+       .dir = IIO_EV_DIR_NONE,
+       .mask_separate = BIT(IIO_EV_INFO_ENABLE) | BIT(IIO_EV_INFO_PERIOD),
+};
+
+static const struct iio_event_spec mma9553_activity_events[] = {
+       {
+               .type = IIO_EV_TYPE_THRESH,
+               .dir = IIO_EV_DIR_RISING,
+               .mask_separate = BIT(IIO_EV_INFO_ENABLE) |
+                                BIT(IIO_EV_INFO_VALUE),
+        },
+       {
+               .type = IIO_EV_TYPE_THRESH,
+               .dir = IIO_EV_DIR_FALLING,
+               .mask_separate = BIT(IIO_EV_INFO_ENABLE) |
+                                BIT(IIO_EV_INFO_VALUE),
+       },
+};
+
+#define MMA9553_PEDOMETER_CHANNEL(_type, _mask) {              \
+       .type = _type,                                          \
+       .info_mask_separate = BIT(IIO_CHAN_INFO_ENABLE)      |  \
+                             BIT(IIO_CHAN_INFO_CALIBHEIGHT) |  \
+                             BIT(IIO_CHAN_INFO_CALIBGENDER) |  \
+                             _mask,                            \
+}
+
+#define MMA9553_ACTIVITY_CHANNEL(_chan2) {                             \
+       .type = IIO_ACTIVITY,                                           \
+       .modified = 1,                                                  \
+       .channel2 = _chan2,                                             \
+       .info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),             \
+       .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_CALIBHEIGHT) |    \
+                                   BIT(IIO_CHAN_INFO_CALIBGENDER),     \
+       .event_spec = mma9553_activity_events,                          \
+       .num_event_specs = ARRAY_SIZE(mma9553_activity_events),         \
+}
+
+static const struct iio_chan_spec mma9553_channels[] = {
+       MMA9551_ACCEL_CHANNEL(IIO_MOD_X),
+       MMA9551_ACCEL_CHANNEL(IIO_MOD_Y),
+       MMA9551_ACCEL_CHANNEL(IIO_MOD_Z),
+
+       {
+               .type = IIO_STEPS,
+               .info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED) |
+                                     BIT(IIO_CHAN_INFO_ENABLE) |
+                                     BIT(IIO_CHAN_INFO_OFFSET) |
+                                     BIT(IIO_CHAN_INFO_INT_TIME),
+               .event_spec = &mma9553_step_event,
+               .num_event_specs = 1,
+       },
+
+       MMA9553_PEDOMETER_CHANNEL(IIO_DISTANCE, BIT(IIO_CHAN_INFO_PROCESSED)),
+       MMA9553_PEDOMETER_CHANNEL(IIO_SPEED, BIT(IIO_CHAN_INFO_RAW) |
+                                 BIT(IIO_CHAN_INFO_SCALE) |
+                                 BIT(IIO_CHAN_INFO_INT_TIME)),
+       MMA9553_PEDOMETER_CHANNEL(IIO_CALORIES, BIT(IIO_CHAN_INFO_RAW) |
+                                 BIT(IIO_CHAN_INFO_SCALE) |
+                                 BIT(IIO_CHAN_INFO_CALIBWEIGHT)),
+
+       MMA9553_ACTIVITY_CHANNEL(IIO_MOD_RUNNING),
+       MMA9553_ACTIVITY_CHANNEL(IIO_MOD_JOGGING),
+       MMA9553_ACTIVITY_CHANNEL(IIO_MOD_WALKING),
+       MMA9553_ACTIVITY_CHANNEL(IIO_MOD_STILL),
+};
+
+static const struct iio_info mma9553_info = {
+       .driver_module = THIS_MODULE,
+       .read_raw = mma9553_read_raw,
+       .write_raw = mma9553_write_raw,
+       .read_event_config = mma9553_read_event_config,
+       .write_event_config = mma9553_write_event_config,
+       .read_event_value = mma9553_read_event_value,
+       .write_event_value = mma9553_write_event_value,
+};
+
+static struct mma9553_event mma9553_events[] = {
+       {
+               .type = IIO_STEPS,
+               .mod = IIO_NO_MOD,
+               .dir = IIO_EV_DIR_NONE,
+               .enabled = false,
+       },
+       {
+               .type = IIO_ACTIVITY,
+               .mod = IIO_MOD_STILL,
+               .dir = IIO_EV_DIR_RISING,
+               .enabled = false,
+       },
+       {
+               .type = IIO_ACTIVITY,
+               .mod = IIO_MOD_STILL,
+               .dir = IIO_EV_DIR_FALLING,
+               .enabled = false,
+       },
+       {
+               .type = IIO_ACTIVITY,
+               .mod = IIO_MOD_WALKING,
+               .dir = IIO_EV_DIR_RISING,
+               .enabled = false,
+       },
+       {
+               .type = IIO_ACTIVITY,
+               .mod = IIO_MOD_WALKING,
+               .dir = IIO_EV_DIR_FALLING,
+               .enabled = false,
+       },
+       {
+               .type = IIO_ACTIVITY,
+               .mod = IIO_MOD_JOGGING,
+               .dir = IIO_EV_DIR_RISING,
+               .enabled = false,
+       },
+       {
+               .type = IIO_ACTIVITY,
+               .mod = IIO_MOD_JOGGING,
+               .dir = IIO_EV_DIR_FALLING,
+               .enabled = false,
+       },
+       {
+               .type = IIO_ACTIVITY,
+               .mod = IIO_MOD_RUNNING,
+               .dir = IIO_EV_DIR_RISING,
+               .enabled = false,
+       },
+       {
+               .type = IIO_ACTIVITY,
+               .mod = IIO_MOD_RUNNING,
+               .dir = IIO_EV_DIR_FALLING,
+               .enabled = false,
+       },
+};
+
+static irqreturn_t mma9553_irq_handler(int irq, void *private)
+{
+       /*
+        * Since we only configure the interrupt pin when an
+        * event is enabled, we are sure we have at least
+        * one event enabled at this point.
+        */
+       return IRQ_WAKE_THREAD;
+}
+
+static irqreturn_t mma9553_event_handler(int irq, void *private)
+{
+       struct iio_dev *indio_dev = private;
+       struct mma9553_data *data = iio_priv(indio_dev);
+       u16 stepcnt;
+       u8 activity;
+       struct mma9553_event *ev_activity, *ev_prev_activity, *ev_step_detect;
+       int ret;
+
+       mutex_lock(&data->mutex);
+       ret = mma9553_read_activity_stepcnt(data, &activity, &stepcnt);
+       if (ret < 0) {
+               mutex_unlock(&data->mutex);
+               return IRQ_HANDLED;
+       }
+
+       ev_prev_activity =
+           mma9553_get_event(data, IIO_ACTIVITY,
+                             mma9553_activity_to_mod(data->activity),
+                             IIO_EV_DIR_FALLING);
+       ev_activity =
+           mma9553_get_event(data, IIO_ACTIVITY,
+                             mma9553_activity_to_mod(activity),
+                             IIO_EV_DIR_RISING);
+       ev_step_detect =
+           mma9553_get_event(data, IIO_STEPS, IIO_NO_MOD, IIO_EV_DIR_NONE);
+
+       if (ev_step_detect->enabled && (stepcnt != data->stepcnt)) {
+               data->stepcnt = stepcnt;
+               iio_push_event(indio_dev,
+                              IIO_EVENT_CODE(IIO_STEPS, 0, IIO_NO_MOD,
+                              IIO_EV_DIR_NONE, IIO_EV_TYPE_INSTANCE, 0, 0, 0),
+                              iio_get_time_ns());
+       }
+
+       if (activity != data->activity) {
+               data->activity = activity;
+               /* ev_activity can be NULL if activity == ACTIVITY_UNKNOWN */
+               if (ev_prev_activity && ev_prev_activity->enabled)
+                       iio_push_event(indio_dev,
+                                      IIO_EVENT_CODE(IIO_ACTIVITY, 0,
+                                      ev_prev_activity->mod,
+                                      IIO_EV_DIR_FALLING,
+                                      IIO_EV_TYPE_THRESH, 0, 0, 0),
+                                      iio_get_time_ns());
+
+               if (ev_activity && ev_activity->enabled)
+                       iio_push_event(indio_dev,
+                                      IIO_EVENT_CODE(IIO_ACTIVITY, 0,
+                                      ev_activity->mod,
+                                      IIO_EV_DIR_RISING,
+                                      IIO_EV_TYPE_THRESH, 0, 0, 0),
+                                      iio_get_time_ns());
+       }
+       mutex_unlock(&data->mutex);
+       return IRQ_HANDLED;
+}
+
+static int mma9553_gpio_probe(struct i2c_client *client)
+{
+       struct device *dev;
+       struct gpio_desc *gpio;
+       int ret;
+
+       if (!client)
+               return -EINVAL;
+
+       dev = &client->dev;
+
+       /* data ready gpio interrupt pin */
+       gpio = devm_gpiod_get_index(dev, MMA9553_GPIO_NAME, 0);
+       if (IS_ERR(gpio)) {
+               dev_err(dev, "acpi gpio get index failed\n");
+               return PTR_ERR(gpio);
+       }
+
+       ret = gpiod_direction_input(gpio);
+       if (ret)
+               return ret;
+
+       ret = gpiod_to_irq(gpio);
+
+       dev_dbg(dev, "gpio resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
+
+       return ret;
+}
+
+static const char *mma9553_match_acpi_device(struct device *dev)
+{
+       const struct acpi_device_id *id;
+
+       id = acpi_match_device(dev->driver->acpi_match_table, dev);
+       if (!id)
+               return NULL;
+
+       return dev_name(dev);
+}
+
+static int mma9553_probe(struct i2c_client *client,
+                        const struct i2c_device_id *id)
+{
+       struct mma9553_data *data;
+       struct iio_dev *indio_dev;
+       const char *name = NULL;
+       int ret;
+
+       indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
+       if (!indio_dev)
+               return -ENOMEM;
+
+       data = iio_priv(indio_dev);
+       i2c_set_clientdata(client, indio_dev);
+       data->client = client;
+
+       if (id)
+               name = id->name;
+       else if (ACPI_HANDLE(&client->dev))
+               name = mma9553_match_acpi_device(&client->dev);
+       else
+               return -ENOSYS;
+
+       mutex_init(&data->mutex);
+       data->events = mma9553_events;
+       data->num_events = ARRAY_SIZE(mma9553_events);
+
+       ret = mma9553_init(data);
+       if (ret < 0)
+               return ret;
+
+       indio_dev->dev.parent = &client->dev;
+       indio_dev->channels = mma9553_channels;
+       indio_dev->num_channels = ARRAY_SIZE(mma9553_channels);
+       indio_dev->name = name;
+       indio_dev->modes = INDIO_DIRECT_MODE;
+       indio_dev->info = &mma9553_info;
+
+       if (client->irq < 0)
+               client->irq = mma9553_gpio_probe(client);
+
+       if (client->irq >= 0) {
+               ret = devm_request_threaded_irq(&client->dev, client->irq,
+                                               mma9553_irq_handler,
+                                               mma9553_event_handler,
+                                               IRQF_TRIGGER_RISING,
+                                               MMA9553_IRQ_NAME, indio_dev);
+               if (ret < 0) {
+                       dev_err(&client->dev, "request irq %d failed\n",
+                               client->irq);
+                       goto out_poweroff;
+               }
+
+       }
+
+       ret = iio_device_register(indio_dev);
+       if (ret < 0) {
+               dev_err(&client->dev, "unable to register iio device\n");
+               goto out_poweroff;
+       }
+
+       ret = pm_runtime_set_active(&client->dev);
+       if (ret < 0)
+               goto out_iio_unregister;
+
+       pm_runtime_enable(&client->dev);
+       pm_runtime_set_autosuspend_delay(&client->dev,
+                                        MMA9551_AUTO_SUSPEND_DELAY_MS);
+       pm_runtime_use_autosuspend(&client->dev);
+
+       dev_dbg(&indio_dev->dev, "Registered device %s\n", name);
+       return 0;
+
+out_iio_unregister:
+       iio_device_unregister(indio_dev);
+out_poweroff:
+       mma9551_set_device_state(client, false);
+       return ret;
+}
+
+static int mma9553_remove(struct i2c_client *client)
+{
+       struct iio_dev *indio_dev = i2c_get_clientdata(client);
+       struct mma9553_data *data = iio_priv(indio_dev);
+
+       pm_runtime_disable(&client->dev);
+       pm_runtime_set_suspended(&client->dev);
+       pm_runtime_put_noidle(&client->dev);
+
+       iio_device_unregister(indio_dev);
+       mutex_lock(&data->mutex);
+       mma9551_set_device_state(data->client, false);
+       mutex_unlock(&data->mutex);
+
+       return 0;
+}
+
+#ifdef CONFIG_PM
+static int mma9553_runtime_suspend(struct device *dev)
+{
+       struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
+       struct mma9553_data *data = iio_priv(indio_dev);
+       int ret;
+
+       mutex_lock(&data->mutex);
+       ret = mma9551_set_device_state(data->client, false);
+       mutex_unlock(&data->mutex);
+       if (ret < 0) {
+               dev_err(&data->client->dev, "powering off device failed\n");
+               return -EAGAIN;
+       }
+
+       return 0;
+}
+
+static int mma9553_runtime_resume(struct device *dev)
+{
+       struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
+       struct mma9553_data *data = iio_priv(indio_dev);
+       int ret;
+
+       ret = mma9551_set_device_state(data->client, true);
+       if (ret < 0)
+               return ret;
+
+       mma9551_sleep(MMA9553_DEFAULT_SAMPLE_RATE);
+       return 0;
+}
+#endif
+
+#ifdef CONFIG_PM_SLEEP
+static int mma9553_suspend(struct device *dev)
+{
+       struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
+       struct mma9553_data *data = iio_priv(indio_dev);
+       int ret;
+
+       mutex_lock(&data->mutex);
+       ret = mma9551_set_device_state(data->client, false);
+       mutex_unlock(&data->mutex);
+
+       return ret;
+}
+
+static int mma9553_resume(struct device *dev)
+{
+       struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
+       struct mma9553_data *data = iio_priv(indio_dev);
+       int ret;
+
+       mutex_lock(&data->mutex);
+       ret = mma9551_set_device_state(data->client, true);
+       mutex_unlock(&data->mutex);
+
+       return ret;
+}
+#endif
+
+static const struct dev_pm_ops mma9553_pm_ops = {
+       SET_SYSTEM_SLEEP_PM_OPS(mma9553_suspend, mma9553_resume)
+       SET_RUNTIME_PM_OPS(mma9553_runtime_suspend,
+                          mma9553_runtime_resume, NULL)
+};
+
+static const struct acpi_device_id mma9553_acpi_match[] = {
+       {"MMA9553", 0},
+       {},
+};
+
+MODULE_DEVICE_TABLE(acpi, mma9553_acpi_match);
+
+static const struct i2c_device_id mma9553_id[] = {
+       {"mma9553", 0},
+       {},
+};
+
+MODULE_DEVICE_TABLE(i2c, mma9553_id);
+
+static struct i2c_driver mma9553_driver = {
+       .driver = {
+                  .name = MMA9553_DRV_NAME,
+                  .acpi_match_table = ACPI_PTR(mma9553_acpi_match),
+                  .pm = &mma9553_pm_ops,
+                  },
+       .probe = mma9553_probe,
+       .remove = mma9553_remove,
+       .id_table = mma9553_id,
+};
+
+module_i2c_driver(mma9553_driver);
+
+MODULE_AUTHOR("Irina Tirdea <irina.tir...@intel.com>");
+MODULE_LICENSE("GPL v2");
+MODULE_DESCRIPTION("MMA9553L pedometer platform driver");
-- 
1.7.9.5

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to