Input: add CMA3000 accelerometer driver

Add support for CMA3000 Tri-axis accelerometer, which supports Motion
detect, Measurement and Free fall modes. CMA3000 supports both I2C/SPI
bus for communication, currently the driver supports I2C based
communication.

Signed-off-by: Hemanth V <hemanthv@ti.com>
Reviewed-by: Jonathan Cameron <jic23@cam.ac.uk>
Reviewed-by: Sergio Aguirre <saaguirre@ti.com>
Reviewed-by: Shubhrajyoti <Shubhrajyoti@ti.com>
Signed-off-by: Dmitry Torokhov <dtor@mail.ru>

5 files changed, 607 insertions, 0 deletions

diff --git a/drivers/input/misc/Kconfig b/drivers/input/misc/Kconfig
index b99b8cbde02f..f0d90172a65f 100644
--- a/drivers/input/misc/Kconfig
+++ b/drivers/input/misc/Kconfig
@@ -448,4 +448,28 @@ config INPUT_ADXL34X_SPI
           To compile this driver as a module, choose M here: the
           module will be called adxl34x-spi.
 
+config INPUT_CMA3000
+        tristate "VTI CMA3000 Tri-axis accelerometer"
+        help
+          Say Y here if you want to use VTI CMA3000_D0x Accelerometer
+          driver
+
+          This driver currently only supports I2C interface to the
+          controller. Also select the I2C method.
+
+          If unsure, say N
+
+          To compile this driver as a module, choose M here: the
+          module will be called cma3000_d0x.
+
+config INPUT_CMA3000_I2C
+        tristate "Support I2C bus connection"
+        depends on INPUT_CMA3000 && I2C
+        help
+          Say Y here if you want to use VTI CMA3000_D0x Accelerometer
+          through I2C interface.
+
+          To compile this driver as a module, choose M here: the
+          module will be called cma3000_d0x_i2c.
+
 endif
diff --git a/drivers/input/misc/Makefile b/drivers/input/misc/Makefile
index 1fe1f6c8b737..35bcfe46555e 100644
--- a/drivers/input/misc/Makefile
+++ b/drivers/input/misc/Makefile
@@ -18,6 +18,8 @@ obj-$(CONFIG_INPUT_ATI_REMOTE2)		+= ati_remote2.o
 obj-$(CONFIG_INPUT_ATLAS_BTNS)          += atlas_btns.o
 obj-$(CONFIG_INPUT_BFIN_ROTARY)         += bfin_rotary.o
 obj-$(CONFIG_INPUT_CM109)               += cm109.o
+obj-$(CONFIG_INPUT_CMA3000)             += cma3000_d0x.o
+obj-$(CONFIG_INPUT_CMA3000_I2C)         += cma3000_d0x_i2c.o
 obj-$(CONFIG_INPUT_COBALT_BTNS)         += cobalt_btns.o
 obj-$(CONFIG_INPUT_DM355EVM)            += dm355evm_keys.o
 obj-$(CONFIG_HP_SDC_RTC)                += hp_sdc_rtc.o
