projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge tag 'iio-fixes-for-4.7a' of git://git.kernel.org/pub/scm/linux/kernel/git/jic23...
[deliverable/linux.git] / drivers / iio / magnetometer / st_magn_core.c
CommitLineData
872e79ad
DC		 1/*
2 * STMicroelectronics magnetometers 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/errno.h>
15#include <linux/types.h>
16#include <linux/mutex.h>
17#include <linux/interrupt.h>
18#include <linux/i2c.h>
19#include <linux/gpio.h>
20#include <linux/irq.h>
21#include <linux/delay.h>
22#include <linux/iio/iio.h>
23#include <linux/iio/sysfs.h>
872e79ad
DC		 24#include <linux/iio/buffer.h>
25
26#include <linux/iio/common/st_sensors.h>
27#include "st_magn.h"
28
607a568a
DC		 29#define ST_MAGN_NUMBER_DATA_CHANNELS 3
30
872e79ad 31/* DEFAULT VALUE FOR SENSORS */
512690da
DC		 32#define ST_MAGN_DEFAULT_OUT_X_H_ADDR 0X03
33#define ST_MAGN_DEFAULT_OUT_Y_H_ADDR 0X07
34#define ST_MAGN_DEFAULT_OUT_Z_H_ADDR 0X05
872e79ad
DC		 35
36/* FULLSCALE */
37#define ST_MAGN_FS_AVL_1300MG 1300
38#define ST_MAGN_FS_AVL_1900MG 1900
39#define ST_MAGN_FS_AVL_2500MG 2500
40#define ST_MAGN_FS_AVL_4000MG 4000
41#define ST_MAGN_FS_AVL_4700MG 4700
42#define ST_MAGN_FS_AVL_5600MG 5600
43#define ST_MAGN_FS_AVL_8000MG 8000
44#define ST_MAGN_FS_AVL_8100MG 8100
a31d0928 45#define ST_MAGN_FS_AVL_12000MG 12000
1e9676a8 46#define ST_MAGN_FS_AVL_15000MG 15000
a31d0928 47#define ST_MAGN_FS_AVL_16000MG 16000
872e79ad 48
1038a687
LW		 49/* CUSTOM VALUES FOR SENSOR 0 */
50#define ST_MAGN_0_ODR_ADDR 0x00
51#define ST_MAGN_0_ODR_MASK 0x1c
52#define ST_MAGN_0_ODR_AVL_1HZ_VAL 0x00
53#define ST_MAGN_0_ODR_AVL_2HZ_VAL 0x01
54#define ST_MAGN_0_ODR_AVL_3HZ_VAL 0x02
55#define ST_MAGN_0_ODR_AVL_8HZ_VAL 0x03
56#define ST_MAGN_0_ODR_AVL_15HZ_VAL 0x04
57#define ST_MAGN_0_ODR_AVL_30HZ_VAL 0x05
58#define ST_MAGN_0_ODR_AVL_75HZ_VAL 0x06
59#define ST_MAGN_0_ODR_AVL_220HZ_VAL 0x07
60#define ST_MAGN_0_PW_ADDR 0x02
61#define ST_MAGN_0_PW_MASK 0x03
62#define ST_MAGN_0_PW_ON 0x00
63#define ST_MAGN_0_PW_OFF 0x03
64#define ST_MAGN_0_FS_ADDR 0x01
65#define ST_MAGN_0_FS_MASK 0xe0
66#define ST_MAGN_0_FS_AVL_1300_VAL 0x01
67#define ST_MAGN_0_FS_AVL_1900_VAL 0x02
68#define ST_MAGN_0_FS_AVL_2500_VAL 0x03
69#define ST_MAGN_0_FS_AVL_4000_VAL 0x04
70#define ST_MAGN_0_FS_AVL_4700_VAL 0x05
71#define ST_MAGN_0_FS_AVL_5600_VAL 0x06
72#define ST_MAGN_0_FS_AVL_8100_VAL 0x07
73#define ST_MAGN_0_FS_AVL_1300_GAIN_XY 1100
74#define ST_MAGN_0_FS_AVL_1900_GAIN_XY 855
75#define ST_MAGN_0_FS_AVL_2500_GAIN_XY 670
76#define ST_MAGN_0_FS_AVL_4000_GAIN_XY 450
77#define ST_MAGN_0_FS_AVL_4700_GAIN_XY 400
78#define ST_MAGN_0_FS_AVL_5600_GAIN_XY 330
79#define ST_MAGN_0_FS_AVL_8100_GAIN_XY 230
80#define ST_MAGN_0_FS_AVL_1300_GAIN_Z 980
81#define ST_MAGN_0_FS_AVL_1900_GAIN_Z 760
82#define ST_MAGN_0_FS_AVL_2500_GAIN_Z 600
83#define ST_MAGN_0_FS_AVL_4000_GAIN_Z 400
84#define ST_MAGN_0_FS_AVL_4700_GAIN_Z 355
85#define ST_MAGN_0_FS_AVL_5600_GAIN_Z 295
86#define ST_MAGN_0_FS_AVL_8100_GAIN_Z 205
87#define ST_MAGN_0_MULTIREAD_BIT false
88
872e79ad
DC		 89/* CUSTOM VALUES FOR SENSOR 1 */
90#define ST_MAGN_1_WAI_EXP 0x3c
91#define ST_MAGN_1_ODR_ADDR 0x00
92#define ST_MAGN_1_ODR_MASK 0x1c
93#define ST_MAGN_1_ODR_AVL_1HZ_VAL 0x00
94#define ST_MAGN_1_ODR_AVL_2HZ_VAL 0x01
95#define ST_MAGN_1_ODR_AVL_3HZ_VAL 0x02
96#define ST_MAGN_1_ODR_AVL_8HZ_VAL 0x03
97#define ST_MAGN_1_ODR_AVL_15HZ_VAL 0x04
98#define ST_MAGN_1_ODR_AVL_30HZ_VAL 0x05
99#define ST_MAGN_1_ODR_AVL_75HZ_VAL 0x06
100#define ST_MAGN_1_ODR_AVL_220HZ_VAL 0x07
101#define ST_MAGN_1_PW_ADDR 0x02
102#define ST_MAGN_1_PW_MASK 0x03
103#define ST_MAGN_1_PW_ON 0x00
104#define ST_MAGN_1_PW_OFF 0x03
105#define ST_MAGN_1_FS_ADDR 0x01
106#define ST_MAGN_1_FS_MASK 0xe0
107#define ST_MAGN_1_FS_AVL_1300_VAL 0x01
108#define ST_MAGN_1_FS_AVL_1900_VAL 0x02
109#define ST_MAGN_1_FS_AVL_2500_VAL 0x03
110#define ST_MAGN_1_FS_AVL_4000_VAL 0x04
111#define ST_MAGN_1_FS_AVL_4700_VAL 0x05
112#define ST_MAGN_1_FS_AVL_5600_VAL 0x06
113#define ST_MAGN_1_FS_AVL_8100_VAL 0x07
a31d0928
DC		 114#define ST_MAGN_1_FS_AVL_1300_GAIN_XY 909
115#define ST_MAGN_1_FS_AVL_1900_GAIN_XY 1169
116#define ST_MAGN_1_FS_AVL_2500_GAIN_XY 1492
117#define ST_MAGN_1_FS_AVL_4000_GAIN_XY 2222
118#define ST_MAGN_1_FS_AVL_4700_GAIN_XY 2500
119#define ST_MAGN_1_FS_AVL_5600_GAIN_XY 3030
120#define ST_MAGN_1_FS_AVL_8100_GAIN_XY 4347
121#define ST_MAGN_1_FS_AVL_1300_GAIN_Z 1020
122#define ST_MAGN_1_FS_AVL_1900_GAIN_Z 1315
123#define ST_MAGN_1_FS_AVL_2500_GAIN_Z 1666
124#define ST_MAGN_1_FS_AVL_4000_GAIN_Z 2500
125#define ST_MAGN_1_FS_AVL_4700_GAIN_Z 2816
126#define ST_MAGN_1_FS_AVL_5600_GAIN_Z 3389
127#define ST_MAGN_1_FS_AVL_8100_GAIN_Z 4878
872e79ad
DC		 128#define ST_MAGN_1_MULTIREAD_BIT false
129
130/* CUSTOM VALUES FOR SENSOR 2 */
131#define ST_MAGN_2_WAI_EXP 0x3d
132#define ST_MAGN_2_ODR_ADDR 0x20
133#define ST_MAGN_2_ODR_MASK 0x1c
134#define ST_MAGN_2_ODR_AVL_1HZ_VAL 0x00
135#define ST_MAGN_2_ODR_AVL_2HZ_VAL 0x01
136#define ST_MAGN_2_ODR_AVL_3HZ_VAL 0x02
137#define ST_MAGN_2_ODR_AVL_5HZ_VAL 0x03
138#define ST_MAGN_2_ODR_AVL_10HZ_VAL 0x04
139#define ST_MAGN_2_ODR_AVL_20HZ_VAL 0x05
140#define ST_MAGN_2_ODR_AVL_40HZ_VAL 0x06
141#define ST_MAGN_2_ODR_AVL_80HZ_VAL 0x07
142#define ST_MAGN_2_PW_ADDR 0x22
143#define ST_MAGN_2_PW_MASK 0x03
144#define ST_MAGN_2_PW_ON 0x00
145#define ST_MAGN_2_PW_OFF 0x03
146#define ST_MAGN_2_FS_ADDR 0x21
147#define ST_MAGN_2_FS_MASK 0x60
148#define ST_MAGN_2_FS_AVL_4000_VAL 0x00
149#define ST_MAGN_2_FS_AVL_8000_VAL 0x01
a31d0928
DC		 150#define ST_MAGN_2_FS_AVL_12000_VAL 0x02
151#define ST_MAGN_2_FS_AVL_16000_VAL 0x03
152#define ST_MAGN_2_FS_AVL_4000_GAIN 146
153#define ST_MAGN_2_FS_AVL_8000_GAIN 292
154#define ST_MAGN_2_FS_AVL_12000_GAIN 438
155#define ST_MAGN_2_FS_AVL_16000_GAIN 584
872e79ad
DC		 156#define ST_MAGN_2_MULTIREAD_BIT false
157#define ST_MAGN_2_OUT_X_L_ADDR 0x28
158#define ST_MAGN_2_OUT_Y_L_ADDR 0x2a
159#define ST_MAGN_2_OUT_Z_L_ADDR 0x2c
160
1e9676a8
GB		 161/* CUSTOM VALUES FOR SENSOR 3 */
162#define ST_MAGN_3_WAI_ADDR 0x4f
163#define ST_MAGN_3_WAI_EXP 0x40
164#define ST_MAGN_3_ODR_ADDR 0x60
165#define ST_MAGN_3_ODR_MASK 0x0c
166#define ST_MAGN_3_ODR_AVL_10HZ_VAL 0x00
167#define ST_MAGN_3_ODR_AVL_20HZ_VAL 0x01
168#define ST_MAGN_3_ODR_AVL_50HZ_VAL 0x02
169#define ST_MAGN_3_ODR_AVL_100HZ_VAL 0x03
170#define ST_MAGN_3_PW_ADDR 0x60
171#define ST_MAGN_3_PW_MASK 0x03
172#define ST_MAGN_3_PW_ON 0x00
173#define ST_MAGN_3_PW_OFF 0x03
174#define ST_MAGN_3_BDU_ADDR 0x62
175#define ST_MAGN_3_BDU_MASK 0x10
176#define ST_MAGN_3_DRDY_IRQ_ADDR 0x62
177#define ST_MAGN_3_DRDY_INT_MASK 0x01
a9fd053b
LW		 178#define ST_MAGN_3_IHL_IRQ_ADDR 0x63
179#define ST_MAGN_3_IHL_IRQ_MASK 0x04
1e9676a8
GB		 180#define ST_MAGN_3_FS_AVL_15000_GAIN 1500
181#define ST_MAGN_3_MULTIREAD_BIT false
182#define ST_MAGN_3_OUT_X_L_ADDR 0x68
183#define ST_MAGN_3_OUT_Y_L_ADDR 0x6a
184#define ST_MAGN_3_OUT_Z_L_ADDR 0x6c
185
872e79ad 186static const struct iio_chan_spec st_magn_16bit_channels[] = {
762011d6
DC		 187 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
188 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
512690da
DC		 189 ST_SENSORS_SCAN_X, 1, IIO_MOD_X, 's', IIO_BE, 16, 16,
190 ST_MAGN_DEFAULT_OUT_X_H_ADDR),
762011d6
DC		 191 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
192 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
512690da
DC		 193 ST_SENSORS_SCAN_Y, 1, IIO_MOD_Y, 's', IIO_BE, 16, 16,
194 ST_MAGN_DEFAULT_OUT_Y_H_ADDR),
762011d6
DC		 195 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
196 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
512690da
DC		 197 ST_SENSORS_SCAN_Z, 1, IIO_MOD_Z, 's', IIO_BE, 16, 16,
198 ST_MAGN_DEFAULT_OUT_Z_H_ADDR),
872e79ad
DC		 199 IIO_CHAN_SOFT_TIMESTAMP(3)
200};
201
202static const struct iio_chan_spec st_magn_2_16bit_channels[] = {
762011d6
DC		 203 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
204 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
205 ST_SENSORS_SCAN_X, 1, IIO_MOD_X, 's', IIO_LE, 16, 16,
206 ST_MAGN_2_OUT_X_L_ADDR),
207 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
208 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
209 ST_SENSORS_SCAN_Y, 1, IIO_MOD_Y, 's', IIO_LE, 16, 16,
210 ST_MAGN_2_OUT_Y_L_ADDR),
211 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
212 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
213 ST_SENSORS_SCAN_Z, 1, IIO_MOD_Z, 's', IIO_LE, 16, 16,
214 ST_MAGN_2_OUT_Z_L_ADDR),
872e79ad
DC		 215 IIO_CHAN_SOFT_TIMESTAMP(3)
216};
217
1e9676a8
GB		 218static const struct iio_chan_spec st_magn_3_16bit_channels[] = {
219 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
220 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
221 ST_SENSORS_SCAN_X, 1, IIO_MOD_X, 's', IIO_LE, 16, 16,
222 ST_MAGN_3_OUT_X_L_ADDR),
223 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
224 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
225 ST_SENSORS_SCAN_Y, 1, IIO_MOD_Y, 's', IIO_LE, 16, 16,
226 ST_MAGN_3_OUT_Y_L_ADDR),
227 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
228 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
229 ST_SENSORS_SCAN_Z, 1, IIO_MOD_Z, 's', IIO_LE, 16, 16,
230 ST_MAGN_3_OUT_Z_L_ADDR),
231 IIO_CHAN_SOFT_TIMESTAMP(3)
232};
233
a7ee8839 234static const struct st_sensor_settings st_magn_sensors_settings[] = {
1038a687
LW		 235 {
236 .wai = 0, /* This sensor has no valid WhoAmI report 0 */
bc27381e 237 .wai_addr = ST_SENSORS_DEFAULT_WAI_ADDRESS,
1038a687
LW		 238 .sensors_supported = {
239 [0] = LSM303DLH_MAGN_DEV_NAME,
240 },
241 .ch = (struct iio_chan_spec *)st_magn_16bit_channels,
242 .odr = {
243 .addr = ST_MAGN_0_ODR_ADDR,
244 .mask = ST_MAGN_0_ODR_MASK,
245 .odr_avl = {
246 { 1, ST_MAGN_0_ODR_AVL_1HZ_VAL, },
247 { 2, ST_MAGN_0_ODR_AVL_2HZ_VAL, },
248 { 3, ST_MAGN_0_ODR_AVL_3HZ_VAL, },
249 { 8, ST_MAGN_0_ODR_AVL_8HZ_VAL, },
250 { 15, ST_MAGN_0_ODR_AVL_15HZ_VAL, },
251 { 30, ST_MAGN_0_ODR_AVL_30HZ_VAL, },
252 { 75, ST_MAGN_0_ODR_AVL_75HZ_VAL, },
253 },
254 },
255 .pw = {
256 .addr = ST_MAGN_0_PW_ADDR,
257 .mask = ST_MAGN_0_PW_MASK,
258 .value_on = ST_MAGN_0_PW_ON,
259 .value_off = ST_MAGN_0_PW_OFF,
260 },
261 .fs = {
262 .addr = ST_MAGN_0_FS_ADDR,
263 .mask = ST_MAGN_0_FS_MASK,
264 .fs_avl = {
265 [0] = {
266 .num = ST_MAGN_FS_AVL_1300MG,
267 .value = ST_MAGN_0_FS_AVL_1300_VAL,
268 .gain = ST_MAGN_0_FS_AVL_1300_GAIN_XY,
269 .gain2 = ST_MAGN_0_FS_AVL_1300_GAIN_Z,
270 },
271 [1] = {
272 .num = ST_MAGN_FS_AVL_1900MG,
273 .value = ST_MAGN_0_FS_AVL_1900_VAL,
274 .gain = ST_MAGN_0_FS_AVL_1900_GAIN_XY,
275 .gain2 = ST_MAGN_0_FS_AVL_1900_GAIN_Z,
276 },
277 [2] = {
278 .num = ST_MAGN_FS_AVL_2500MG,
279 .value = ST_MAGN_0_FS_AVL_2500_VAL,
280 .gain = ST_MAGN_0_FS_AVL_2500_GAIN_XY,
281 .gain2 = ST_MAGN_0_FS_AVL_2500_GAIN_Z,
282 },
283 [3] = {
284 .num = ST_MAGN_FS_AVL_4000MG,
285 .value = ST_MAGN_0_FS_AVL_4000_VAL,
286 .gain = ST_MAGN_0_FS_AVL_4000_GAIN_XY,
287 .gain2 = ST_MAGN_0_FS_AVL_4000_GAIN_Z,
288 },
289 [4] = {
290 .num = ST_MAGN_FS_AVL_4700MG,
291 .value = ST_MAGN_0_FS_AVL_4700_VAL,
292 .gain = ST_MAGN_0_FS_AVL_4700_GAIN_XY,
293 .gain2 = ST_MAGN_0_FS_AVL_4700_GAIN_Z,
294 },
295 [5] = {
296 .num = ST_MAGN_FS_AVL_5600MG,
297 .value = ST_MAGN_0_FS_AVL_5600_VAL,
298 .gain = ST_MAGN_0_FS_AVL_5600_GAIN_XY,
299 .gain2 = ST_MAGN_0_FS_AVL_5600_GAIN_Z,
300 },
301 [6] = {
302 .num = ST_MAGN_FS_AVL_8100MG,
303 .value = ST_MAGN_0_FS_AVL_8100_VAL,
304 .gain = ST_MAGN_0_FS_AVL_8100_GAIN_XY,
305 .gain2 = ST_MAGN_0_FS_AVL_8100_GAIN_Z,
306 },
307 },
308 },
309 .multi_read_bit = ST_MAGN_0_MULTIREAD_BIT,
310 .bootime = 2,
311 },
872e79ad
DC		 312 {
313 .wai = ST_MAGN_1_WAI_EXP,
bc27381e 314 .wai_addr = ST_SENSORS_DEFAULT_WAI_ADDRESS,
872e79ad
DC		 315 .sensors_supported = {
316 [0] = LSM303DLHC_MAGN_DEV_NAME,
317 [1] = LSM303DLM_MAGN_DEV_NAME,
318 },
319 .ch = (struct iio_chan_spec *)st_magn_16bit_channels,
320 .odr = {
321 .addr = ST_MAGN_1_ODR_ADDR,
322 .mask = ST_MAGN_1_ODR_MASK,
323 .odr_avl = {
324 { 1, ST_MAGN_1_ODR_AVL_1HZ_VAL, },
325 { 2, ST_MAGN_1_ODR_AVL_2HZ_VAL, },
326 { 3, ST_MAGN_1_ODR_AVL_3HZ_VAL, },
327 { 8, ST_MAGN_1_ODR_AVL_8HZ_VAL, },
328 { 15, ST_MAGN_1_ODR_AVL_15HZ_VAL, },
329 { 30, ST_MAGN_1_ODR_AVL_30HZ_VAL, },
330 { 75, ST_MAGN_1_ODR_AVL_75HZ_VAL, },
331 { 220, ST_MAGN_1_ODR_AVL_220HZ_VAL, },
332 },
333 },
334 .pw = {
335 .addr = ST_MAGN_1_PW_ADDR,
336 .mask = ST_MAGN_1_PW_MASK,
337 .value_on = ST_MAGN_1_PW_ON,
338 .value_off = ST_MAGN_1_PW_OFF,
339 },
340 .fs = {
341 .addr = ST_MAGN_1_FS_ADDR,
342 .mask = ST_MAGN_1_FS_MASK,
343 .fs_avl = {
344 [0] = {
345 .num = ST_MAGN_FS_AVL_1300MG,
346 .value = ST_MAGN_1_FS_AVL_1300_VAL,
347 .gain = ST_MAGN_1_FS_AVL_1300_GAIN_XY,
348 .gain2 = ST_MAGN_1_FS_AVL_1300_GAIN_Z,
349 },
350 [1] = {
351 .num = ST_MAGN_FS_AVL_1900MG,
352 .value = ST_MAGN_1_FS_AVL_1900_VAL,
353 .gain = ST_MAGN_1_FS_AVL_1900_GAIN_XY,
354 .gain2 = ST_MAGN_1_FS_AVL_1900_GAIN_Z,
355 },
356 [2] = {
357 .num = ST_MAGN_FS_AVL_2500MG,
358 .value = ST_MAGN_1_FS_AVL_2500_VAL,
359 .gain = ST_MAGN_1_FS_AVL_2500_GAIN_XY,
360 .gain2 = ST_MAGN_1_FS_AVL_2500_GAIN_Z,
361 },
362 [3] = {
363 .num = ST_MAGN_FS_AVL_4000MG,
364 .value = ST_MAGN_1_FS_AVL_4000_VAL,
365 .gain = ST_MAGN_1_FS_AVL_4000_GAIN_XY,
366 .gain2 = ST_MAGN_1_FS_AVL_4000_GAIN_Z,
367 },
368 [4] = {
369 .num = ST_MAGN_FS_AVL_4700MG,
370 .value = ST_MAGN_1_FS_AVL_4700_VAL,
371 .gain = ST_MAGN_1_FS_AVL_4700_GAIN_XY,
372 .gain2 = ST_MAGN_1_FS_AVL_4700_GAIN_Z,
373 },
374 [5] = {
375 .num = ST_MAGN_FS_AVL_5600MG,
376 .value = ST_MAGN_1_FS_AVL_5600_VAL,
377 .gain = ST_MAGN_1_FS_AVL_5600_GAIN_XY,
378 .gain2 = ST_MAGN_1_FS_AVL_5600_GAIN_Z,
379 },
380 [6] = {
381 .num = ST_MAGN_FS_AVL_8100MG,
382 .value = ST_MAGN_1_FS_AVL_8100_VAL,
383 .gain = ST_MAGN_1_FS_AVL_8100_GAIN_XY,
384 .gain2 = ST_MAGN_1_FS_AVL_8100_GAIN_Z,
385 },
386 },
387 },
388 .multi_read_bit = ST_MAGN_1_MULTIREAD_BIT,
389 .bootime = 2,
390 },
391 {
392 .wai = ST_MAGN_2_WAI_EXP,
bc27381e 393 .wai_addr = ST_SENSORS_DEFAULT_WAI_ADDRESS,
872e79ad
DC		 394 .sensors_supported = {
395 [0] = LIS3MDL_MAGN_DEV_NAME,
396 },
397 .ch = (struct iio_chan_spec *)st_magn_2_16bit_channels,
398 .odr = {
399 .addr = ST_MAGN_2_ODR_ADDR,
400 .mask = ST_MAGN_2_ODR_MASK,
401 .odr_avl = {
402 { 1, ST_MAGN_2_ODR_AVL_1HZ_VAL, },
403 { 2, ST_MAGN_2_ODR_AVL_2HZ_VAL, },
404 { 3, ST_MAGN_2_ODR_AVL_3HZ_VAL, },
405 { 5, ST_MAGN_2_ODR_AVL_5HZ_VAL, },
406 { 10, ST_MAGN_2_ODR_AVL_10HZ_VAL, },
407 { 20, ST_MAGN_2_ODR_AVL_20HZ_VAL, },
408 { 40, ST_MAGN_2_ODR_AVL_40HZ_VAL, },
409 { 80, ST_MAGN_2_ODR_AVL_80HZ_VAL, },
410 },
411 },
412 .pw = {
413 .addr = ST_MAGN_2_PW_ADDR,
414 .mask = ST_MAGN_2_PW_MASK,
415 .value_on = ST_MAGN_2_PW_ON,
416 .value_off = ST_MAGN_2_PW_OFF,
417 },
418 .fs = {
419 .addr = ST_MAGN_2_FS_ADDR,
420 .mask = ST_MAGN_2_FS_MASK,
421 .fs_avl = {
422 [0] = {
423 .num = ST_MAGN_FS_AVL_4000MG,
424 .value = ST_MAGN_2_FS_AVL_4000_VAL,
425 .gain = ST_MAGN_2_FS_AVL_4000_GAIN,
426 },
427 [1] = {
428 .num = ST_MAGN_FS_AVL_8000MG,
429 .value = ST_MAGN_2_FS_AVL_8000_VAL,
430 .gain = ST_MAGN_2_FS_AVL_8000_GAIN,
431 },
432 [2] = {
a31d0928
DC		 433 .num = ST_MAGN_FS_AVL_12000MG,
434 .value = ST_MAGN_2_FS_AVL_12000_VAL,
435 .gain = ST_MAGN_2_FS_AVL_12000_GAIN,
436 },
437 [3] = {
438 .num = ST_MAGN_FS_AVL_16000MG,
439 .value = ST_MAGN_2_FS_AVL_16000_VAL,
440 .gain = ST_MAGN_2_FS_AVL_16000_GAIN,
872e79ad
DC		 441 },
442 },
443 },
444 .multi_read_bit = ST_MAGN_2_MULTIREAD_BIT,
445 .bootime = 2,
446 },
1e9676a8
GB		 447 {
448 .wai = ST_MAGN_3_WAI_EXP,
449 .wai_addr = ST_MAGN_3_WAI_ADDR,
450 .sensors_supported = {
451 [0] = LSM303AGR_MAGN_DEV_NAME,
452 },
453 .ch = (struct iio_chan_spec *)st_magn_3_16bit_channels,
454 .odr = {
455 .addr = ST_MAGN_3_ODR_ADDR,
456 .mask = ST_MAGN_3_ODR_MASK,
457 .odr_avl = {
458 { 10, ST_MAGN_3_ODR_AVL_10HZ_VAL, },
459 { 20, ST_MAGN_3_ODR_AVL_20HZ_VAL, },
460 { 50, ST_MAGN_3_ODR_AVL_50HZ_VAL, },
461 { 100, ST_MAGN_3_ODR_AVL_100HZ_VAL, },
462 },
463 },
464 .pw = {
465 .addr = ST_MAGN_3_PW_ADDR,
466 .mask = ST_MAGN_3_PW_MASK,
467 .value_on = ST_MAGN_3_PW_ON,
468 .value_off = ST_MAGN_3_PW_OFF,
469 },
470 .fs = {
471 .fs_avl = {
472 [0] = {
473 .num = ST_MAGN_FS_AVL_15000MG,
474 .gain = ST_MAGN_3_FS_AVL_15000_GAIN,
475 },
476 },
477 },
478 .bdu = {
479 .addr = ST_MAGN_3_BDU_ADDR,
480 .mask = ST_MAGN_3_BDU_MASK,
481 },
482 .drdy_irq = {
483 .addr = ST_MAGN_3_DRDY_IRQ_ADDR,
484 .mask_int1 = ST_MAGN_3_DRDY_INT_MASK,
a9fd053b
LW		 485 .addr_ihl = ST_MAGN_3_IHL_IRQ_ADDR,
486 .mask_ihl = ST_MAGN_3_IHL_IRQ_MASK,
97865fe4 487 .addr_stat_drdy = ST_SENSORS_DEFAULT_STAT_ADDR,
1e9676a8
GB		 488 },
489 .multi_read_bit = ST_MAGN_3_MULTIREAD_BIT,
490 .bootime = 2,
491 },
872e79ad
DC		 492};
493
494static int st_magn_read_raw(struct iio_dev *indio_dev,
495 struct iio_chan_spec const *ch, int *val,
496 int *val2, long mask)
497{
498 int err;
499 struct st_sensor_data *mdata = iio_priv(indio_dev);
500
501 switch (mask) {
502 case IIO_CHAN_INFO_RAW:
503 err = st_sensors_read_info_raw(indio_dev, ch, val);
504 if (err < 0)
505 goto read_error;
506
507 return IIO_VAL_INT;
508 case IIO_CHAN_INFO_SCALE:
509 *val = 0;
510 if ((ch->scan_index == ST_SENSORS_SCAN_Z) &&
511 (mdata->current_fullscale->gain2 != 0))
512 *val2 = mdata->current_fullscale->gain2;
513 else
514 *val2 = mdata->current_fullscale->gain;
515 return IIO_VAL_INT_PLUS_MICRO;
2d239c9e
JC		 516 case IIO_CHAN_INFO_SAMP_FREQ:
517 *val = mdata->odr;
518 return IIO_VAL_INT;
872e79ad
DC		 519 default:
520 return -EINVAL;
521 }
522
523read_error:
524 return err;
525}
526
527static int st_magn_write_raw(struct iio_dev *indio_dev,
528 struct iio_chan_spec const *chan, int val, int val2, long mask)
529{
530 int err;
531
532 switch (mask) {
533 case IIO_CHAN_INFO_SCALE:
534 err = st_sensors_set_fullscale_by_gain(indio_dev, val2);
535 break;
2d239c9e
JC		 536 case IIO_CHAN_INFO_SAMP_FREQ:
537 if (val2)
538 return -EINVAL;
539 mutex_lock(&indio_dev->mlock);
540 err = st_sensors_set_odr(indio_dev, val);
541 mutex_unlock(&indio_dev->mlock);
542 return err;
872e79ad
DC		 543 default:
544 err = -EINVAL;
545 }
546
547 return err;
548}
549
872e79ad
DC		 550static ST_SENSORS_DEV_ATTR_SAMP_FREQ_AVAIL();
551static ST_SENSORS_DEV_ATTR_SCALE_AVAIL(in_magn_scale_available);
552
553static struct attribute *st_magn_attributes[] = {
554 &iio_dev_attr_sampling_frequency_available.dev_attr.attr,
555 &iio_dev_attr_in_magn_scale_available.dev_attr.attr,
872e79ad
DC		 556 NULL,
557};
558
559static const struct attribute_group st_magn_attribute_group = {
560 .attrs = st_magn_attributes,
561};
562
563static const struct iio_info magn_info = {
564 .driver_module = THIS_MODULE,
565 .attrs = &st_magn_attribute_group,
566 .read_raw = &st_magn_read_raw,
567 .write_raw = &st_magn_write_raw,
a0175b9c 568 .debugfs_reg_access = &st_sensors_debugfs_reg_access,
872e79ad
DC		 569};
570
74f5683f
GB		 571#ifdef CONFIG_IIO_TRIGGER
572static const struct iio_trigger_ops st_magn_trigger_ops = {
573 .owner = THIS_MODULE,
574 .set_trigger_state = ST_MAGN_TRIGGER_SET_STATE,
65925b65 575 .validate_device = st_sensors_validate_device,
74f5683f
GB		 576};
577#define ST_MAGN_TRIGGER_OPS (&st_magn_trigger_ops)
578#else
579#define ST_MAGN_TRIGGER_OPS NULL
580#endif
581
2109eb4c 582int st_magn_common_probe(struct iio_dev *indio_dev)
872e79ad 583{
872e79ad 584 struct st_sensor_data *mdata = iio_priv(indio_dev);
267a29b9
LJ		 585 int irq = mdata->get_irq_data_ready(indio_dev);
586 int err;
872e79ad
DC		 587
588 indio_dev->modes = INDIO_DIRECT_MODE;
589 indio_dev->info = &magn_info;
8e71c04f 590 mutex_init(&mdata->tb.buf_lock);
872e79ad 591
ea7e586b
LW		 592 st_sensors_power_enable(indio_dev);
593
872e79ad 594 err = st_sensors_check_device_support(indio_dev,
a7ee8839
DC		 595 ARRAY_SIZE(st_magn_sensors_settings),
596 st_magn_sensors_settings);
872e79ad 597 if (err < 0)
267a29b9 598 return err;
872e79ad 599
607a568a 600 mdata->num_data_channels = ST_MAGN_NUMBER_DATA_CHANNELS;
a7ee8839
DC		 601 mdata->multiread_bit = mdata->sensor_settings->multi_read_bit;
602 indio_dev->channels = mdata->sensor_settings->ch;
872e79ad
DC		 603 indio_dev->num_channels = ST_SENSORS_NUMBER_ALL_CHANNELS;
604
605 mdata->current_fullscale = (struct st_sensor_fullscale_avl *)
a7ee8839
DC		 606 &mdata->sensor_settings->fs.fs_avl[0];
607 mdata->odr = mdata->sensor_settings->odr.odr_avl[0].hz;
872e79ad 608
2109eb4c 609 err = st_sensors_init_sensor(indio_dev, NULL);
872e79ad 610 if (err < 0)
267a29b9 611 return err;
872e79ad 612
f60b12b0
DC		 613 err = st_magn_allocate_ring(indio_dev);
614 if (err < 0)
615 return err;
616
267a29b9 617 if (irq > 0) {
74f5683f
GB		 618 err = st_sensors_allocate_trigger(indio_dev,
619 ST_MAGN_TRIGGER_OPS);
872e79ad
DC		 620 if (err < 0)
621 goto st_magn_probe_trigger_error;
622 }
623
624 err = iio_device_register(indio_dev);
625 if (err)
626 goto st_magn_device_register_error;
627
4f544ced
LW		 628 dev_info(&indio_dev->dev, "registered magnetometer %s\n",
629 indio_dev->name);
630
267a29b9 631 return 0;
872e79ad
DC		 632
633st_magn_device_register_error:
267a29b9 634 if (irq > 0)
872e79ad
DC		 635 st_sensors_deallocate_trigger(indio_dev);
636st_magn_probe_trigger_error:
f60b12b0 637 st_magn_deallocate_ring(indio_dev);
267a29b9 638
872e79ad
DC		 639 return err;
640}
641EXPORT_SYMBOL(st_magn_common_probe);
642
643void st_magn_common_remove(struct iio_dev *indio_dev)
644{
645 struct st_sensor_data *mdata = iio_priv(indio_dev);
646
ea7e586b
LW		 647 st_sensors_power_disable(indio_dev);
648
872e79ad 649 iio_device_unregister(indio_dev);
f60b12b0 650 if (mdata->get_irq_data_ready(indio_dev) > 0)
872e79ad 651 st_sensors_deallocate_trigger(indio_dev);
f60b12b0
DC		 652
653 st_magn_deallocate_ring(indio_dev);
872e79ad
DC		 654}
655EXPORT_SYMBOL(st_magn_common_remove);
656
657MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
658MODULE_DESCRIPTION("STMicroelectronics magnetometers driver");
659MODULE_LICENSE("GPL v2");
Linux kernel - Deliverables
This page took 0.533705 seconds and 5 git commands to generate.