2 * STMicroelectronics pressures driver
4 * Copyright 2013 STMicroelectronics Inc.
6 * Denis Ciocca <denis.ciocca@st.com>
8 * Licensed under the GPL-2.
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/trigger.h>
25 #include <linux/iio/buffer.h>
26 #include <asm/unaligned.h>
28 #include <linux/iio/common/st_sensors.h>
29 #include "st_pressure.h"
31 #define ST_PRESS_LSB_PER_MBAR 4096UL
32 #define ST_PRESS_KPASCAL_NANO_SCALE (100000000UL / \
33 ST_PRESS_LSB_PER_MBAR)
34 #define ST_PRESS_LSB_PER_CELSIUS 480UL
35 #define ST_PRESS_CELSIUS_NANO_SCALE (1000000000UL / \
36 ST_PRESS_LSB_PER_CELSIUS)
37 #define ST_PRESS_NUMBER_DATA_CHANNELS 1
40 #define ST_PRESS_FS_AVL_1260MB 1260
42 #define ST_PRESS_1_OUT_XL_ADDR 0x28
43 #define ST_TEMP_1_OUT_L_ADDR 0x2b
45 /* CUSTOM VALUES FOR LPS331AP SENSOR */
46 #define ST_PRESS_LPS331AP_WAI_EXP 0xbb
47 #define ST_PRESS_LPS331AP_ODR_ADDR 0x20
48 #define ST_PRESS_LPS331AP_ODR_MASK 0x70
49 #define ST_PRESS_LPS331AP_ODR_AVL_1HZ_VAL 0x01
50 #define ST_PRESS_LPS331AP_ODR_AVL_7HZ_VAL 0x05
51 #define ST_PRESS_LPS331AP_ODR_AVL_13HZ_VAL 0x06
52 #define ST_PRESS_LPS331AP_ODR_AVL_25HZ_VAL 0x07
53 #define ST_PRESS_LPS331AP_PW_ADDR 0x20
54 #define ST_PRESS_LPS331AP_PW_MASK 0x80
55 #define ST_PRESS_LPS331AP_FS_ADDR 0x23
56 #define ST_PRESS_LPS331AP_FS_MASK 0x30
57 #define ST_PRESS_LPS331AP_FS_AVL_1260_VAL 0x00
58 #define ST_PRESS_LPS331AP_FS_AVL_1260_GAIN ST_PRESS_KPASCAL_NANO_SCALE
59 #define ST_PRESS_LPS331AP_FS_AVL_TEMP_GAIN ST_PRESS_CELSIUS_NANO_SCALE
60 #define ST_PRESS_LPS331AP_BDU_ADDR 0x20
61 #define ST_PRESS_LPS331AP_BDU_MASK 0x04
62 #define ST_PRESS_LPS331AP_DRDY_IRQ_ADDR 0x22
63 #define ST_PRESS_LPS331AP_DRDY_IRQ_INT1_MASK 0x04
64 #define ST_PRESS_LPS331AP_DRDY_IRQ_INT2_MASK 0x20
65 #define ST_PRESS_LPS331AP_MULTIREAD_BIT true
66 #define ST_PRESS_LPS331AP_TEMP_OFFSET 42500
68 /* CUSTOM VALUES FOR LPS001WP SENSOR */
69 #define ST_PRESS_LPS001WP_WAI_EXP 0xba
70 #define ST_PRESS_LPS001WP_ODR_ADDR 0x20
71 #define ST_PRESS_LPS001WP_ODR_MASK 0x30
72 #define ST_PRESS_LPS001WP_ODR_AVL_1HZ_VAL 0x01
73 #define ST_PRESS_LPS001WP_ODR_AVL_7HZ_VAL 0x02
74 #define ST_PRESS_LPS001WP_ODR_AVL_13HZ_VAL 0x03
75 #define ST_PRESS_LPS001WP_PW_ADDR 0x20
76 #define ST_PRESS_LPS001WP_PW_MASK 0x40
77 #define ST_PRESS_LPS001WP_BDU_ADDR 0x20
78 #define ST_PRESS_LPS001WP_BDU_MASK 0x04
79 #define ST_PRESS_LPS001WP_MULTIREAD_BIT true
80 #define ST_PRESS_LPS001WP_OUT_L_ADDR 0x28
81 #define ST_TEMP_LPS001WP_OUT_L_ADDR 0x2a
83 /* CUSTOM VALUES FOR LPS25H SENSOR */
84 #define ST_PRESS_LPS25H_WAI_EXP 0xbd
85 #define ST_PRESS_LPS25H_ODR_ADDR 0x20
86 #define ST_PRESS_LPS25H_ODR_MASK 0x70
87 #define ST_PRESS_LPS25H_ODR_AVL_1HZ_VAL 0x01
88 #define ST_PRESS_LPS25H_ODR_AVL_7HZ_VAL 0x02
89 #define ST_PRESS_LPS25H_ODR_AVL_13HZ_VAL 0x03
90 #define ST_PRESS_LPS25H_ODR_AVL_25HZ_VAL 0x04
91 #define ST_PRESS_LPS25H_PW_ADDR 0x20
92 #define ST_PRESS_LPS25H_PW_MASK 0x80
93 #define ST_PRESS_LPS25H_FS_ADDR 0x00
94 #define ST_PRESS_LPS25H_FS_MASK 0x00
95 #define ST_PRESS_LPS25H_FS_AVL_1260_VAL 0x00
96 #define ST_PRESS_LPS25H_FS_AVL_1260_GAIN ST_PRESS_KPASCAL_NANO_SCALE
97 #define ST_PRESS_LPS25H_FS_AVL_TEMP_GAIN ST_PRESS_CELSIUS_NANO_SCALE
98 #define ST_PRESS_LPS25H_BDU_ADDR 0x20
99 #define ST_PRESS_LPS25H_BDU_MASK 0x04
100 #define ST_PRESS_LPS25H_DRDY_IRQ_ADDR 0x23
101 #define ST_PRESS_LPS25H_DRDY_IRQ_INT1_MASK 0x01
102 #define ST_PRESS_LPS25H_DRDY_IRQ_INT2_MASK 0x10
103 #define ST_PRESS_LPS25H_MULTIREAD_BIT true
104 #define ST_PRESS_LPS25H_TEMP_OFFSET 42500
105 #define ST_PRESS_LPS25H_OUT_XL_ADDR 0x28
106 #define ST_TEMP_LPS25H_OUT_L_ADDR 0x2b
108 static const struct iio_chan_spec st_press_1_channels
[] = {
110 .type
= IIO_PRESSURE
,
111 .channel2
= IIO_NO_MOD
,
112 .address
= ST_PRESS_1_OUT_XL_ADDR
,
113 .scan_index
= ST_SENSORS_SCAN_X
,
118 .endianness
= IIO_LE
,
120 .info_mask_separate
=
121 BIT(IIO_CHAN_INFO_RAW
) | BIT(IIO_CHAN_INFO_SCALE
),
126 .channel2
= IIO_NO_MOD
,
127 .address
= ST_TEMP_1_OUT_L_ADDR
,
133 .endianness
= IIO_LE
,
135 .info_mask_separate
=
136 BIT(IIO_CHAN_INFO_RAW
) |
137 BIT(IIO_CHAN_INFO_SCALE
) |
138 BIT(IIO_CHAN_INFO_OFFSET
),
141 IIO_CHAN_SOFT_TIMESTAMP(1)
144 static const struct iio_chan_spec st_press_lps001wp_channels
[] = {
146 .type
= IIO_PRESSURE
,
147 .channel2
= IIO_NO_MOD
,
148 .address
= ST_PRESS_LPS001WP_OUT_L_ADDR
,
149 .scan_index
= ST_SENSORS_SCAN_X
,
154 .endianness
= IIO_LE
,
156 .info_mask_separate
= BIT(IIO_CHAN_INFO_RAW
),
161 .channel2
= IIO_NO_MOD
,
162 .address
= ST_TEMP_LPS001WP_OUT_L_ADDR
,
168 .endianness
= IIO_LE
,
170 .info_mask_separate
=
171 BIT(IIO_CHAN_INFO_RAW
) |
172 BIT(IIO_CHAN_INFO_OFFSET
),
175 IIO_CHAN_SOFT_TIMESTAMP(1)
178 static const struct st_sensors st_press_sensors
[] = {
180 .wai
= ST_PRESS_LPS331AP_WAI_EXP
,
181 .sensors_supported
= {
182 [0] = LPS331AP_PRESS_DEV_NAME
,
184 .ch
= (struct iio_chan_spec
*)st_press_1_channels
,
185 .num_ch
= ARRAY_SIZE(st_press_1_channels
),
187 .addr
= ST_PRESS_LPS331AP_ODR_ADDR
,
188 .mask
= ST_PRESS_LPS331AP_ODR_MASK
,
190 { 1, ST_PRESS_LPS331AP_ODR_AVL_1HZ_VAL
, },
191 { 7, ST_PRESS_LPS331AP_ODR_AVL_7HZ_VAL
, },
192 { 13, ST_PRESS_LPS331AP_ODR_AVL_13HZ_VAL
, },
193 { 25, ST_PRESS_LPS331AP_ODR_AVL_25HZ_VAL
, },
197 .addr
= ST_PRESS_LPS331AP_PW_ADDR
,
198 .mask
= ST_PRESS_LPS331AP_PW_MASK
,
199 .value_on
= ST_SENSORS_DEFAULT_POWER_ON_VALUE
,
200 .value_off
= ST_SENSORS_DEFAULT_POWER_OFF_VALUE
,
203 .addr
= ST_PRESS_LPS331AP_FS_ADDR
,
204 .mask
= ST_PRESS_LPS331AP_FS_MASK
,
207 .num
= ST_PRESS_FS_AVL_1260MB
,
208 .value
= ST_PRESS_LPS331AP_FS_AVL_1260_VAL
,
209 .gain
= ST_PRESS_LPS331AP_FS_AVL_1260_GAIN
,
210 .gain2
= ST_PRESS_LPS331AP_FS_AVL_TEMP_GAIN
,
215 .addr
= ST_PRESS_LPS331AP_BDU_ADDR
,
216 .mask
= ST_PRESS_LPS331AP_BDU_MASK
,
219 .addr
= ST_PRESS_LPS331AP_DRDY_IRQ_ADDR
,
220 .mask_int1
= ST_PRESS_LPS331AP_DRDY_IRQ_INT1_MASK
,
221 .mask_int2
= ST_PRESS_LPS331AP_DRDY_IRQ_INT2_MASK
,
223 .multi_read_bit
= ST_PRESS_LPS331AP_MULTIREAD_BIT
,
227 .wai
= ST_PRESS_LPS001WP_WAI_EXP
,
228 .sensors_supported
= {
229 [0] = LPS001WP_PRESS_DEV_NAME
,
231 .ch
= (struct iio_chan_spec
*)st_press_lps001wp_channels
,
232 .num_ch
= ARRAY_SIZE(st_press_lps001wp_channels
),
234 .addr
= ST_PRESS_LPS001WP_ODR_ADDR
,
235 .mask
= ST_PRESS_LPS001WP_ODR_MASK
,
237 { 1, ST_PRESS_LPS001WP_ODR_AVL_1HZ_VAL
, },
238 { 7, ST_PRESS_LPS001WP_ODR_AVL_7HZ_VAL
, },
239 { 13, ST_PRESS_LPS001WP_ODR_AVL_13HZ_VAL
, },
243 .addr
= ST_PRESS_LPS001WP_PW_ADDR
,
244 .mask
= ST_PRESS_LPS001WP_PW_MASK
,
245 .value_on
= ST_SENSORS_DEFAULT_POWER_ON_VALUE
,
246 .value_off
= ST_SENSORS_DEFAULT_POWER_OFF_VALUE
,
252 .addr
= ST_PRESS_LPS001WP_BDU_ADDR
,
253 .mask
= ST_PRESS_LPS001WP_BDU_MASK
,
258 .multi_read_bit
= ST_PRESS_LPS001WP_MULTIREAD_BIT
,
262 .wai
= ST_PRESS_LPS25H_WAI_EXP
,
263 .sensors_supported
= {
264 [0] = LPS25H_PRESS_DEV_NAME
,
266 .ch
= (struct iio_chan_spec
*)st_press_1_channels
,
267 .num_ch
= ARRAY_SIZE(st_press_1_channels
),
269 .addr
= ST_PRESS_LPS25H_ODR_ADDR
,
270 .mask
= ST_PRESS_LPS25H_ODR_MASK
,
272 { 1, ST_PRESS_LPS25H_ODR_AVL_1HZ_VAL
, },
273 { 7, ST_PRESS_LPS25H_ODR_AVL_7HZ_VAL
, },
274 { 13, ST_PRESS_LPS25H_ODR_AVL_13HZ_VAL
, },
275 { 25, ST_PRESS_LPS25H_ODR_AVL_25HZ_VAL
, },
279 .addr
= ST_PRESS_LPS25H_PW_ADDR
,
280 .mask
= ST_PRESS_LPS25H_PW_MASK
,
281 .value_on
= ST_SENSORS_DEFAULT_POWER_ON_VALUE
,
282 .value_off
= ST_SENSORS_DEFAULT_POWER_OFF_VALUE
,
285 .addr
= ST_PRESS_LPS25H_FS_ADDR
,
286 .mask
= ST_PRESS_LPS25H_FS_MASK
,
289 .num
= ST_PRESS_FS_AVL_1260MB
,
290 .value
= ST_PRESS_LPS25H_FS_AVL_1260_VAL
,
291 .gain
= ST_PRESS_LPS25H_FS_AVL_1260_GAIN
,
292 .gain2
= ST_PRESS_LPS25H_FS_AVL_TEMP_GAIN
,
297 .addr
= ST_PRESS_LPS25H_BDU_ADDR
,
298 .mask
= ST_PRESS_LPS25H_BDU_MASK
,
301 .addr
= ST_PRESS_LPS25H_DRDY_IRQ_ADDR
,
302 .mask_int1
= ST_PRESS_LPS25H_DRDY_IRQ_INT1_MASK
,
303 .mask_int2
= ST_PRESS_LPS25H_DRDY_IRQ_INT2_MASK
,
305 .multi_read_bit
= ST_PRESS_LPS25H_MULTIREAD_BIT
,
310 static int st_press_read_raw(struct iio_dev
*indio_dev
,
311 struct iio_chan_spec
const *ch
, int *val
,
312 int *val2
, long mask
)
315 struct st_sensor_data
*pdata
= iio_priv(indio_dev
);
318 case IIO_CHAN_INFO_RAW
:
319 err
= st_sensors_read_info_raw(indio_dev
, ch
, val
);
324 case IIO_CHAN_INFO_SCALE
:
329 *val2
= pdata
->current_fullscale
->gain
;
332 *val2
= pdata
->current_fullscale
->gain2
;
339 return IIO_VAL_INT_PLUS_NANO
;
340 case IIO_CHAN_INFO_OFFSET
:
351 return IIO_VAL_FRACTIONAL
;
360 static ST_SENSOR_DEV_ATTR_SAMP_FREQ();
361 static ST_SENSORS_DEV_ATTR_SAMP_FREQ_AVAIL();
363 static struct attribute
*st_press_attributes
[] = {
364 &iio_dev_attr_sampling_frequency_available
.dev_attr
.attr
,
365 &iio_dev_attr_sampling_frequency
.dev_attr
.attr
,
369 static const struct attribute_group st_press_attribute_group
= {
370 .attrs
= st_press_attributes
,
373 static const struct iio_info press_info
= {
374 .driver_module
= THIS_MODULE
,
375 .attrs
= &st_press_attribute_group
,
376 .read_raw
= &st_press_read_raw
,
379 #ifdef CONFIG_IIO_TRIGGER
380 static const struct iio_trigger_ops st_press_trigger_ops
= {
381 .owner
= THIS_MODULE
,
382 .set_trigger_state
= ST_PRESS_TRIGGER_SET_STATE
,
384 #define ST_PRESS_TRIGGER_OPS (&st_press_trigger_ops)
386 #define ST_PRESS_TRIGGER_OPS NULL
389 int st_press_common_probe(struct iio_dev
*indio_dev
,
390 struct st_sensors_platform_data
*plat_data
)
392 struct st_sensor_data
*pdata
= iio_priv(indio_dev
);
393 int irq
= pdata
->get_irq_data_ready(indio_dev
);
396 indio_dev
->modes
= INDIO_DIRECT_MODE
;
397 indio_dev
->info
= &press_info
;
399 st_sensors_power_enable(indio_dev
);
401 err
= st_sensors_check_device_support(indio_dev
,
402 ARRAY_SIZE(st_press_sensors
),
407 pdata
->num_data_channels
= ST_PRESS_NUMBER_DATA_CHANNELS
;
408 pdata
->multiread_bit
= pdata
->sensor
->multi_read_bit
;
409 indio_dev
->channels
= pdata
->sensor
->ch
;
410 indio_dev
->num_channels
= pdata
->sensor
->num_ch
;
412 if (pdata
->sensor
->fs
.addr
!= 0)
413 pdata
->current_fullscale
= (struct st_sensor_fullscale_avl
*)
414 &pdata
->sensor
->fs
.fs_avl
[0];
416 pdata
->odr
= pdata
->sensor
->odr
.odr_avl
[0].hz
;
418 /* Some devices don't support a data ready pin. */
419 if (!plat_data
&& pdata
->sensor
->drdy_irq
.addr
)
421 (struct st_sensors_platform_data
*)&default_press_pdata
;
423 err
= st_sensors_init_sensor(indio_dev
, plat_data
);
427 err
= st_press_allocate_ring(indio_dev
);
432 err
= st_sensors_allocate_trigger(indio_dev
,
433 ST_PRESS_TRIGGER_OPS
);
435 goto st_press_probe_trigger_error
;
438 err
= iio_device_register(indio_dev
);
440 goto st_press_device_register_error
;
442 dev_info(&indio_dev
->dev
, "registered pressure sensor %s\n",
447 st_press_device_register_error
:
449 st_sensors_deallocate_trigger(indio_dev
);
450 st_press_probe_trigger_error
:
451 st_press_deallocate_ring(indio_dev
);
455 EXPORT_SYMBOL(st_press_common_probe
);
457 void st_press_common_remove(struct iio_dev
*indio_dev
)
459 struct st_sensor_data
*pdata
= iio_priv(indio_dev
);
461 st_sensors_power_disable(indio_dev
);
463 iio_device_unregister(indio_dev
);
464 if (pdata
->get_irq_data_ready(indio_dev
) > 0)
465 st_sensors_deallocate_trigger(indio_dev
);
467 st_press_deallocate_ring(indio_dev
);
469 EXPORT_SYMBOL(st_press_common_remove
);
471 MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
472 MODULE_DESCRIPTION("STMicroelectronics pressures driver");
473 MODULE_LICENSE("GPL v2");