diff --git a/drivers/input/misc/cma3000_d0x.c b/drivers/input/misc/cma3000_d0x.c
new file mode 100644
index 000000000000..1633b6342267
--- /dev/null
+++ b/drivers/input/misc/cma3000_d0x.c
@@ -0,0 +1,398 @@
+/*
+ * VTI CMA3000_D0x Accelerometer driver
+ *
+ * Copyright (C) 2010 Texas Instruments
+ * Author: Hemanth V <hemanthv@ti.com>
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License version 2 as published by
+ * the Free Software Foundation.
+ *
+ * This program is distributed in the hope that 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.
+ *
+ * You should have received a copy of the GNU General Public License along with
+ * this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <linux/types.h>
+#include <linux/interrupt.h>
+#include <linux/delay.h>
+#include <linux/slab.h>
+#include <linux/input.h>
+#include <linux/input/cma3000.h>
+
+#include "cma3000_d0x.h"
+
+#define CMA3000_WHOAMI      0x00
+#define CMA3000_REVID       0x01
+#define CMA3000_CTRL        0x02
+#define CMA3000_STATUS      0x03
+#define CMA3000_RSTR        0x04
+#define CMA3000_INTSTATUS   0x05
+#define CMA3000_DOUTX       0x06
+#define CMA3000_DOUTY       0x07
+#define CMA3000_DOUTZ       0x08
+#define CMA3000_MDTHR       0x09
+#define CMA3000_MDFFTMR     0x0A
+#define CMA3000_FFTHR       0x0B
+
+#define CMA3000_RANGE2G    (1 << 7)
+#define CMA3000_RANGE8G    (0 << 7)
+#define CMA3000_BUSI2C     (0 << 4)
+#define CMA3000_MODEMASK   (7 << 1)
+#define CMA3000_GRANGEMASK (1 << 7)
+
+#define CMA3000_STATUS_PERR    1
+#define CMA3000_INTSTATUS_FFDET (1 << 2)
+
+/* Settling time delay in ms */
+#define CMA3000_SETDELAY    30
+
+/* Delay for clearing interrupt in us */
+#define CMA3000_INTDELAY    44
+
+
+/*
+ * Bit weights in mg for bit 0, other bits need
+ * multipy factor 2^n. Eight bit is the sign bit.
+ */
+#define BIT_TO_2G  18
+#define BIT_TO_8G  71
+
+struct cma3000_accl_data {
+        const struct cma3000_bus_ops *bus_ops;
+        const struct cma3000_platform_data *pdata;
+
+        struct device *dev;
+        struct input_dev *input_dev;
+
+        int bit_to_mg;
+        int irq;
+
+        int g_range;
+        u8 mode;
+
+        struct mutex mutex;
+        bool opened;
+        bool suspended;
+};
+
+#define CMA3000_READ(data, reg, msg) \
+        (data->bus_ops->read(data->dev, reg, msg))
+#define CMA3000_SET(data, reg, val, msg) \
+        ((data)->bus_ops->write(data->dev, reg, val, msg))
+
+/*
+ * Conversion for each of the eight modes to g, depending
+ * on G range i.e 2G or 8G. Some modes always operate in
+ * 8G.
+ */
+
+static int mode_to_mg[8][2] = {
+        { 0, 0 },
+        { BIT_TO_8G, BIT_TO_2G },
+        { BIT_TO_8G, BIT_TO_2G },
+        { BIT_TO_8G, BIT_TO_8G },
+        { BIT_TO_8G, BIT_TO_8G },
+        { BIT_TO_8G, BIT_TO_2G },
+        { BIT_TO_8G, BIT_TO_2G },
+        { 0, 0},
+};
+
+static void decode_mg(struct cma3000_accl_data *data, int *datax,
+                                int *datay, int *dataz)
+{
+        /* Data in 2's complement, convert to mg */
+        *datax = ((s8)*datax) * data->bit_to_mg;
+        *datay = ((s8)*datay) * data->bit_to_mg;
+        *dataz = ((s8)*dataz) * data->bit_to_mg;
+}
+
+static irqreturn_t cma3000_thread_irq(int irq, void *dev_id)
+{
+        struct cma3000_accl_data *data = dev_id;
+        int datax, datay, dataz;
+        u8 ctrl, mode, range, intr_status;
+
+        intr_status = CMA3000_READ(data, CMA3000_INTSTATUS, "interrupt status");
+        if (intr_status < 0)
+                return IRQ_NONE;
+
+        /* Check if free fall is detected, report immediately */
+        if (intr_status & CMA3000_INTSTATUS_FFDET) {
+                input_report_abs(data->input_dev, ABS_MISC, 1);
+                input_sync(data->input_dev);
+        } else {
+                input_report_abs(data->input_dev, ABS_MISC, 0);
+        }
+
+        datax = CMA3000_READ(data, CMA3000_DOUTX, "X");
+        datay = CMA3000_READ(data, CMA3000_DOUTY, "Y");
+        dataz = CMA3000_READ(data, CMA3000_DOUTZ, "Z");
+
+        ctrl = CMA3000_READ(data, CMA3000_CTRL, "ctrl");
+        mode = (ctrl & CMA3000_MODEMASK) >> 1;
+        range = (ctrl & CMA3000_GRANGEMASK) >> 7;
+
+        data->bit_to_mg = mode_to_mg[mode][range];
+
+        /* Interrupt not for this device */
+        if (data->bit_to_mg == 0)
+                return IRQ_NONE;
+
+        /* Decode register values to milli g */
+        decode_mg(data, &datax, &datay, &dataz);
+
+        input_report_abs(data->input_dev, ABS_X, datax);
+        input_report_abs(data->input_dev, ABS_Y, datay);
+        input_report_abs(data->input_dev, ABS_Z, dataz);
+        input_sync(data->input_dev);
+
+        return IRQ_HANDLED;
+}
+
+static int cma3000_reset(struct cma3000_accl_data *data)
+{
+        int val;
+
+        /* Reset sequence */
+        CMA3000_SET(data, CMA3000_RSTR, 0x02, "Reset");
+        CMA3000_SET(data, CMA3000_RSTR, 0x0A, "Reset");
+        CMA3000_SET(data, CMA3000_RSTR, 0x04, "Reset");
+
+        /* Settling time delay */
+        mdelay(10);
+
+        val = CMA3000_READ(data, CMA3000_STATUS, "Status");
+        if (val < 0) {
+                dev_err(data->dev, "Reset failed\n");
+                return val;
+        }
+
+        if (val & CMA3000_STATUS_PERR) {
+                dev_err(data->dev, "Parity Error\n");
+                return -EIO;
+        }
+
+        return 0;
+}
+
+static int cma3000_poweron(struct cma3000_accl_data *data)
+{
+        const struct cma3000_platform_data *pdata = data->pdata;
+        u8 ctrl = 0;
+        int ret;
+
+        if (data->g_range == CMARANGE_2G) {
+                ctrl = (data->mode << 1) | CMA3000_RANGE2G;
+        } else if (data->g_range == CMARANGE_8G) {
+                ctrl = (data->mode << 1) | CMA3000_RANGE8G;
+        } else {
+                dev_info(data->dev,
+                         "Invalid G range specified, assuming 8G\n");
+                ctrl = (data->mode << 1) | CMA3000_RANGE8G;
+        }
+
+        ctrl |= data->bus_ops->ctrl_mod;
+
+        CMA3000_SET(data, CMA3000_MDTHR, pdata->mdthr,
+                    "Motion Detect Threshold");
+        CMA3000_SET(data, CMA3000_MDFFTMR, pdata->mdfftmr,
+                    "Time register");
+        CMA3000_SET(data, CMA3000_FFTHR, pdata->ffthr,
+                    "Free fall threshold");
+        ret = CMA3000_SET(data, CMA3000_CTRL, ctrl, "Mode setting");
+        if (ret < 0)
+                return -EIO;
+
+        msleep(CMA3000_SETDELAY);
+
+        return 0;
+}
+
+static int cma3000_poweroff(struct cma3000_accl_data *data)
+{
+        int ret;
+
+        ret = CMA3000_SET(data, CMA3000_CTRL, CMAMODE_POFF, "Mode setting");
+        msleep(CMA3000_SETDELAY);
+
+        return ret;
+}
+
+static int cma3000_open(struct input_dev *input_dev)
+{
+        struct cma3000_accl_data *data = input_get_drvdata(input_dev);
+
+        mutex_lock(&data->mutex);
+
+        if (!data->suspended)
+                cma3000_poweron(data);
+
+        data->opened = true;
+
+        mutex_unlock(&data->mutex);
+
+        return 0;
+}
+
+static void cma3000_close(struct input_dev *input_dev)
+{
+        struct cma3000_accl_data *data = input_get_drvdata(input_dev);
+
+        mutex_lock(&data->mutex);
+
+        if (!data->suspended)
+                cma3000_poweroff(data);
+
+        data->opened = false;
+
+        mutex_unlock(&data->mutex);
+}
+
+void cma3000_suspend(struct cma3000_accl_data *data)
+{
+        mutex_lock(&data->mutex);
+
+        if (!data->suspended && data->opened)
+                cma3000_poweroff(data);
+
+        data->suspended = true;
+
+        mutex_unlock(&data->mutex);
+}
+EXPORT_SYMBOL(cma3000_suspend);
+
+
+void cma3000_resume(struct cma3000_accl_data *data)
+{
+        mutex_lock(&data->mutex);
+
+        if (data->suspended && data->opened)
+                cma3000_poweron(data);
+
+        data->suspended = false;
+
+        mutex_unlock(&data->mutex);
+}
+EXPORT_SYMBOL(cma3000_resume);
+
+struct cma3000_accl_data *cma3000_init(struct device *dev, int irq,
+                                       const struct cma3000_bus_ops *bops)
+{
+        const struct cma3000_platform_data *pdata = dev->platform_data;
+        struct cma3000_accl_data *data;
+        struct input_dev *input_dev;
+        int rev;
+        int error;
+
+        if (!pdata) {
+                dev_err(dev, "platform data not found\n");
+                error = -EINVAL;
+                goto err_out;
+        }
+
+
+        /* if no IRQ return error */
+        if (irq == 0) {
+                error = -EINVAL;
+                goto err_out;
+        }
+
+        data = kzalloc(sizeof(struct cma3000_accl_data), GFP_KERNEL);
+        input_dev = input_allocate_device();
+        if (!data || !input_dev) {
+                error = -ENOMEM;
+                goto err_free_mem;
+        }
+
+        data->dev = dev;
+        data->input_dev = input_dev;
+        data->bus_ops = bops;
+        data->pdata = pdata;
+        data->irq = irq;
+        mutex_init(&data->mutex);
+
+        data->mode = pdata->mode;
+        if (data->mode < CMAMODE_DEFAULT || data->mode > CMAMODE_POFF) {
+                data->mode = CMAMODE_MOTDET;
+                dev_warn(dev,
+                         "Invalid mode specified, assuming Motion Detect\n");
+        }
+
+        data->g_range = pdata->g_range;
+        if (data->g_range != CMARANGE_2G && data->g_range != CMARANGE_8G) {
+                dev_info(dev,
+                         "Invalid G range specified, assuming 8G\n");
+                data->g_range = CMARANGE_8G;
+        }
+
+        input_dev->name = "cma3000-accelerometer";
+        input_dev->id.bustype = bops->bustype;
+        input_dev->open = cma3000_open;
+        input_dev->close = cma3000_close;
+
+         __set_bit(EV_ABS, input_dev->evbit);
+
+        input_set_abs_params(input_dev, ABS_X,
+                        -data->g_range, data->g_range, pdata->fuzz_x, 0);
+        input_set_abs_params(input_dev, ABS_Y,
+                        -data->g_range, data->g_range, pdata->fuzz_y, 0);
+        input_set_abs_params(input_dev, ABS_Z,
+                        -data->g_range, data->g_range, pdata->fuzz_z, 0);
+        input_set_abs_params(input_dev, ABS_MISC, 0, 1, 0, 0);
+
+        input_set_drvdata(input_dev, data);
+
+        error = cma3000_reset(data);
+        if (error)
+                goto err_free_mem;
+
+        rev = CMA3000_READ(data, CMA3000_REVID, "Revid");
+        if (rev < 0) {
+                error = rev;
+                goto err_free_mem;
+        }
+
+        pr_info("CMA3000 Accelerometer: Revision %x\n", rev);
+
+        error = request_threaded_irq(irq, NULL, cma3000_thread_irq,
+                                     pdata->irqflags | IRQF_ONESHOT,
+                                     "cma3000_d0x", data);
+        if (error) {
+                dev_err(dev, "request_threaded_irq failed\n");
+                goto err_free_mem;
+        }
+
+        error = input_register_device(data->input_dev);
+        if (error) {
+                dev_err(dev, "Unable to register input device\n");
+                goto err_free_irq;
+        }
+
+        return data;
+
+err_free_irq:
+        free_irq(irq, data);
+err_free_mem:
+        input_free_device(input_dev);
+        kfree(data);
+err_out:
+        return ERR_PTR(error);
+}
+EXPORT_SYMBOL(cma3000_init);
+
+void cma3000_exit(struct cma3000_accl_data *data)
+{
+        free_irq(data->irq, data);
+        input_unregister_device(data->input_dev);
+        kfree(data);
+}
+EXPORT_SYMBOL(cma3000_exit);
+
+MODULE_DESCRIPTION("CMA3000-D0x Accelerometer Driver");
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Hemanth V <hemanthv@ti.com>");
diff --git a/drivers/input/misc/cma3000_d0x.h b/drivers/input/misc/cma3000_d0x.h
new file mode 100644
index 000000000000..2304ce306e1c
--- /dev/null
+++ b/drivers/input/misc/cma3000_d0x.h
@@ -0,0 +1,42 @@
+/*
+ * VTI CMA3000_D0x Accelerometer driver
+ *
+ * Copyright (C) 2010 Texas Instruments
+ * Author: Hemanth V <hemanthv@ti.com>
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License version 2 as published by
+ * the Free Software Foundation.
+ *
+ * This program is distributed in the hope that 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.
+ *
+ * You should have received a copy of the GNU General Public License along with
+ * this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#ifndef _INPUT_CMA3000_H
+#define _INPUT_CMA3000_H
+
+#include <linux/types.h>
+#include <linux/input.h>
+
+struct device;
+struct cma3000_accl_data;
+
+struct cma3000_bus_ops {
+        u16 bustype;
+        u8 ctrl_mod;
+        int (*read)(struct device *, u8, char *);
+        int (*write)(struct device *, u8, u8, char *);
+};
+
+struct cma3000_accl_data *cma3000_init(struct device *dev, int irq,
+                                        const struct cma3000_bus_ops *bops);
+void cma3000_exit(struct cma3000_accl_data *);
+void cma3000_suspend(struct cma3000_accl_data *);
+void cma3000_resume(struct cma3000_accl_data *);
+
+#endif
diff --git a/drivers/input/misc/cma3000_d0x_i2c.c b/drivers/input/misc/cma3000_d0x_i2c.c
new file mode 100644
index 000000000000..c52d278a7942
--- /dev/null
+++ b/drivers/input/misc/cma3000_d0x_i2c.c
@@ -0,0 +1,141 @@
+/*
+ * Implements I2C interface for VTI CMA300_D0x Accelerometer driver
+ *
+ * Copyright (C) 2010 Texas Instruments
+ * Author: Hemanth V <hemanthv@ti.com>
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License version 2 as published by
+ * the Free Software Foundation.
+ *
+ * This program is distributed in the hope that 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.
+ *
+ * You should have received a copy of the GNU General Public License along with
+ * this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <linux/module.h>
+#include <linux/i2c.h>
+#include <linux/input/cma3000.h>
+#include "cma3000_d0x.h"
+
+static int cma3000_i2c_set(struct device *dev,
+                           u8 reg, u8 val, char *msg)
+{
+        struct i2c_client *client = to_i2c_client(dev);
+        int ret;
+
+        ret = i2c_smbus_write_byte_data(client, reg, val);
+        if (ret < 0)
+                dev_err(&client->dev,
+                        "%s failed (%s, %d)\n", __func__, msg, ret);
+        return ret;
+}
+
+static int cma3000_i2c_read(struct device *dev, u8 reg, char *msg)
+{
+        struct i2c_client *client = to_i2c_client(dev);
+        int ret;
+
+        ret = i2c_smbus_read_byte_data(client, reg);
+        if (ret < 0)
+                dev_err(&client->dev,
+                        "%s failed (%s, %d)\n", __func__, msg, ret);
+        return ret;
+}
+
+static const struct cma3000_bus_ops cma3000_i2c_bops = {
+        .bustype        = BUS_I2C,
+#define CMA3000_BUSI2C     (0 << 4)
+        .ctrl_mod       = CMA3000_BUSI2C,
+        .read           = cma3000_i2c_read,
+        .write          = cma3000_i2c_set,
+};
+
+static int __devinit cma3000_i2c_probe(struct i2c_client *client,
+                                        const struct i2c_device_id *id)
+{
+        struct cma3000_accl_data *data;
+
+        data = cma3000_init(&client->dev, client->irq, &cma3000_i2c_bops);
+        if (IS_ERR(data))
+                return PTR_ERR(data);
+
+        i2c_set_clientdata(client, data);
+
+        return 0;
+}
+
+static int __devexit cma3000_i2c_remove(struct i2c_client *client)
+{
+        struct cma3000_accl_data *data = i2c_get_clientdata(client);
+
+        cma3000_exit(data);
+
+        return 0;
+}
+
+#ifdef CONFIG_PM
+static int cma3000_i2c_suspend(struct device *dev)
+{
+        struct i2c_client *client = to_i2c_client(dev);
+        struct cma3000_accl_data *data = i2c_get_clientdata(client);
+
+        cma3000_suspend(data);
+
+        return 0;
+}
+
+static int cma3000_i2c_resume(struct device *dev)
+{
+        struct i2c_client *client = to_i2c_client(dev);
+        struct cma3000_accl_data *data = i2c_get_clientdata(client);
+
+        cma3000_resume(data);
+
+        return 0;
+}
+
+static const struct dev_pm_ops cma3000_i2c_pm_ops = {
+        .suspend        = cma3000_i2c_suspend,
+        .resume         = cma3000_i2c_resume,
+};
+#endif
+
+static const struct i2c_device_id cma3000_i2c_id[] = {
+        { "cma3000_d01", 0 },
+        { },
+};
+
+static struct i2c_driver cma3000_i2c_driver = {
+        .probe          = cma3000_i2c_probe,
+        .remove         = __devexit_p(cma3000_i2c_remove),
+        .id_table       = cma3000_i2c_id,
+        .driver = {
+                .name   = "cma3000_i2c_accl",
+                .owner  = THIS_MODULE,
+#ifdef CONFIG_PM
+                .pm     = &cma3000_i2c_pm_ops,
+#endif
+        },
+};
+
+static int __init cma3000_i2c_init(void)
+{
+        return i2c_add_driver(&cma3000_i2c_driver);
+}
+
+static void __exit cma3000_i2c_exit(void)
+{
+        i2c_del_driver(&cma3000_i2c_driver);
+}
+
+module_init(cma3000_i2c_init);
+module_exit(cma3000_i2c_exit);
+
+MODULE_DESCRIPTION("CMA3000-D0x Accelerometer I2C Driver");
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Hemanth V <hemanthv@ti.com>");