1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * STMicroelectronics accelerometers 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_accel.h"
19
20 /*
21 * For new single-chip sensors use <device_name> as compatible string.
22 * For old single-chip devices keep <device_name>-accel to maintain
23 * compatibility
24 */
25 static const struct of_device_id st_accel_of_match[] = {
26 {
27 /* An older compatible */
28 .compatible = "st,lis302dl-spi",
29 .data = LIS3LV02DL_ACCEL_DEV_NAME,
30 },
31 {
32 .compatible = "st,lis3lv02dl-accel",
33 .data = LIS3LV02DL_ACCEL_DEV_NAME,
34 },
35 {
36 .compatible = "st,lis3dh-accel",
37 .data = LIS3DH_ACCEL_DEV_NAME,
38 },
39 {
40 .compatible = "st,lsm330d-accel",
41 .data = LSM330D_ACCEL_DEV_NAME,
42 },
43 {
44 .compatible = "st,lsm330dl-accel",
45 .data = LSM330DL_ACCEL_DEV_NAME,
46 },
47 {
48 .compatible = "st,lsm330dlc-accel",
49 .data = LSM330DLC_ACCEL_DEV_NAME,
50 },
51 {
52 .compatible = "st,lis331dlh-accel",
53 .data = LIS331DLH_ACCEL_DEV_NAME,
54 },
55 {
56 .compatible = "st,lsm330-accel",
57 .data = LSM330_ACCEL_DEV_NAME,
58 },
59 {
60 .compatible = "st,lsm303agr-accel",
61 .data = LSM303AGR_ACCEL_DEV_NAME,
62 },
63 {
64 .compatible = "st,lis2dh12-accel",
65 .data = LIS2DH12_ACCEL_DEV_NAME,
66 },
67 {
68 .compatible = "st,lis3l02dq",
69 .data = LIS3L02DQ_ACCEL_DEV_NAME,
70 },
71 {
72 .compatible = "st,lng2dm-accel",
73 .data = LNG2DM_ACCEL_DEV_NAME,
74 },
75 {
76 .compatible = "st,h3lis331dl-accel",
77 .data = H3LIS331DL_ACCEL_DEV_NAME,
78 },
79 {
80 .compatible = "st,lis331dl-accel",
81 .data = LIS331DL_ACCEL_DEV_NAME,
82 },
83 {
84 .compatible = "st,lis2dw12",
85 .data = LIS2DW12_ACCEL_DEV_NAME,
86 },
87 {
88 .compatible = "st,lis3dhh",
89 .data = LIS3DHH_ACCEL_DEV_NAME,
90 },
91 {
92 .compatible = "st,lis3de",
93 .data = LIS3DE_ACCEL_DEV_NAME,
94 },
95 {}
96 };
97 MODULE_DEVICE_TABLE(of, st_accel_of_match);
98
st_accel_spi_probe(struct spi_device * spi)99 static int st_accel_spi_probe(struct spi_device *spi)
100 {
101 const struct st_sensor_settings *settings;
102 struct st_sensor_data *adata;
103 struct iio_dev *indio_dev;
104 int err;
105
106 st_sensors_dev_name_probe(&spi->dev, spi->modalias, sizeof(spi->modalias));
107
108 settings = st_accel_get_settings(spi->modalias);
109 if (!settings) {
110 dev_err(&spi->dev, "device name %s not recognized.\n",
111 spi->modalias);
112 return -ENODEV;
113 }
114
115 indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*adata));
116 if (!indio_dev)
117 return -ENOMEM;
118
119 adata = iio_priv(indio_dev);
120 adata->sensor_settings = (struct st_sensor_settings *)settings;
121
122 err = st_sensors_spi_configure(indio_dev, spi);
123 if (err < 0)
124 return err;
125
126 err = st_sensors_power_enable(indio_dev);
127 if (err)
128 return err;
129
130 err = st_accel_common_probe(indio_dev);
131 if (err < 0)
132 goto st_accel_power_off;
133
134 return 0;
135
136 st_accel_power_off:
137 st_sensors_power_disable(indio_dev);
138
139 return err;
140 }
141
st_accel_spi_remove(struct spi_device * spi)142 static int st_accel_spi_remove(struct spi_device *spi)
143 {
144 struct iio_dev *indio_dev = spi_get_drvdata(spi);
145
146 st_accel_common_remove(indio_dev);
147
148 st_sensors_power_disable(indio_dev);
149
150 return 0;
151 }
152
153 static const struct spi_device_id st_accel_id_table[] = {
154 { LIS3DH_ACCEL_DEV_NAME },
155 { LSM330D_ACCEL_DEV_NAME },
156 { LSM330DL_ACCEL_DEV_NAME },
157 { LSM330DLC_ACCEL_DEV_NAME },
158 { LIS331DLH_ACCEL_DEV_NAME },
159 { LSM330_ACCEL_DEV_NAME },
160 { LSM303AGR_ACCEL_DEV_NAME },
161 { LIS2DH12_ACCEL_DEV_NAME },
162 { LIS3L02DQ_ACCEL_DEV_NAME },
163 { LNG2DM_ACCEL_DEV_NAME },
164 { H3LIS331DL_ACCEL_DEV_NAME },
165 { LIS331DL_ACCEL_DEV_NAME },
166 { LIS3LV02DL_ACCEL_DEV_NAME },
167 { LIS2DW12_ACCEL_DEV_NAME },
168 { LIS3DHH_ACCEL_DEV_NAME },
169 { LIS3DE_ACCEL_DEV_NAME },
170 {},
171 };
172 MODULE_DEVICE_TABLE(spi, st_accel_id_table);
173
174 static struct spi_driver st_accel_driver = {
175 .driver = {
176 .name = "st-accel-spi",
177 .of_match_table = st_accel_of_match,
178 },
179 .probe = st_accel_spi_probe,
180 .remove = st_accel_spi_remove,
181 .id_table = st_accel_id_table,
182 };
183 module_spi_driver(st_accel_driver);
184
185 MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
186 MODULE_DESCRIPTION("STMicroelectronics accelerometers spi driver");
187 MODULE_LICENSE("GPL v2");
188