1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * STMicroelectronics gyroscopes driver |
4 | * |
5 | * Copyright 2012-2013 STMicroelectronics Inc. |
6 | * |
7 | * Denis Ciocca <denis.ciocca@st.com> |
8 | */ |
9 | |
10 | #include <linux/kernel.h> |
11 | #include <linux/module.h> |
12 | #include <linux/mod_devicetable.h> |
13 | #include <linux/spi/spi.h> |
14 | #include <linux/iio/iio.h> |
15 | |
16 | #include <linux/iio/common/st_sensors.h> |
17 | #include <linux/iio/common/st_sensors_spi.h> |
18 | #include "st_gyro.h" |
19 | |
20 | /* |
21 | * For new single-chip sensors use <device_name> as compatible string. |
22 | * For old single-chip devices keep <device_name>-gyro to maintain |
23 | * compatibility |
24 | */ |
25 | static const struct of_device_id st_gyro_of_match[] = { |
26 | { |
27 | .compatible = "st,l3g4200d-gyro" , |
28 | .data = L3G4200D_GYRO_DEV_NAME, |
29 | }, |
30 | { |
31 | .compatible = "st,lsm330d-gyro" , |
32 | .data = LSM330D_GYRO_DEV_NAME, |
33 | }, |
34 | { |
35 | .compatible = "st,lsm330dl-gyro" , |
36 | .data = LSM330DL_GYRO_DEV_NAME, |
37 | }, |
38 | { |
39 | .compatible = "st,lsm330dlc-gyro" , |
40 | .data = LSM330DLC_GYRO_DEV_NAME, |
41 | }, |
42 | { |
43 | .compatible = "st,l3gd20-gyro" , |
44 | .data = L3GD20_GYRO_DEV_NAME, |
45 | }, |
46 | { |
47 | .compatible = "st,l3gd20h-gyro" , |
48 | .data = L3GD20H_GYRO_DEV_NAME, |
49 | }, |
50 | { |
51 | .compatible = "st,l3g4is-gyro" , |
52 | .data = L3G4IS_GYRO_DEV_NAME, |
53 | }, |
54 | { |
55 | .compatible = "st,lsm330-gyro" , |
56 | .data = LSM330_GYRO_DEV_NAME, |
57 | }, |
58 | { |
59 | .compatible = "st,lsm9ds0-gyro" , |
60 | .data = LSM9DS0_GYRO_DEV_NAME, |
61 | }, |
62 | {}, |
63 | }; |
64 | MODULE_DEVICE_TABLE(of, st_gyro_of_match); |
65 | |
66 | static int st_gyro_spi_probe(struct spi_device *spi) |
67 | { |
68 | const struct st_sensor_settings *settings; |
69 | struct st_sensor_data *gdata; |
70 | struct iio_dev *indio_dev; |
71 | int err; |
72 | |
73 | st_sensors_dev_name_probe(dev: &spi->dev, name: spi->modalias, len: sizeof(spi->modalias)); |
74 | |
75 | settings = st_gyro_get_settings(name: spi->modalias); |
76 | if (!settings) { |
77 | dev_err(&spi->dev, "device name %s not recognized.\n" , |
78 | spi->modalias); |
79 | return -ENODEV; |
80 | } |
81 | |
82 | indio_dev = devm_iio_device_alloc(parent: &spi->dev, sizeof_priv: sizeof(*gdata)); |
83 | if (!indio_dev) |
84 | return -ENOMEM; |
85 | |
86 | gdata = iio_priv(indio_dev); |
87 | gdata->sensor_settings = (struct st_sensor_settings *)settings; |
88 | |
89 | err = st_sensors_spi_configure(indio_dev, spi); |
90 | if (err < 0) |
91 | return err; |
92 | |
93 | err = st_sensors_power_enable(indio_dev); |
94 | if (err) |
95 | return err; |
96 | |
97 | return st_gyro_common_probe(indio_dev); |
98 | } |
99 | |
100 | static const struct spi_device_id st_gyro_id_table[] = { |
101 | { L3G4200D_GYRO_DEV_NAME }, |
102 | { LSM330D_GYRO_DEV_NAME }, |
103 | { LSM330DL_GYRO_DEV_NAME }, |
104 | { LSM330DLC_GYRO_DEV_NAME }, |
105 | { L3GD20_GYRO_DEV_NAME }, |
106 | { L3GD20H_GYRO_DEV_NAME }, |
107 | { L3G4IS_GYRO_DEV_NAME }, |
108 | { LSM330_GYRO_DEV_NAME }, |
109 | { LSM9DS0_GYRO_DEV_NAME }, |
110 | {}, |
111 | }; |
112 | MODULE_DEVICE_TABLE(spi, st_gyro_id_table); |
113 | |
114 | static struct spi_driver st_gyro_driver = { |
115 | .driver = { |
116 | .name = "st-gyro-spi" , |
117 | .of_match_table = st_gyro_of_match, |
118 | }, |
119 | .probe = st_gyro_spi_probe, |
120 | .id_table = st_gyro_id_table, |
121 | }; |
122 | module_spi_driver(st_gyro_driver); |
123 | |
124 | MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>" ); |
125 | MODULE_DESCRIPTION("STMicroelectronics gyroscopes spi driver" ); |
126 | MODULE_LICENSE("GPL v2" ); |
127 | MODULE_IMPORT_NS(IIO_ST_SENSORS); |
128 | |