1 /* 2 * STMicroelectronics pressures driver 3 * 4 * Copyright 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/trigger.h> 25 #include <linux/iio/buffer.h> 26 #include <asm/unaligned.h> 27 28 #include <linux/iio/common/st_sensors.h> 29 #include "st_pressure.h" 30 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 38 39 /* FULLSCALE */ 40 #define ST_PRESS_FS_AVL_1260MB 1260 41 42 #define ST_PRESS_1_OUT_XL_ADDR 0x28 43 #define ST_TEMP_1_OUT_L_ADDR 0x2b 44 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 67 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 82 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 107 108 static const struct iio_chan_spec st_press_1_channels[] = { 109 { 110 .type = IIO_PRESSURE, 111 .channel2 = IIO_NO_MOD, 112 .address = ST_PRESS_1_OUT_XL_ADDR, 113 .scan_index = ST_SENSORS_SCAN_X, 114 .scan_type = { 115 .sign = 'u', 116 .realbits = 24, 117 .storagebits = 24, 118 .endianness = IIO_LE, 119 }, 120 .info_mask_separate = 121 BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE), 122 .modified = 0, 123 }, 124 { 125 .type = IIO_TEMP, 126 .channel2 = IIO_NO_MOD, 127 .address = ST_TEMP_1_OUT_L_ADDR, 128 .scan_index = -1, 129 .scan_type = { 130 .sign = 'u', 131 .realbits = 16, 132 .storagebits = 16, 133 .endianness = IIO_LE, 134 }, 135 .info_mask_separate = 136 BIT(IIO_CHAN_INFO_RAW) | 137 BIT(IIO_CHAN_INFO_SCALE) | 138 BIT(IIO_CHAN_INFO_OFFSET), 139 .modified = 0, 140 }, 141 IIO_CHAN_SOFT_TIMESTAMP(1) 142 }; 143 144 static const struct iio_chan_spec st_press_lps001wp_channels[] = { 145 { 146 .type = IIO_PRESSURE, 147 .channel2 = IIO_NO_MOD, 148 .address = ST_PRESS_LPS001WP_OUT_L_ADDR, 149 .scan_index = ST_SENSORS_SCAN_X, 150 .scan_type = { 151 .sign = 'u', 152 .realbits = 16, 153 .storagebits = 16, 154 .endianness = IIO_LE, 155 }, 156 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), 157 .modified = 0, 158 }, 159 { 160 .type = IIO_TEMP, 161 .channel2 = IIO_NO_MOD, 162 .address = ST_TEMP_LPS001WP_OUT_L_ADDR, 163 .scan_index = -1, 164 .scan_type = { 165 .sign = 'u', 166 .realbits = 16, 167 .storagebits = 16, 168 .endianness = IIO_LE, 169 }, 170 .info_mask_separate = 171 BIT(IIO_CHAN_INFO_RAW) | 172 BIT(IIO_CHAN_INFO_OFFSET), 173 .modified = 0, 174 }, 175 IIO_CHAN_SOFT_TIMESTAMP(1) 176 }; 177 178 static const struct st_sensors st_press_sensors[] = { 179 { 180 .wai = ST_PRESS_LPS331AP_WAI_EXP, 181 .sensors_supported = { 182 [0] = LPS331AP_PRESS_DEV_NAME, 183 }, 184 .ch = (struct iio_chan_spec *)st_press_1_channels, 185 .num_ch = ARRAY_SIZE(st_press_1_channels), 186 .odr = { 187 .addr = ST_PRESS_LPS331AP_ODR_ADDR, 188 .mask = ST_PRESS_LPS331AP_ODR_MASK, 189 .odr_avl = { 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, }, 194 }, 195 }, 196 .pw = { 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, 201 }, 202 .fs = { 203 .addr = ST_PRESS_LPS331AP_FS_ADDR, 204 .mask = ST_PRESS_LPS331AP_FS_MASK, 205 .fs_avl = { 206 [0] = { 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, 211 }, 212 }, 213 }, 214 .bdu = { 215 .addr = ST_PRESS_LPS331AP_BDU_ADDR, 216 .mask = ST_PRESS_LPS331AP_BDU_MASK, 217 }, 218 .drdy_irq = { 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, 222 }, 223 .multi_read_bit = ST_PRESS_LPS331AP_MULTIREAD_BIT, 224 .bootime = 2, 225 }, 226 { 227 .wai = ST_PRESS_LPS001WP_WAI_EXP, 228 .sensors_supported = { 229 [0] = LPS001WP_PRESS_DEV_NAME, 230 }, 231 .ch = (struct iio_chan_spec *)st_press_lps001wp_channels, 232 .num_ch = ARRAY_SIZE(st_press_lps001wp_channels), 233 .odr = { 234 .addr = ST_PRESS_LPS001WP_ODR_ADDR, 235 .mask = ST_PRESS_LPS001WP_ODR_MASK, 236 .odr_avl = { 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, }, 240 }, 241 }, 242 .pw = { 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, 247 }, 248 .fs = { 249 .addr = 0, 250 }, 251 .bdu = { 252 .addr = ST_PRESS_LPS001WP_BDU_ADDR, 253 .mask = ST_PRESS_LPS001WP_BDU_MASK, 254 }, 255 .drdy_irq = { 256 .addr = 0, 257 }, 258 .multi_read_bit = ST_PRESS_LPS001WP_MULTIREAD_BIT, 259 .bootime = 2, 260 }, 261 { 262 .wai = ST_PRESS_LPS25H_WAI_EXP, 263 .sensors_supported = { 264 [0] = LPS25H_PRESS_DEV_NAME, 265 }, 266 .ch = (struct iio_chan_spec *)st_press_1_channels, 267 .num_ch = ARRAY_SIZE(st_press_1_channels), 268 .odr = { 269 .addr = ST_PRESS_LPS25H_ODR_ADDR, 270 .mask = ST_PRESS_LPS25H_ODR_MASK, 271 .odr_avl = { 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, }, 276 }, 277 }, 278 .pw = { 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, 283 }, 284 .fs = { 285 .addr = ST_PRESS_LPS25H_FS_ADDR, 286 .mask = ST_PRESS_LPS25H_FS_MASK, 287 .fs_avl = { 288 [0] = { 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, 293 }, 294 }, 295 }, 296 .bdu = { 297 .addr = ST_PRESS_LPS25H_BDU_ADDR, 298 .mask = ST_PRESS_LPS25H_BDU_MASK, 299 }, 300 .drdy_irq = { 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, 304 }, 305 .multi_read_bit = ST_PRESS_LPS25H_MULTIREAD_BIT, 306 .bootime = 2, 307 }, 308 }; 309 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) 313 { 314 int err; 315 struct st_sensor_data *pdata = iio_priv(indio_dev); 316 317 switch (mask) { 318 case IIO_CHAN_INFO_RAW: 319 err = st_sensors_read_info_raw(indio_dev, ch, val); 320 if (err < 0) 321 goto read_error; 322 323 return IIO_VAL_INT; 324 case IIO_CHAN_INFO_SCALE: 325 *val = 0; 326 327 switch (ch->type) { 328 case IIO_PRESSURE: 329 *val2 = pdata->current_fullscale->gain; 330 break; 331 case IIO_TEMP: 332 *val2 = pdata->current_fullscale->gain2; 333 break; 334 default: 335 err = -EINVAL; 336 goto read_error; 337 } 338 339 return IIO_VAL_INT_PLUS_NANO; 340 case IIO_CHAN_INFO_OFFSET: 341 switch (ch->type) { 342 case IIO_TEMP: 343 *val = 425; 344 *val2 = 10; 345 break; 346 default: 347 err = -EINVAL; 348 goto read_error; 349 } 350 351 return IIO_VAL_FRACTIONAL; 352 default: 353 return -EINVAL; 354 } 355 356 read_error: 357 return err; 358 } 359 360 static ST_SENSOR_DEV_ATTR_SAMP_FREQ(); 361 static ST_SENSORS_DEV_ATTR_SAMP_FREQ_AVAIL(); 362 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, 366 NULL, 367 }; 368 369 static const struct attribute_group st_press_attribute_group = { 370 .attrs = st_press_attributes, 371 }; 372 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, 377 }; 378 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, 383 }; 384 #define ST_PRESS_TRIGGER_OPS (&st_press_trigger_ops) 385 #else 386 #define ST_PRESS_TRIGGER_OPS NULL 387 #endif 388 389 int st_press_common_probe(struct iio_dev *indio_dev, 390 struct st_sensors_platform_data *plat_data) 391 { 392 struct st_sensor_data *pdata = iio_priv(indio_dev); 393 int irq = pdata->get_irq_data_ready(indio_dev); 394 int err; 395 396 indio_dev->modes = INDIO_DIRECT_MODE; 397 indio_dev->info = &press_info; 398 399 st_sensors_power_enable(indio_dev); 400 401 err = st_sensors_check_device_support(indio_dev, 402 ARRAY_SIZE(st_press_sensors), 403 st_press_sensors); 404 if (err < 0) 405 return err; 406 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; 411 412 if (pdata->sensor->fs.addr != 0) 413 pdata->current_fullscale = (struct st_sensor_fullscale_avl *) 414 &pdata->sensor->fs.fs_avl[0]; 415 416 pdata->odr = pdata->sensor->odr.odr_avl[0].hz; 417 418 /* Some devices don't support a data ready pin. */ 419 if (!plat_data && pdata->sensor->drdy_irq.addr) 420 plat_data = 421 (struct st_sensors_platform_data *)&default_press_pdata; 422 423 err = st_sensors_init_sensor(indio_dev, plat_data); 424 if (err < 0) 425 return err; 426 427 err = st_press_allocate_ring(indio_dev); 428 if (err < 0) 429 return err; 430 431 if (irq > 0) { 432 err = st_sensors_allocate_trigger(indio_dev, 433 ST_PRESS_TRIGGER_OPS); 434 if (err < 0) 435 goto st_press_probe_trigger_error; 436 } 437 438 err = iio_device_register(indio_dev); 439 if (err) 440 goto st_press_device_register_error; 441 442 dev_info(&indio_dev->dev, "registered pressure sensor %s\n", 443 indio_dev->name); 444 445 return err; 446 447 st_press_device_register_error: 448 if (irq > 0) 449 st_sensors_deallocate_trigger(indio_dev); 450 st_press_probe_trigger_error: 451 st_press_deallocate_ring(indio_dev); 452 453 return err; 454 } 455 EXPORT_SYMBOL(st_press_common_probe); 456 457 void st_press_common_remove(struct iio_dev *indio_dev) 458 { 459 struct st_sensor_data *pdata = iio_priv(indio_dev); 460 461 st_sensors_power_disable(indio_dev); 462 463 iio_device_unregister(indio_dev); 464 if (pdata->get_irq_data_ready(indio_dev) > 0) 465 st_sensors_deallocate_trigger(indio_dev); 466 467 st_press_deallocate_ring(indio_dev); 468 } 469 EXPORT_SYMBOL(st_press_common_remove); 470 471 MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>"); 472 MODULE_DESCRIPTION("STMicroelectronics pressures driver"); 473 MODULE_LICENSE("GPL v2"); 474