diff options
Diffstat (limited to 'drivers/iio/gyro/st_gyro_spi.c')
-rw-r--r-- | drivers/iio/gyro/st_gyro_spi.c | 83 |
1 files changed, 83 insertions, 0 deletions
diff --git a/drivers/iio/gyro/st_gyro_spi.c b/drivers/iio/gyro/st_gyro_spi.c new file mode 100644 index 000000000000..f3540390eb22 --- /dev/null +++ b/drivers/iio/gyro/st_gyro_spi.c | |||
@@ -0,0 +1,83 @@ | |||
1 | /* | ||
2 | * STMicroelectronics gyroscopes 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/spi/spi.h> | ||
15 | #include <linux/iio/iio.h> | ||
16 | |||
17 | #include <linux/iio/common/st_sensors.h> | ||
18 | #include <linux/iio/common/st_sensors_spi.h> | ||
19 | #include "st_gyro.h" | ||
20 | |||
21 | static int st_gyro_spi_probe(struct spi_device *spi) | ||
22 | { | ||
23 | struct iio_dev *indio_dev; | ||
24 | struct st_sensor_data *gdata; | ||
25 | int err; | ||
26 | |||
27 | indio_dev = iio_device_alloc(sizeof(*gdata)); | ||
28 | if (indio_dev == NULL) { | ||
29 | err = -ENOMEM; | ||
30 | goto iio_device_alloc_error; | ||
31 | } | ||
32 | |||
33 | gdata = iio_priv(indio_dev); | ||
34 | gdata->dev = &spi->dev; | ||
35 | |||
36 | st_sensors_spi_configure(indio_dev, spi, gdata); | ||
37 | |||
38 | err = st_gyro_common_probe(indio_dev); | ||
39 | if (err < 0) | ||
40 | goto st_gyro_common_probe_error; | ||
41 | |||
42 | return 0; | ||
43 | |||
44 | st_gyro_common_probe_error: | ||
45 | iio_device_free(indio_dev); | ||
46 | iio_device_alloc_error: | ||
47 | return err; | ||
48 | } | ||
49 | |||
50 | static int st_gyro_spi_remove(struct spi_device *spi) | ||
51 | { | ||
52 | st_gyro_common_remove(spi_get_drvdata(spi)); | ||
53 | |||
54 | return 0; | ||
55 | } | ||
56 | |||
57 | static const struct spi_device_id st_gyro_id_table[] = { | ||
58 | { L3G4200D_GYRO_DEV_NAME }, | ||
59 | { LSM330D_GYRO_DEV_NAME }, | ||
60 | { LSM330DL_GYRO_DEV_NAME }, | ||
61 | { LSM330DLC_GYRO_DEV_NAME }, | ||
62 | { L3GD20_GYRO_DEV_NAME }, | ||
63 | { L3GD20H_GYRO_DEV_NAME }, | ||
64 | { L3G4IS_GYRO_DEV_NAME }, | ||
65 | { LSM330_GYRO_DEV_NAME }, | ||
66 | {}, | ||
67 | }; | ||
68 | MODULE_DEVICE_TABLE(spi, st_gyro_id_table); | ||
69 | |||
70 | static struct spi_driver st_gyro_driver = { | ||
71 | .driver = { | ||
72 | .owner = THIS_MODULE, | ||
73 | .name = "st-gyro-spi", | ||
74 | }, | ||
75 | .probe = st_gyro_spi_probe, | ||
76 | .remove = st_gyro_spi_remove, | ||
77 | .id_table = st_gyro_id_table, | ||
78 | }; | ||
79 | module_spi_driver(st_gyro_driver); | ||
80 | |||
81 | MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>"); | ||
82 | MODULE_DESCRIPTION("STMicroelectronics gyroscopes spi driver"); | ||
83 | MODULE_LICENSE("GPL v2"); | ||