?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
x86/xen: resume timer irqs early
[linux/fpc-iii.git] / drivers / iio / magnetometer / st_magn_core.c
blobcab3bc7494a2260214a85874310ac80deca87c0a
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>
24 #include <linux/iio/buffer.h>
25
26 #include <linux/iio/common/st_sensors.h>
27 #include "st_magn.h"
28
29 #define ST_MAGN_NUMBER_DATA_CHANNELS 3
30
31 /* DEFAULT VALUE FOR SENSORS */
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
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
45 #define ST_MAGN_FS_AVL_10000MG 10000
46
47 /* CUSTOM VALUES FOR SENSOR 1 */
48 #define ST_MAGN_1_WAI_EXP 0x3c
49 #define ST_MAGN_1_ODR_ADDR 0x00
50 #define ST_MAGN_1_ODR_MASK 0x1c
51 #define ST_MAGN_1_ODR_AVL_1HZ_VAL 0x00
52 #define ST_MAGN_1_ODR_AVL_2HZ_VAL 0x01
53 #define ST_MAGN_1_ODR_AVL_3HZ_VAL 0x02
54 #define ST_MAGN_1_ODR_AVL_8HZ_VAL 0x03
55 #define ST_MAGN_1_ODR_AVL_15HZ_VAL 0x04
56 #define ST_MAGN_1_ODR_AVL_30HZ_VAL 0x05
57 #define ST_MAGN_1_ODR_AVL_75HZ_VAL 0x06
58 #define ST_MAGN_1_ODR_AVL_220HZ_VAL 0x07
59 #define ST_MAGN_1_PW_ADDR 0x02
60 #define ST_MAGN_1_PW_MASK 0x03
61 #define ST_MAGN_1_PW_ON 0x00
62 #define ST_MAGN_1_PW_OFF 0x03
63 #define ST_MAGN_1_FS_ADDR 0x01
64 #define ST_MAGN_1_FS_MASK 0xe0
65 #define ST_MAGN_1_FS_AVL_1300_VAL 0x01
66 #define ST_MAGN_1_FS_AVL_1900_VAL 0x02
67 #define ST_MAGN_1_FS_AVL_2500_VAL 0x03
68 #define ST_MAGN_1_FS_AVL_4000_VAL 0x04
69 #define ST_MAGN_1_FS_AVL_4700_VAL 0x05
70 #define ST_MAGN_1_FS_AVL_5600_VAL 0x06
71 #define ST_MAGN_1_FS_AVL_8100_VAL 0x07
72 #define ST_MAGN_1_FS_AVL_1300_GAIN_XY 1100
73 #define ST_MAGN_1_FS_AVL_1900_GAIN_XY 855
74 #define ST_MAGN_1_FS_AVL_2500_GAIN_XY 670
75 #define ST_MAGN_1_FS_AVL_4000_GAIN_XY 450
76 #define ST_MAGN_1_FS_AVL_4700_GAIN_XY 400
77 #define ST_MAGN_1_FS_AVL_5600_GAIN_XY 330
78 #define ST_MAGN_1_FS_AVL_8100_GAIN_XY 230
79 #define ST_MAGN_1_FS_AVL_1300_GAIN_Z 980
80 #define ST_MAGN_1_FS_AVL_1900_GAIN_Z 760
81 #define ST_MAGN_1_FS_AVL_2500_GAIN_Z 600
82 #define ST_MAGN_1_FS_AVL_4000_GAIN_Z 400
83 #define ST_MAGN_1_FS_AVL_4700_GAIN_Z 355
84 #define ST_MAGN_1_FS_AVL_5600_GAIN_Z 295
85 #define ST_MAGN_1_FS_AVL_8100_GAIN_Z 205
86 #define ST_MAGN_1_MULTIREAD_BIT false
87
88 /* CUSTOM VALUES FOR SENSOR 2 */
89 #define ST_MAGN_2_WAI_EXP 0x3d
90 #define ST_MAGN_2_ODR_ADDR 0x20
91 #define ST_MAGN_2_ODR_MASK 0x1c
92 #define ST_MAGN_2_ODR_AVL_1HZ_VAL 0x00
93 #define ST_MAGN_2_ODR_AVL_2HZ_VAL 0x01
94 #define ST_MAGN_2_ODR_AVL_3HZ_VAL 0x02
95 #define ST_MAGN_2_ODR_AVL_5HZ_VAL 0x03
96 #define ST_MAGN_2_ODR_AVL_10HZ_VAL 0x04
97 #define ST_MAGN_2_ODR_AVL_20HZ_VAL 0x05
98 #define ST_MAGN_2_ODR_AVL_40HZ_VAL 0x06
99 #define ST_MAGN_2_ODR_AVL_80HZ_VAL 0x07
100 #define ST_MAGN_2_PW_ADDR 0x22
101 #define ST_MAGN_2_PW_MASK 0x03
102 #define ST_MAGN_2_PW_ON 0x00
103 #define ST_MAGN_2_PW_OFF 0x03
104 #define ST_MAGN_2_FS_ADDR 0x21
105 #define ST_MAGN_2_FS_MASK 0x60
106 #define ST_MAGN_2_FS_AVL_4000_VAL 0x00
107 #define ST_MAGN_2_FS_AVL_8000_VAL 0x01
108 #define ST_MAGN_2_FS_AVL_10000_VAL 0x02
109 #define ST_MAGN_2_FS_AVL_4000_GAIN 430
110 #define ST_MAGN_2_FS_AVL_8000_GAIN 230
111 #define ST_MAGN_2_FS_AVL_10000_GAIN 230
112 #define ST_MAGN_2_MULTIREAD_BIT false
113 #define ST_MAGN_2_OUT_X_L_ADDR 0x28
114 #define ST_MAGN_2_OUT_Y_L_ADDR 0x2a
115 #define ST_MAGN_2_OUT_Z_L_ADDR 0x2c
116
117 static const struct iio_chan_spec st_magn_16bit_channels[] = {
118 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
119 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
120 ST_SENSORS_SCAN_X, 1, IIO_MOD_X, 's', IIO_BE, 16, 16,
121 ST_MAGN_DEFAULT_OUT_X_H_ADDR),
122 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
123 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
124 ST_SENSORS_SCAN_Y, 1, IIO_MOD_Y, 's', IIO_BE, 16, 16,
125 ST_MAGN_DEFAULT_OUT_Y_H_ADDR),
126 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
127 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
128 ST_SENSORS_SCAN_Z, 1, IIO_MOD_Z, 's', IIO_BE, 16, 16,
129 ST_MAGN_DEFAULT_OUT_Z_H_ADDR),
130 IIO_CHAN_SOFT_TIMESTAMP(3)
131 };
132
133 static const struct iio_chan_spec st_magn_2_16bit_channels[] = {
134 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
135 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
136 ST_SENSORS_SCAN_X, 1, IIO_MOD_X, 's', IIO_LE, 16, 16,
137 ST_MAGN_2_OUT_X_L_ADDR),
138 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
139 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
140 ST_SENSORS_SCAN_Y, 1, IIO_MOD_Y, 's', IIO_LE, 16, 16,
141 ST_MAGN_2_OUT_Y_L_ADDR),
142 ST_SENSORS_LSM_CHANNELS(IIO_MAGN,
143 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
144 ST_SENSORS_SCAN_Z, 1, IIO_MOD_Z, 's', IIO_LE, 16, 16,
145 ST_MAGN_2_OUT_Z_L_ADDR),
146 IIO_CHAN_SOFT_TIMESTAMP(3)
147 };
148
149 static const struct st_sensors st_magn_sensors[] = {
150 {
151 .wai = ST_MAGN_1_WAI_EXP,
152 .sensors_supported = {
153 [0] = LSM303DLHC_MAGN_DEV_NAME,
154 [1] = LSM303DLM_MAGN_DEV_NAME,
155 },
156 .ch = (struct iio_chan_spec *)st_magn_16bit_channels,
157 .odr = {
158 .addr = ST_MAGN_1_ODR_ADDR,
159 .mask = ST_MAGN_1_ODR_MASK,
160 .odr_avl = {
161 { 1, ST_MAGN_1_ODR_AVL_1HZ_VAL, },
162 { 2, ST_MAGN_1_ODR_AVL_2HZ_VAL, },
163 { 3, ST_MAGN_1_ODR_AVL_3HZ_VAL, },
164 { 8, ST_MAGN_1_ODR_AVL_8HZ_VAL, },
165 { 15, ST_MAGN_1_ODR_AVL_15HZ_VAL, },
166 { 30, ST_MAGN_1_ODR_AVL_30HZ_VAL, },
167 { 75, ST_MAGN_1_ODR_AVL_75HZ_VAL, },
168 { 220, ST_MAGN_1_ODR_AVL_220HZ_VAL, },
169 },
170 },
171 .pw = {
172 .addr = ST_MAGN_1_PW_ADDR,
173 .mask = ST_MAGN_1_PW_MASK,
174 .value_on = ST_MAGN_1_PW_ON,
175 .value_off = ST_MAGN_1_PW_OFF,
176 },
177 .fs = {
178 .addr = ST_MAGN_1_FS_ADDR,
179 .mask = ST_MAGN_1_FS_MASK,
180 .fs_avl = {
181 [0] = {
182 .num = ST_MAGN_FS_AVL_1300MG,
183 .value = ST_MAGN_1_FS_AVL_1300_VAL,
184 .gain = ST_MAGN_1_FS_AVL_1300_GAIN_XY,
185 .gain2 = ST_MAGN_1_FS_AVL_1300_GAIN_Z,
186 },
187 [1] = {
188 .num = ST_MAGN_FS_AVL_1900MG,
189 .value = ST_MAGN_1_FS_AVL_1900_VAL,
190 .gain = ST_MAGN_1_FS_AVL_1900_GAIN_XY,
191 .gain2 = ST_MAGN_1_FS_AVL_1900_GAIN_Z,
192 },
193 [2] = {
194 .num = ST_MAGN_FS_AVL_2500MG,
195 .value = ST_MAGN_1_FS_AVL_2500_VAL,
196 .gain = ST_MAGN_1_FS_AVL_2500_GAIN_XY,
197 .gain2 = ST_MAGN_1_FS_AVL_2500_GAIN_Z,
198 },
199 [3] = {
200 .num = ST_MAGN_FS_AVL_4000MG,
201 .value = ST_MAGN_1_FS_AVL_4000_VAL,
202 .gain = ST_MAGN_1_FS_AVL_4000_GAIN_XY,
203 .gain2 = ST_MAGN_1_FS_AVL_4000_GAIN_Z,
204 },
205 [4] = {
206 .num = ST_MAGN_FS_AVL_4700MG,
207 .value = ST_MAGN_1_FS_AVL_4700_VAL,
208 .gain = ST_MAGN_1_FS_AVL_4700_GAIN_XY,
209 .gain2 = ST_MAGN_1_FS_AVL_4700_GAIN_Z,
210 },
211 [5] = {
212 .num = ST_MAGN_FS_AVL_5600MG,
213 .value = ST_MAGN_1_FS_AVL_5600_VAL,
214 .gain = ST_MAGN_1_FS_AVL_5600_GAIN_XY,
215 .gain2 = ST_MAGN_1_FS_AVL_5600_GAIN_Z,
216 },
217 [6] = {
218 .num = ST_MAGN_FS_AVL_8100MG,
219 .value = ST_MAGN_1_FS_AVL_8100_VAL,
220 .gain = ST_MAGN_1_FS_AVL_8100_GAIN_XY,
221 .gain2 = ST_MAGN_1_FS_AVL_8100_GAIN_Z,
222 },
223 },
224 },
225 .multi_read_bit = ST_MAGN_1_MULTIREAD_BIT,
226 .bootime = 2,
227 },
228 {
229 .wai = ST_MAGN_2_WAI_EXP,
230 .sensors_supported = {
231 [0] = LIS3MDL_MAGN_DEV_NAME,
232 },
233 .ch = (struct iio_chan_spec *)st_magn_2_16bit_channels,
234 .odr = {
235 .addr = ST_MAGN_2_ODR_ADDR,
236 .mask = ST_MAGN_2_ODR_MASK,
237 .odr_avl = {
238 { 1, ST_MAGN_2_ODR_AVL_1HZ_VAL, },
239 { 2, ST_MAGN_2_ODR_AVL_2HZ_VAL, },
240 { 3, ST_MAGN_2_ODR_AVL_3HZ_VAL, },
241 { 5, ST_MAGN_2_ODR_AVL_5HZ_VAL, },
242 { 10, ST_MAGN_2_ODR_AVL_10HZ_VAL, },
243 { 20, ST_MAGN_2_ODR_AVL_20HZ_VAL, },
244 { 40, ST_MAGN_2_ODR_AVL_40HZ_VAL, },
245 { 80, ST_MAGN_2_ODR_AVL_80HZ_VAL, },
246 },
247 },
248 .pw = {
249 .addr = ST_MAGN_2_PW_ADDR,
250 .mask = ST_MAGN_2_PW_MASK,
251 .value_on = ST_MAGN_2_PW_ON,
252 .value_off = ST_MAGN_2_PW_OFF,
253 },
254 .fs = {
255 .addr = ST_MAGN_2_FS_ADDR,
256 .mask = ST_MAGN_2_FS_MASK,
257 .fs_avl = {
258 [0] = {
259 .num = ST_MAGN_FS_AVL_4000MG,
260 .value = ST_MAGN_2_FS_AVL_4000_VAL,
261 .gain = ST_MAGN_2_FS_AVL_4000_GAIN,
262 },
263 [1] = {
264 .num = ST_MAGN_FS_AVL_8000MG,
265 .value = ST_MAGN_2_FS_AVL_8000_VAL,
266 .gain = ST_MAGN_2_FS_AVL_8000_GAIN,
267 },
268 [2] = {
269 .num = ST_MAGN_FS_AVL_10000MG,
270 .value = ST_MAGN_2_FS_AVL_10000_VAL,
271 .gain = ST_MAGN_2_FS_AVL_10000_GAIN,
272 },
273 },
274 },
275 .multi_read_bit = ST_MAGN_2_MULTIREAD_BIT,
276 .bootime = 2,
277 },
278 };
279
280 static int st_magn_read_raw(struct iio_dev *indio_dev,
281 struct iio_chan_spec const *ch, int *val,
282 int *val2, long mask)
283 {
284 int err;
285 struct st_sensor_data *mdata = iio_priv(indio_dev);
286
287 switch (mask) {
288 case IIO_CHAN_INFO_RAW:
289 err = st_sensors_read_info_raw(indio_dev, ch, val);
290 if (err < 0)
291 goto read_error;
292
293 return IIO_VAL_INT;
294 case IIO_CHAN_INFO_SCALE:
295 *val = 0;
296 if ((ch->scan_index == ST_SENSORS_SCAN_Z) &&
297 (mdata->current_fullscale->gain2 != 0))
298 *val2 = mdata->current_fullscale->gain2;
299 else
300 *val2 = mdata->current_fullscale->gain;
301 return IIO_VAL_INT_PLUS_MICRO;
302 default:
303 return -EINVAL;
304 }
305
306 read_error:
307 return err;
308 }
309
310 static int st_magn_write_raw(struct iio_dev *indio_dev,
311 struct iio_chan_spec const *chan, int val, int val2, long mask)
312 {
313 int err;
314
315 switch (mask) {
316 case IIO_CHAN_INFO_SCALE:
317 err = st_sensors_set_fullscale_by_gain(indio_dev, val2);
318 break;
319 default:
320 err = -EINVAL;
321 }
322
323 return err;
324 }
325
326 static ST_SENSOR_DEV_ATTR_SAMP_FREQ();
327 static ST_SENSORS_DEV_ATTR_SAMP_FREQ_AVAIL();
328 static ST_SENSORS_DEV_ATTR_SCALE_AVAIL(in_magn_scale_available);
329
330 static struct attribute *st_magn_attributes[] = {
331 &iio_dev_attr_sampling_frequency_available.dev_attr.attr,
332 &iio_dev_attr_in_magn_scale_available.dev_attr.attr,
333 &iio_dev_attr_sampling_frequency.dev_attr.attr,
334 NULL,
335 };
336
337 static const struct attribute_group st_magn_attribute_group = {
338 .attrs = st_magn_attributes,
339 };
340
341 static const struct iio_info magn_info = {
342 .driver_module = THIS_MODULE,
343 .attrs = &st_magn_attribute_group,
344 .read_raw = &st_magn_read_raw,
345 .write_raw = &st_magn_write_raw,
346 };
347
348 int st_magn_common_probe(struct iio_dev *indio_dev,
349 struct st_sensors_platform_data *pdata)
350 {
351 int err;
352 struct st_sensor_data *mdata = iio_priv(indio_dev);
353
354 indio_dev->modes = INDIO_DIRECT_MODE;
355 indio_dev->info = &magn_info;
356
357 err = st_sensors_check_device_support(indio_dev,
358 ARRAY_SIZE(st_magn_sensors), st_magn_sensors);
359 if (err < 0)
360 goto st_magn_common_probe_error;
361
362 mdata->num_data_channels = ST_MAGN_NUMBER_DATA_CHANNELS;
363 mdata->multiread_bit = mdata->sensor->multi_read_bit;
364 indio_dev->channels = mdata->sensor->ch;
365 indio_dev->num_channels = ST_SENSORS_NUMBER_ALL_CHANNELS;
366
367 mdata->current_fullscale = (struct st_sensor_fullscale_avl *)
368 &mdata->sensor->fs.fs_avl[0];
369 mdata->odr = mdata->sensor->odr.odr_avl[0].hz;
370
371 err = st_sensors_init_sensor(indio_dev, pdata);
372 if (err < 0)
373 goto st_magn_common_probe_error;
374
375 if (mdata->get_irq_data_ready(indio_dev) > 0) {
376 err = st_magn_allocate_ring(indio_dev);
377 if (err < 0)
378 goto st_magn_common_probe_error;
379 err = st_sensors_allocate_trigger(indio_dev, NULL);
380 if (err < 0)
381 goto st_magn_probe_trigger_error;
382 }
383
384 err = iio_device_register(indio_dev);
385 if (err)
386 goto st_magn_device_register_error;
387
388 return err;
389
390 st_magn_device_register_error:
391 if (mdata->get_irq_data_ready(indio_dev) > 0)
392 st_sensors_deallocate_trigger(indio_dev);
393 st_magn_probe_trigger_error:
394 if (mdata->get_irq_data_ready(indio_dev) > 0)
395 st_magn_deallocate_ring(indio_dev);
396 st_magn_common_probe_error:
397 return err;
398 }
399 EXPORT_SYMBOL(st_magn_common_probe);
400
401 void st_magn_common_remove(struct iio_dev *indio_dev)
402 {
403 struct st_sensor_data *mdata = iio_priv(indio_dev);
404
405 iio_device_unregister(indio_dev);
406 if (mdata->get_irq_data_ready(indio_dev) > 0) {
407 st_sensors_deallocate_trigger(indio_dev);
408 st_magn_deallocate_ring(indio_dev);
409 }
410 }
411 EXPORT_SYMBOL(st_magn_common_remove);
412
413 MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
414 MODULE_DESCRIPTION("STMicroelectronics magnetometers driver");
415 MODULE_LICENSE("GPL v2");
Linux with added FPC-III support