From e70959f79384901bf089695d0ff9786e60b4c361 Mon Sep 17 00:00:00 2001 From: Luwei Zhou Date: Fri, 20 Dec 2013 10:23:39 +0800 Subject: [PATCH] ENGR00281813 input: mma8450: evbug module will keep print message. evbug will open the mma8450 on i.MX6SL_EVK and mma8450 will work in 2G mode by default. That is the reason why mma8450 logs will be printed out. The main changes is below: * Remove the open(), close() hook out of the drivers. The open() and close() hook in input framwork is defined as void type. It isn't strictly safe in logic when some error happends. So remove them out. * Modify the mma8450 to standby mode by default. It will be more power saving and there would be no log printing out after booting up. * Provide the sys interface to modify the mma8450 work modes. Then the higher layer can modify the the mma8450 work mode via the interface. It would be much safer.There would be a sclaemode interface in the folder of /sys/devices/soc0/soc.1/2100000.aips-bus/21a0000.i2c/i2c-0/0-001c/scalemode User can use cat to read the current scalemode and echo to write. The mode is defined as: MODE_STANDBY: 0 MODE_2G:1 MODE_4G:2 MODE_8G:3 * Add mutex to protect and some error handling. Signed-off-by: Luwei Zhou (cherry picked from commit c51a786078fd569ce95eb6dcf09c76d1b3c0f172) --- drivers/input/misc/mma8450.c | 137 +++++++++++++++++++++++++++++++---- 1 file changed, 122 insertions(+), 15 deletions(-) diff --git a/drivers/input/misc/mma8450.c b/drivers/input/misc/mma8450.c index 7744d23cc584..2f24bef6bd67 100644 --- a/drivers/input/misc/mma8450.c +++ b/drivers/input/misc/mma8450.c @@ -25,6 +25,7 @@ #include #include #include +#include #define MMA8450_DRV_NAME "mma8450" @@ -54,10 +55,19 @@ #define MMA8450_ID 0xC6 #define MMA8450_WHO_AM_I 0x0F +enum { + MODE_STANDBY = 0, + MODE_2G, + MODE_4G, + MODE_8G, +}; + /* mma8450 status */ struct mma8450 { struct i2c_client *client; struct input_polled_dev *idev; + struct mutex mma8450_lock; + u8 mode; }; static int mma8450_read(struct mma8450 *m, unsigned off) @@ -114,16 +124,19 @@ static void mma8450_poll(struct input_polled_dev *dev) int ret; u8 buf[6]; - ret = mma8450_read(m, MMA8450_STATUS); - if (ret < 0) - return; + mutex_lock(&m->mma8450_lock); - if (!(ret & MMA8450_STATUS_ZXYDR)) + ret = mma8450_read(m, MMA8450_STATUS); + if (ret < 0 || !(ret & MMA8450_STATUS_ZXYDR)) { + mutex_unlock(&m->mma8450_lock); return; + } ret = mma8450_read_block(m, MMA8450_OUT_X_LSB, buf, sizeof(buf)); - if (ret < 0) + if (ret < 0) { + mutex_unlock(&m->mma8450_lock); return; + } x = ((int)(s8)buf[1] << 4) | (buf[0] & 0xf); y = ((int)(s8)buf[3] << 4) | (buf[2] & 0xf); @@ -133,10 +146,12 @@ static void mma8450_poll(struct input_polled_dev *dev) input_report_abs(dev->input, ABS_Y, y); input_report_abs(dev->input, ABS_Z, z); input_sync(dev->input); + + mutex_unlock(&m->mma8450_lock); } /* Initialize the MMA8450 chip */ -static void mma8450_open(struct input_polled_dev *dev) +static s32 mma8450_open(struct input_polled_dev *dev) { struct mma8450 *m = dev->private; int err; @@ -144,18 +159,20 @@ static void mma8450_open(struct input_polled_dev *dev) /* enable all events from X/Y/Z, no FIFO */ err = mma8450_write(m, MMA8450_XYZ_DATA_CFG, 0x07); if (err) - return; + return err; /* * Sleep mode poll rate - 50Hz * System output data rate - 400Hz - * Full scale selection - Active, +/- 2G + * Standby mode */ - err = mma8450_write(m, MMA8450_CTRL_REG1, 0x01); - if (err < 0) - return; - + err = mma8450_write(m, MMA8450_CTRL_REG1, MODE_STANDBY); + if (err) + return err; + m->mode = MODE_STANDBY; msleep(MODE_CHANGE_DELAY_MS); + + return 0; } static void mma8450_close(struct input_polled_dev *dev) @@ -166,6 +183,76 @@ static void mma8450_close(struct input_polled_dev *dev) mma8450_write(m, MMA8450_CTRL_REG2, 0x01); } +static ssize_t mma8450_scalemode_show(struct device *dev, + struct device_attribute *attr, + char *buf) +{ + int mode = 0; + struct mma8450 *m; + struct i2c_client *client = to_i2c_client(dev); + + m = i2c_get_clientdata(client); + + mutex_lock(&m->mma8450_lock); + mode = (int)m->mode; + mutex_unlock(&m->mma8450_lock); + + return sprintf(buf, "%d\n", mode); +} + +static ssize_t mma8450_scalemode_store(struct device *dev, + struct device_attribute *attr, + const char *buf, size_t count) +{ + unsigned long mode; + int ret; + struct mma8450 *m = NULL; + struct i2c_client *client = to_i2c_client(dev); + + ret = strict_strtoul(buf, 10, &mode); + if (ret) { + dev_err(dev, "string transform error\n"); + return ret; + } + + if (mode > MODE_8G) { + dev_warn(dev, "not supported mode %d\n", (int)mode); + return count; + } + + m = i2c_get_clientdata(client); + + mutex_lock(&m->mma8450_lock); + if (mode == m->mode) { + mutex_unlock(&m->mma8450_lock); + return count; + } + + ret = mma8450_write(m, MMA8450_CTRL_REG1, mode); + if (ret < 0) { + mutex_unlock(&m->mma8450_lock); + return ret; + } + + msleep(MODE_CHANGE_DELAY_MS); + m->mode = (u8)mode; + mutex_unlock(&m->mma8450_lock); + + return count; +} + +static DEVICE_ATTR(scalemode, S_IWUSR | S_IRUGO, + mma8450_scalemode_show, mma8450_scalemode_store); + +static struct attribute *mma8450_attributes[] = { + &dev_attr_scalemode.attr, + NULL +}; + +static const struct attribute_group mma8450_attr_group = { + .attrs = mma8450_attributes, +}; + /* * I2C init/probing/exit functions */ @@ -203,6 +290,7 @@ static int mma8450_probe(struct i2c_client *c, m->client = c; m->idev = idev; + i2c_set_clientdata(c, m); idev->private = m; idev->input->name = MMA8450_DRV_NAME; @@ -210,8 +298,6 @@ static int mma8450_probe(struct i2c_client *c, idev->poll = mma8450_poll; idev->poll_interval = POLL_INTERVAL; idev->poll_interval_max = POLL_INTERVAL_MAX; - idev->open = mma8450_open; - idev->close = mma8450_close; __set_bit(EV_ABS, idev->input->evbit); input_set_abs_params(idev->input, ABS_X, -2048, 2047, 32, 32); @@ -224,10 +310,28 @@ static int mma8450_probe(struct i2c_client *c, goto err_free_mem; } - i2c_set_clientdata(c, m); + mutex_init(&m->mma8450_lock); + + err = mma8450_open(idev); + if (err) { + dev_err(&c->dev, "failed to initialize mma8450\n"); + goto err_unreg_dev; + } + + err = sysfs_create_group(&c->dev.kobj, &mma8450_attr_group); + if (err) { + dev_err(&c->dev, "create device file failed!\n"); + err = -EINVAL; + goto err_close; + } return 0; +err_close: + mma8450_close(idev); +err_unreg_dev: + mutex_destroy(&m->mma8450_lock); + input_unregister_polled_device(idev); err_free_mem: input_free_polled_device(idev); kfree(m); @@ -240,6 +344,9 @@ static int mma8450_remove(struct i2c_client *c) struct mma8450 *m = i2c_get_clientdata(c); struct input_polled_dev *idev = m->idev; + sysfs_remove_group(&c->dev.kobj, &mma8450_attr_group); + mma8450_close(idev); + mutex_destroy(&m->mma8450_lock); input_unregister_polled_device(idev); input_free_polled_device(idev); kfree(m); -- 2.39.5