diff options
Diffstat (limited to 'drivers/iio/accel/st_accel_i2c.c')
-rw-r--r-- | drivers/iio/accel/st_accel_i2c.c | 86 |
1 files changed, 86 insertions, 0 deletions
diff --git a/drivers/iio/accel/st_accel_i2c.c b/drivers/iio/accel/st_accel_i2c.c new file mode 100644 index 000000000000..ffc9d097e484 --- /dev/null +++ b/drivers/iio/accel/st_accel_i2c.c | |||
@@ -0,0 +1,86 @@ | |||
1 | /* | ||
2 | * STMicroelectronics accelerometers driver | ||
3 | * | ||
4 | * Copyright 2012-2013 STMicroelectronics Inc. | ||
5 | * | ||
6 | * Denis Ciocca <denis.ciocca@st.com> | ||
7 | * | ||
8 | * Licensed under the GPL-2. | ||
9 | */ | ||
10 | |||
11 | #include <linux/kernel.h> | ||
12 | #include <linux/module.h> | ||
13 | #include <linux/slab.h> | ||
14 | #include <linux/i2c.h> | ||
15 | #include <linux/iio/iio.h> | ||
16 | |||
17 | #include <linux/iio/common/st_sensors.h> | ||
18 | #include <linux/iio/common/st_sensors_i2c.h> | ||
19 | #include "st_accel.h" | ||
20 | |||
21 | static int st_accel_i2c_probe(struct i2c_client *client, | ||
22 | const struct i2c_device_id *id) | ||
23 | { | ||
24 | struct iio_dev *indio_dev; | ||
25 | struct st_sensor_data *adata; | ||
26 | int err; | ||
27 | |||
28 | indio_dev = iio_device_alloc(sizeof(*adata)); | ||
29 | if (indio_dev == NULL) { | ||
30 | err = -ENOMEM; | ||
31 | goto iio_device_alloc_error; | ||
32 | } | ||
33 | |||
34 | adata = iio_priv(indio_dev); | ||
35 | adata->dev = &client->dev; | ||
36 | |||
37 | st_sensors_i2c_configure(indio_dev, client, adata); | ||
38 | |||
39 | err = st_accel_common_probe(indio_dev); | ||
40 | if (err < 0) | ||
41 | goto st_accel_common_probe_error; | ||
42 | |||
43 | return 0; | ||
44 | |||
45 | st_accel_common_probe_error: | ||
46 | iio_device_free(indio_dev); | ||
47 | iio_device_alloc_error: | ||
48 | return err; | ||
49 | } | ||
50 | |||
51 | static int st_accel_i2c_remove(struct i2c_client *client) | ||
52 | { | ||
53 | st_accel_common_remove(i2c_get_clientdata(client)); | ||
54 | |||
55 | return 0; | ||
56 | } | ||
57 | |||
58 | static const struct i2c_device_id st_accel_id_table[] = { | ||
59 | { LSM303DLH_ACCEL_DEV_NAME }, | ||
60 | { LSM303DLHC_ACCEL_DEV_NAME }, | ||
61 | { LIS3DH_ACCEL_DEV_NAME }, | ||
62 | { LSM330D_ACCEL_DEV_NAME }, | ||
63 | { LSM330DL_ACCEL_DEV_NAME }, | ||
64 | { LSM330DLC_ACCEL_DEV_NAME }, | ||
65 | { LIS331DLH_ACCEL_DEV_NAME }, | ||
66 | { LSM303DL_ACCEL_DEV_NAME }, | ||
67 | { LSM303DLM_ACCEL_DEV_NAME }, | ||
68 | { LSM330_ACCEL_DEV_NAME }, | ||
69 | {}, | ||
70 | }; | ||
71 | MODULE_DEVICE_TABLE(i2c, st_accel_id_table); | ||
72 | |||
73 | static struct i2c_driver st_accel_driver = { | ||
74 | .driver = { | ||
75 | .owner = THIS_MODULE, | ||
76 | .name = "st-accel-i2c", | ||
77 | }, | ||
78 | .probe = st_accel_i2c_probe, | ||
79 | .remove = st_accel_i2c_remove, | ||
80 | .id_table = st_accel_id_table, | ||
81 | }; | ||
82 | module_i2c_driver(st_accel_driver); | ||
83 | |||
84 | MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>"); | ||
85 | MODULE_DESCRIPTION("STMicroelectronics accelerometers i2c driver"); | ||
86 | MODULE_LICENSE("GPL v2"); | ||