@@ -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"
@@ -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
new file mode 100644
@@ -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");