> Daniel
>
>
> > > Signed-off-by: Kalhan Trisal <kalhan.trisal@intel.com>
> > > Signed-off-by: Alan Cox <alan@linux.intel.com>
> > > ---
> > >
> > > drivers/hwmon/Kconfig | 8 +
> > > drivers/hwmon/Makefile | 1
> > > drivers/hwmon/lis331dl.c | 286 ++++++++++++++++++++++++++++++++++++++++++++++
> > > 3 files changed, 295 insertions(+), 0 deletions(-)
> > > create mode 100644 drivers/hwmon/lis331dl.c
> > >
> > >
> > > diff --git a/drivers/hwmon/Kconfig b/drivers/hwmon/Kconfig
> > > index 1fa2533..6868b9d 100644
> > > --- a/drivers/hwmon/Kconfig
> > > +++ b/drivers/hwmon/Kconfig
> > > @@ -1104,6 +1104,14 @@ config SENSORS_ISL29020
> > > Range values can be configured using sysfs.
> > > Lux data is accessible via sysfs.
> > >
> > > +config SENSORS_LIS331DL
> > > + tristate "STMicroeletronics LIS331DL three-axis digital accelerometer"
> > > + depends on I2C
> > > + help
> > > + If you say yes here you get support for the Accelerometer Devices
> > > + Device can be configured using sysfs.
> > > + x y Z data can be accessible via sysfs.
> > > +
> > > if ACPI
> > >
> > > comment "ACPI drivers"
> > > diff --git a/drivers/hwmon/Makefile b/drivers/hwmon/Makefile
> > > index 13d6832..ebeb2a2 100644
> > > --- a/drivers/hwmon/Makefile
> > > +++ b/drivers/hwmon/Makefile
> > > @@ -60,6 +60,7 @@ obj-$(CONFIG_SENSORS_K10TEMP) += k10temp.o
> > > obj-$(CONFIG_SENSORS_LIS3LV02D) += lis3lv02d.o hp_accel.o
> > > obj-$(CONFIG_SENSORS_LIS3_SPI) += lis3lv02d.o lis3lv02d_spi.o
> > > obj-$(CONFIG_SENSORS_LIS3_I2C) += lis3lv02d.o lis3lv02d_i2c.o
> > > +obj-$(CONFIG_SENSORS_LIS331DL) += lis331dl.o
> > > obj-$(CONFIG_SENSORS_LM63) += lm63.o
> > > obj-$(CONFIG_SENSORS_LM70) += lm70.o
> > > obj-$(CONFIG_SENSORS_LM73) += lm73.o
> > > diff --git a/drivers/hwmon/lis331dl.c b/drivers/hwmon/lis331dl.c
> > > new file mode 100644
> > > index 0000000..34009eb
> > > --- /dev/null
> > > +++ b/drivers/hwmon/lis331dl.c
> > > @@ -0,0 +1,286 @@
> > > +/*
> > > + * lis331dl.c - ST LIS331DL Accelerometer Driver
> > > + *
> > > + * Copyright (C) 2009 Intel Corp
> > > + *
> > > + * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
> > > + *
> > > + * This program is free software; you can redistribute it and/or modify
> > > + * it under the terms of the GNU General Public License as published by
> > > + * the Free Software Foundation; version 2 of the License.
> > > + *
> > > + * 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, write to the Free Software Foundation, Inc.,
> > > + * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
> > > + * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
> > > + *
> > > + */
> > > +
> > > +#include <linux/module.h>
> > > +#include <linux/init.h>
> > > +#include <linux/slab.h>
> > > +#include <linux/i2c.h>
> > > +#include <linux/err.h>
> > > +#include <linux/delay.h>
> > > +#include <linux/mutex.h>
> > > +#include <linux/sysfs.h>
> > > +#include <linux/input-polldev.h>
> > > +
> > > +
> > > +#define POLL_INTERVAL 50
> > > +
> > > +struct lis331dl {
> > > + struct input_polled_dev *idev;
> > > + struct i2c_client *client;
> > > + struct mutex update_lock;
> > > +};
> > > +
> > > +static ssize_t data_rate_show(struct device *dev,
> > > + struct device_attribute *attr, char *buf)
> > > +{
> > > + struct i2c_client *client = to_i2c_client(dev);
> > > + int val;
> > > + int speed = 100;
> > > +
> > > + val = i2c_smbus_read_byte_data(client, 0x20);
> > > + if (val & 0x80); /* 1= 400HZ 0= 100HZ */
> > > + speed = 400;
> > > + return sprintf(buf, "%d\n", speed);
> > > +}
> > > +
> > > +static ssize_t power_mode_show(struct device *dev,
> > > + struct device_attribute *attr, char *buf)
> > > +{
> > > + struct i2c_client *client = to_i2c_client(dev);
> > > + int val;
> > > +
> > > + val = i2c_smbus_read_byte_data(client, 0x20) & 0x40;
> > > + if (val == 0x40)
> > > + val = 1;
> > > + return sprintf(buf, "%d\n", val);
> > > +}
> > > +
> > > +static int read_with_retries(struct i2c_client *client, int r)
> > > +{
> > > + int retries;
> > > + int ret;
> > > +
> > > + for (retries = 0; retries < 5; retries++) {
> > > + ret = i2c_smbus_read_byte_data(client, r);
> > > + if (ret != -ETIMEDOUT)
> > > + break;
> > > + msleep(10);
> > > + }
> > > + return ret;
> > > +}
> > > +
> > > +static void lis331dl_poll(struct input_polled_dev *idev)
> > > +{
> > > + struct input_dev *input = idev->input;
> > > + struct lis331dl *data = idev->private;
> > > + int x, y, z;
> > > + struct i2c_client *client = data->client;
> > > +
> > > + x = read_with_retries(client, 0x29);
> > > + y = read_with_retries(client, 0x2B);
> > > + z = read_with_retries(client, 0x2D);
> > > +
> > > + input_report_abs(input, ABS_X, x);
> > > + input_report_abs(input, ABS_Y, y);
> > > + input_report_abs(input, ABS_Z, z);
> > > + input_sync(input);
> > > +}
> > > +
> > > +static ssize_t data_rate_store(struct device *dev,
> > > + struct device_attribute *attr, const char *buf, size_t count)
> > > +{
> > > + struct i2c_client *client = to_i2c_client(dev);
> > > + struct lis331dl *data = i2c_get_clientdata(client);
> > > + unsigned int ret_val;
> > > + unsigned long val;
> > > +
> > > + if (strict_strtoul(buf, 10, &val))
> > > + return -EINVAL;
> > > +
> > > + mutex_lock(&data->update_lock);
> > > +
> > > + ret_val = i2c_smbus_read_byte_data(client, 0x20);
> > > + ret_val &= 0x7F;
> > > +
> > > + switch (val) {
> > > + case 400:
> > > + ret_val |= 0x80;
> > > + case 100:
> > > + i2c_smbus_write_byte_data(client, 0x20, ret_val);
> > > + break;
> > > + default:
> > > + mutex_unlock(&data->update_lock);
> > > + return -EINVAL;
> > > + }
> > > + mutex_unlock(&data->update_lock);
> > > + return count;
> > > +}
> > > +
> > > +static ssize_t power_mode_store(struct device *dev,
> > > + struct device_attribute *attr, const char *buf, size_t count)
> > > +{
> > > + struct i2c_client *client = to_i2c_client(dev);
> > > + struct lis331dl *data = i2c_get_clientdata(client);
> > > + unsigned int ret_val;
> > > + unsigned long val;
> > > +
> > > + if (strict_strtoul(buf, 10, &val))
> > > + return -EINVAL;
> > > +
> > > + mutex_lock(&data->update_lock);
> > > +
> > > + ret_val = i2c_smbus_read_byte_data(client, 0x20);
> > > + ret_val &= 0xBF;
> > > +
> > > + switch(val) {
> > > + case 1:
> > > + ret_val |= 0x40;
> > > + case 0:
> > > + i2c_smbus_write_byte_data(client, 0x20, ret_val);
> > > + break;
> > > + default:
> > > + mutex_unlock(&data->update_lock);
> > > + return -EINVAL;
> > > + }
> > > + mutex_unlock(&data->update_lock);
> > > + return count;
> > > +}
> > > +
> > > +static DEVICE_ATTR(data_rate, S_IRUGO | S_IWUSR,
> > > + data_rate_show, data_rate_store);
> > > +static DEVICE_ATTR(power_state, S_IRUGO | S_IWUSR,
> > > + power_mode_show, power_mode_store);
> > > +
> > > +static struct attribute *mid_att_accelero[] = {
> > > + &dev_attr_data_rate.attr,
> > > + &dev_attr_power_state.attr,
> > > + NULL
> > > +};
> > > +
> > > +static struct attribute_group m_accelero_gr = {
> > > + .name = "lis331dl",
> > > + .attrs = mid_att_accelero
> > > +};
> > > +
> > > +static void accel_set_default_config(struct i2c_client *client)
> > > +{
> > > + i2c_smbus_write_byte_data(client, 0x20, 0x47);
> > > +}
> > > +
> > > +static int lis331dl_probe(struct i2c_client *client,
> > > + const struct i2c_device_id *id)
> > > +{
> > > + int res;
> > > + struct lis331dl *data;
> > > + struct input_polled_dev *idev;
> > > + struct input_dev *input;
> > > +
> > > + data = kzalloc(sizeof(struct lis331dl), GFP_KERNEL);
> > > + if (data == NULL) {
> > > + dev_err(&client->dev, "lis331dl: out of memory\n");
> > > + return -ENOMEM;
> > > + }
> > > + mutex_init(&data->update_lock);
> > > + i2c_set_clientdata(client, data);
> > > + data->client = client;
> > > +
> > > + res = sysfs_create_group(&client->dev.kobj, &m_accelero_gr);
> > > + if (res) {
> > > + dev_err(&client->dev, "lis331dl: sysfs group failed\n");
> > > + goto accelero_error1;
> > > + }
> > > + idev = input_allocate_polled_device();
> > > + if (!idev) {
> > > + res = -ENOMEM;
> > > + dev_err(&client->dev,
> > > + "lis331dl: unable to register input device\n");
> > > + goto accelero_error2;
> > > + }
> > > + idev->poll = lis331dl_poll;
> > > + idev->poll_interval = POLL_INTERVAL;
> > > +
> > > + idev->private = data;
> > > + data->idev = idev;
> > > +
> > > + input = idev->input;
> > > + input->name = "lis331dl";
> > > + input->phys = "lis331dl/input0";
> > > + input->id.bustype = BUS_I2C;
> > > + input->dev.parent = &client->dev;
> > > + input->evbit[0] = BIT_MASK(EV_ABS);
> > > + input_set_abs_params(input, ABS_X, 0, 255, 2, 2);
> > > + input_set_abs_params(input, ABS_Y, 0, 255, 2, 2);
> > > + input_set_abs_params(input, ABS_Z, 0, 255, 2, 2);
> > > +
> > > + res = input_register_polled_device(idev);
> > > + if (res == 0) {
> > > + dev_info(&client->dev,
> > > + "%s lis331dl: Accelerometer chip found",
> > > + client->name);
> > > + return 0;
> > > + }
> > > + input_free_polled_device(idev);
> > > +accelero_error2:
> > > + sysfs_remove_group(&client->dev.kobj, &m_accelero_gr);
> > > +accelero_error1:
> > > + i2c_set_clientdata(client, NULL);
> > > + kfree(data);
> > > + return res;
> > > +}
> > > +
> > > +static int lis331dl_remove(struct i2c_client *client)
> > > +{
> > > + struct lis331dl *data = i2c_get_clientdata(client);
> > > +
> > > + input_unregister_polled_device(data->idev);
> > > + input_free_polled_device(data->idev);
> > > + sysfs_remove_group(&client->dev.kobj, &m_accelero_gr);
> > > + kfree(data);
> > > + return 0;
> > > +}
> > > +
> > > +static struct i2c_device_id lis331dl_id[] = {
> > > + { "i2c_accel", 0 },
> > > + { }
> > > +};
> > > +
> > > +MODULE_DEVICE_TABLE(i2c, lis331dl_id);
> > > +
> > > +static struct i2c_driver lis331dl_driver = {
> > > + .driver = {
> > > + .name = "lis331dl",
> > > + },
> > > + .probe = lis331dl_probe,
> > > + .remove = lis331dl_remove,
> > > + .id_table = lis331dl_id,
> > > +};
> > > +
> > > +static int __init sensor_lis331dl_init(void)
> > > +{
> > > + int res;
> > > +
> > > + res = i2c_add_driver(&lis331dl_driver);
> > > + return res;
> > > +}
> > > +
> > > +static void __exit sensor_lis331dl_exit(void)
> > > +{
> > > + i2c_del_driver(&lis331dl_driver);
> > > +}
> > > +
> > > +module_init(sensor_lis331dl_init);
> > > +module_exit(sensor_lis331dl_exit);
> > > +
> > > +MODULE_AUTHOR("Kalhan Trisal <kalhan.trisal@intel.com>, Alan Cox");
> > > +MODULE_DESCRIPTION("STMicroelectronics LIS331DL Accelerometer Driver");
> > > +MODULE_LICENSE("GPL v2");
> > >
> > > --
> > > To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
> > > the body of a message to
majordomo@vger.kernel.org
> > > More majordomo info at
http://vger.kernel.org/majordomo-info.html
> > > Please read the FAQ at
http://www.tux.org/lkml/
> >
> > --
> > To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
> > the body of a message to
majordomo@vger.kernel.org
> > More majordomo info at
http://vger.kernel.org/majordomo-info.html
> > Please read the FAQ at
http://www.tux.org/lkml/
> --
> To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
> the body of a message to
majordomo@vger.kernel.org
> More majordomo info at
http://vger.kernel.org/majordomo-info.html
> Please read the FAQ at
http://www.tux.org/lkml/