mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-09-15 15:15:47 +00:00
cf4dd430c4
Reduce the amount of those unnecessary goto calls, as in most cases we can simply return immediately. We also only call for the IRQ number once and use that value throughout. Signed-off-by: Lee Jones <lee.jones@linaro.org> Signed-off-by: Jonathan Cameron <jic23@kernel.org>
526 lines
15 KiB
C
526 lines
15 KiB
C
/*
|
|
* STMicroelectronics accelerometers driver
|
|
*
|
|
* Copyright 2012-2013 STMicroelectronics Inc.
|
|
*
|
|
* Denis Ciocca <denis.ciocca@st.com>
|
|
*
|
|
* Licensed under the GPL-2.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/types.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/iio/iio.h>
|
|
#include <linux/iio/sysfs.h>
|
|
#include <linux/iio/trigger.h>
|
|
#include <linux/iio/buffer.h>
|
|
|
|
#include <linux/iio/common/st_sensors.h>
|
|
#include "st_accel.h"
|
|
|
|
#define ST_ACCEL_NUMBER_DATA_CHANNELS 3
|
|
|
|
/* DEFAULT VALUE FOR SENSORS */
|
|
#define ST_ACCEL_DEFAULT_OUT_X_L_ADDR 0x28
|
|
#define ST_ACCEL_DEFAULT_OUT_Y_L_ADDR 0x2a
|
|
#define ST_ACCEL_DEFAULT_OUT_Z_L_ADDR 0x2c
|
|
|
|
/* FULLSCALE */
|
|
#define ST_ACCEL_FS_AVL_2G 2
|
|
#define ST_ACCEL_FS_AVL_4G 4
|
|
#define ST_ACCEL_FS_AVL_6G 6
|
|
#define ST_ACCEL_FS_AVL_8G 8
|
|
#define ST_ACCEL_FS_AVL_16G 16
|
|
|
|
/* CUSTOM VALUES FOR SENSOR 1 */
|
|
#define ST_ACCEL_1_WAI_EXP 0x33
|
|
#define ST_ACCEL_1_ODR_ADDR 0x20
|
|
#define ST_ACCEL_1_ODR_MASK 0xf0
|
|
#define ST_ACCEL_1_ODR_AVL_1HZ_VAL 0x01
|
|
#define ST_ACCEL_1_ODR_AVL_10HZ_VAL 0x02
|
|
#define ST_ACCEL_1_ODR_AVL_25HZ_VAL 0x03
|
|
#define ST_ACCEL_1_ODR_AVL_50HZ_VAL 0x04
|
|
#define ST_ACCEL_1_ODR_AVL_100HZ_VAL 0x05
|
|
#define ST_ACCEL_1_ODR_AVL_200HZ_VAL 0x06
|
|
#define ST_ACCEL_1_ODR_AVL_400HZ_VAL 0x07
|
|
#define ST_ACCEL_1_ODR_AVL_1600HZ_VAL 0x08
|
|
#define ST_ACCEL_1_FS_ADDR 0x23
|
|
#define ST_ACCEL_1_FS_MASK 0x30
|
|
#define ST_ACCEL_1_FS_AVL_2_VAL 0x00
|
|
#define ST_ACCEL_1_FS_AVL_4_VAL 0x01
|
|
#define ST_ACCEL_1_FS_AVL_8_VAL 0x02
|
|
#define ST_ACCEL_1_FS_AVL_16_VAL 0x03
|
|
#define ST_ACCEL_1_FS_AVL_2_GAIN IIO_G_TO_M_S_2(1000)
|
|
#define ST_ACCEL_1_FS_AVL_4_GAIN IIO_G_TO_M_S_2(2000)
|
|
#define ST_ACCEL_1_FS_AVL_8_GAIN IIO_G_TO_M_S_2(4000)
|
|
#define ST_ACCEL_1_FS_AVL_16_GAIN IIO_G_TO_M_S_2(12000)
|
|
#define ST_ACCEL_1_BDU_ADDR 0x23
|
|
#define ST_ACCEL_1_BDU_MASK 0x80
|
|
#define ST_ACCEL_1_DRDY_IRQ_ADDR 0x22
|
|
#define ST_ACCEL_1_DRDY_IRQ_INT1_MASK 0x10
|
|
#define ST_ACCEL_1_DRDY_IRQ_INT2_MASK 0x08
|
|
#define ST_ACCEL_1_MULTIREAD_BIT true
|
|
|
|
/* CUSTOM VALUES FOR SENSOR 2 */
|
|
#define ST_ACCEL_2_WAI_EXP 0x32
|
|
#define ST_ACCEL_2_ODR_ADDR 0x20
|
|
#define ST_ACCEL_2_ODR_MASK 0x18
|
|
#define ST_ACCEL_2_ODR_AVL_50HZ_VAL 0x00
|
|
#define ST_ACCEL_2_ODR_AVL_100HZ_VAL 0x01
|
|
#define ST_ACCEL_2_ODR_AVL_400HZ_VAL 0x02
|
|
#define ST_ACCEL_2_ODR_AVL_1000HZ_VAL 0x03
|
|
#define ST_ACCEL_2_PW_ADDR 0x20
|
|
#define ST_ACCEL_2_PW_MASK 0xe0
|
|
#define ST_ACCEL_2_FS_ADDR 0x23
|
|
#define ST_ACCEL_2_FS_MASK 0x30
|
|
#define ST_ACCEL_2_FS_AVL_2_VAL 0X00
|
|
#define ST_ACCEL_2_FS_AVL_4_VAL 0X01
|
|
#define ST_ACCEL_2_FS_AVL_8_VAL 0x03
|
|
#define ST_ACCEL_2_FS_AVL_2_GAIN IIO_G_TO_M_S_2(1000)
|
|
#define ST_ACCEL_2_FS_AVL_4_GAIN IIO_G_TO_M_S_2(2000)
|
|
#define ST_ACCEL_2_FS_AVL_8_GAIN IIO_G_TO_M_S_2(3900)
|
|
#define ST_ACCEL_2_BDU_ADDR 0x23
|
|
#define ST_ACCEL_2_BDU_MASK 0x80
|
|
#define ST_ACCEL_2_DRDY_IRQ_ADDR 0x22
|
|
#define ST_ACCEL_2_DRDY_IRQ_INT1_MASK 0x02
|
|
#define ST_ACCEL_2_DRDY_IRQ_INT2_MASK 0x10
|
|
#define ST_ACCEL_2_MULTIREAD_BIT true
|
|
|
|
/* CUSTOM VALUES FOR SENSOR 3 */
|
|
#define ST_ACCEL_3_WAI_EXP 0x40
|
|
#define ST_ACCEL_3_ODR_ADDR 0x20
|
|
#define ST_ACCEL_3_ODR_MASK 0xf0
|
|
#define ST_ACCEL_3_ODR_AVL_3HZ_VAL 0x01
|
|
#define ST_ACCEL_3_ODR_AVL_6HZ_VAL 0x02
|
|
#define ST_ACCEL_3_ODR_AVL_12HZ_VAL 0x03
|
|
#define ST_ACCEL_3_ODR_AVL_25HZ_VAL 0x04
|
|
#define ST_ACCEL_3_ODR_AVL_50HZ_VAL 0x05
|
|
#define ST_ACCEL_3_ODR_AVL_100HZ_VAL 0x06
|
|
#define ST_ACCEL_3_ODR_AVL_200HZ_VAL 0x07
|
|
#define ST_ACCEL_3_ODR_AVL_400HZ_VAL 0x08
|
|
#define ST_ACCEL_3_ODR_AVL_800HZ_VAL 0x09
|
|
#define ST_ACCEL_3_ODR_AVL_1600HZ_VAL 0x0a
|
|
#define ST_ACCEL_3_FS_ADDR 0x24
|
|
#define ST_ACCEL_3_FS_MASK 0x38
|
|
#define ST_ACCEL_3_FS_AVL_2_VAL 0X00
|
|
#define ST_ACCEL_3_FS_AVL_4_VAL 0X01
|
|
#define ST_ACCEL_3_FS_AVL_6_VAL 0x02
|
|
#define ST_ACCEL_3_FS_AVL_8_VAL 0x03
|
|
#define ST_ACCEL_3_FS_AVL_16_VAL 0x04
|
|
#define ST_ACCEL_3_FS_AVL_2_GAIN IIO_G_TO_M_S_2(61)
|
|
#define ST_ACCEL_3_FS_AVL_4_GAIN IIO_G_TO_M_S_2(122)
|
|
#define ST_ACCEL_3_FS_AVL_6_GAIN IIO_G_TO_M_S_2(183)
|
|
#define ST_ACCEL_3_FS_AVL_8_GAIN IIO_G_TO_M_S_2(244)
|
|
#define ST_ACCEL_3_FS_AVL_16_GAIN IIO_G_TO_M_S_2(732)
|
|
#define ST_ACCEL_3_BDU_ADDR 0x20
|
|
#define ST_ACCEL_3_BDU_MASK 0x08
|
|
#define ST_ACCEL_3_DRDY_IRQ_ADDR 0x23
|
|
#define ST_ACCEL_3_DRDY_IRQ_INT1_MASK 0x80
|
|
#define ST_ACCEL_3_DRDY_IRQ_INT2_MASK 0x00
|
|
#define ST_ACCEL_3_IG1_EN_ADDR 0x23
|
|
#define ST_ACCEL_3_IG1_EN_MASK 0x08
|
|
#define ST_ACCEL_3_MULTIREAD_BIT false
|
|
|
|
static const struct iio_chan_spec st_accel_12bit_channels[] = {
|
|
ST_SENSORS_LSM_CHANNELS(IIO_ACCEL,
|
|
BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
|
|
ST_SENSORS_SCAN_X, 1, IIO_MOD_X, 's', IIO_LE, 12, 16,
|
|
ST_ACCEL_DEFAULT_OUT_X_L_ADDR),
|
|
ST_SENSORS_LSM_CHANNELS(IIO_ACCEL,
|
|
BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
|
|
ST_SENSORS_SCAN_Y, 1, IIO_MOD_Y, 's', IIO_LE, 12, 16,
|
|
ST_ACCEL_DEFAULT_OUT_Y_L_ADDR),
|
|
ST_SENSORS_LSM_CHANNELS(IIO_ACCEL,
|
|
BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
|
|
ST_SENSORS_SCAN_Z, 1, IIO_MOD_Z, 's', IIO_LE, 12, 16,
|
|
ST_ACCEL_DEFAULT_OUT_Z_L_ADDR),
|
|
IIO_CHAN_SOFT_TIMESTAMP(3)
|
|
};
|
|
|
|
static const struct iio_chan_spec st_accel_16bit_channels[] = {
|
|
ST_SENSORS_LSM_CHANNELS(IIO_ACCEL,
|
|
BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
|
|
ST_SENSORS_SCAN_X, 1, IIO_MOD_X, 's', IIO_LE, 16, 16,
|
|
ST_ACCEL_DEFAULT_OUT_X_L_ADDR),
|
|
ST_SENSORS_LSM_CHANNELS(IIO_ACCEL,
|
|
BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
|
|
ST_SENSORS_SCAN_Y, 1, IIO_MOD_Y, 's', IIO_LE, 16, 16,
|
|
ST_ACCEL_DEFAULT_OUT_Y_L_ADDR),
|
|
ST_SENSORS_LSM_CHANNELS(IIO_ACCEL,
|
|
BIT(IIO_CHAN_INFO_RAW) | BIT(IIO_CHAN_INFO_SCALE),
|
|
ST_SENSORS_SCAN_Z, 1, IIO_MOD_Z, 's', IIO_LE, 16, 16,
|
|
ST_ACCEL_DEFAULT_OUT_Z_L_ADDR),
|
|
IIO_CHAN_SOFT_TIMESTAMP(3)
|
|
};
|
|
|
|
static const struct st_sensors st_accel_sensors[] = {
|
|
{
|
|
.wai = ST_ACCEL_1_WAI_EXP,
|
|
.sensors_supported = {
|
|
[0] = LIS3DH_ACCEL_DEV_NAME,
|
|
[1] = LSM303DLHC_ACCEL_DEV_NAME,
|
|
[2] = LSM330D_ACCEL_DEV_NAME,
|
|
[3] = LSM330DL_ACCEL_DEV_NAME,
|
|
[4] = LSM330DLC_ACCEL_DEV_NAME,
|
|
},
|
|
.ch = (struct iio_chan_spec *)st_accel_12bit_channels,
|
|
.odr = {
|
|
.addr = ST_ACCEL_1_ODR_ADDR,
|
|
.mask = ST_ACCEL_1_ODR_MASK,
|
|
.odr_avl = {
|
|
{ 1, ST_ACCEL_1_ODR_AVL_1HZ_VAL, },
|
|
{ 10, ST_ACCEL_1_ODR_AVL_10HZ_VAL, },
|
|
{ 25, ST_ACCEL_1_ODR_AVL_25HZ_VAL, },
|
|
{ 50, ST_ACCEL_1_ODR_AVL_50HZ_VAL, },
|
|
{ 100, ST_ACCEL_1_ODR_AVL_100HZ_VAL, },
|
|
{ 200, ST_ACCEL_1_ODR_AVL_200HZ_VAL, },
|
|
{ 400, ST_ACCEL_1_ODR_AVL_400HZ_VAL, },
|
|
{ 1600, ST_ACCEL_1_ODR_AVL_1600HZ_VAL, },
|
|
},
|
|
},
|
|
.pw = {
|
|
.addr = ST_ACCEL_1_ODR_ADDR,
|
|
.mask = ST_ACCEL_1_ODR_MASK,
|
|
.value_off = ST_SENSORS_DEFAULT_POWER_OFF_VALUE,
|
|
},
|
|
.enable_axis = {
|
|
.addr = ST_SENSORS_DEFAULT_AXIS_ADDR,
|
|
.mask = ST_SENSORS_DEFAULT_AXIS_MASK,
|
|
},
|
|
.fs = {
|
|
.addr = ST_ACCEL_1_FS_ADDR,
|
|
.mask = ST_ACCEL_1_FS_MASK,
|
|
.fs_avl = {
|
|
[0] = {
|
|
.num = ST_ACCEL_FS_AVL_2G,
|
|
.value = ST_ACCEL_1_FS_AVL_2_VAL,
|
|
.gain = ST_ACCEL_1_FS_AVL_2_GAIN,
|
|
},
|
|
[1] = {
|
|
.num = ST_ACCEL_FS_AVL_4G,
|
|
.value = ST_ACCEL_1_FS_AVL_4_VAL,
|
|
.gain = ST_ACCEL_1_FS_AVL_4_GAIN,
|
|
},
|
|
[2] = {
|
|
.num = ST_ACCEL_FS_AVL_8G,
|
|
.value = ST_ACCEL_1_FS_AVL_8_VAL,
|
|
.gain = ST_ACCEL_1_FS_AVL_8_GAIN,
|
|
},
|
|
[3] = {
|
|
.num = ST_ACCEL_FS_AVL_16G,
|
|
.value = ST_ACCEL_1_FS_AVL_16_VAL,
|
|
.gain = ST_ACCEL_1_FS_AVL_16_GAIN,
|
|
},
|
|
},
|
|
},
|
|
.bdu = {
|
|
.addr = ST_ACCEL_1_BDU_ADDR,
|
|
.mask = ST_ACCEL_1_BDU_MASK,
|
|
},
|
|
.drdy_irq = {
|
|
.addr = ST_ACCEL_1_DRDY_IRQ_ADDR,
|
|
.mask_int1 = ST_ACCEL_1_DRDY_IRQ_INT1_MASK,
|
|
.mask_int2 = ST_ACCEL_1_DRDY_IRQ_INT2_MASK,
|
|
},
|
|
.multi_read_bit = ST_ACCEL_1_MULTIREAD_BIT,
|
|
.bootime = 2,
|
|
},
|
|
{
|
|
.wai = ST_ACCEL_2_WAI_EXP,
|
|
.sensors_supported = {
|
|
[0] = LIS331DLH_ACCEL_DEV_NAME,
|
|
[1] = LSM303DL_ACCEL_DEV_NAME,
|
|
[2] = LSM303DLH_ACCEL_DEV_NAME,
|
|
[3] = LSM303DLM_ACCEL_DEV_NAME,
|
|
},
|
|
.ch = (struct iio_chan_spec *)st_accel_12bit_channels,
|
|
.odr = {
|
|
.addr = ST_ACCEL_2_ODR_ADDR,
|
|
.mask = ST_ACCEL_2_ODR_MASK,
|
|
.odr_avl = {
|
|
{ 50, ST_ACCEL_2_ODR_AVL_50HZ_VAL, },
|
|
{ 100, ST_ACCEL_2_ODR_AVL_100HZ_VAL, },
|
|
{ 400, ST_ACCEL_2_ODR_AVL_400HZ_VAL, },
|
|
{ 1000, ST_ACCEL_2_ODR_AVL_1000HZ_VAL, },
|
|
},
|
|
},
|
|
.pw = {
|
|
.addr = ST_ACCEL_2_PW_ADDR,
|
|
.mask = ST_ACCEL_2_PW_MASK,
|
|
.value_on = ST_SENSORS_DEFAULT_POWER_ON_VALUE,
|
|
.value_off = ST_SENSORS_DEFAULT_POWER_OFF_VALUE,
|
|
},
|
|
.enable_axis = {
|
|
.addr = ST_SENSORS_DEFAULT_AXIS_ADDR,
|
|
.mask = ST_SENSORS_DEFAULT_AXIS_MASK,
|
|
},
|
|
.fs = {
|
|
.addr = ST_ACCEL_2_FS_ADDR,
|
|
.mask = ST_ACCEL_2_FS_MASK,
|
|
.fs_avl = {
|
|
[0] = {
|
|
.num = ST_ACCEL_FS_AVL_2G,
|
|
.value = ST_ACCEL_2_FS_AVL_2_VAL,
|
|
.gain = ST_ACCEL_2_FS_AVL_2_GAIN,
|
|
},
|
|
[1] = {
|
|
.num = ST_ACCEL_FS_AVL_4G,
|
|
.value = ST_ACCEL_2_FS_AVL_4_VAL,
|
|
.gain = ST_ACCEL_2_FS_AVL_4_GAIN,
|
|
},
|
|
[2] = {
|
|
.num = ST_ACCEL_FS_AVL_8G,
|
|
.value = ST_ACCEL_2_FS_AVL_8_VAL,
|
|
.gain = ST_ACCEL_2_FS_AVL_8_GAIN,
|
|
},
|
|
},
|
|
},
|
|
.bdu = {
|
|
.addr = ST_ACCEL_2_BDU_ADDR,
|
|
.mask = ST_ACCEL_2_BDU_MASK,
|
|
},
|
|
.drdy_irq = {
|
|
.addr = ST_ACCEL_2_DRDY_IRQ_ADDR,
|
|
.mask_int1 = ST_ACCEL_2_DRDY_IRQ_INT1_MASK,
|
|
.mask_int2 = ST_ACCEL_2_DRDY_IRQ_INT2_MASK,
|
|
},
|
|
.multi_read_bit = ST_ACCEL_2_MULTIREAD_BIT,
|
|
.bootime = 2,
|
|
},
|
|
{
|
|
.wai = ST_ACCEL_3_WAI_EXP,
|
|
.sensors_supported = {
|
|
[0] = LSM330_ACCEL_DEV_NAME,
|
|
},
|
|
.ch = (struct iio_chan_spec *)st_accel_16bit_channels,
|
|
.odr = {
|
|
.addr = ST_ACCEL_3_ODR_ADDR,
|
|
.mask = ST_ACCEL_3_ODR_MASK,
|
|
.odr_avl = {
|
|
{ 3, ST_ACCEL_3_ODR_AVL_3HZ_VAL },
|
|
{ 6, ST_ACCEL_3_ODR_AVL_6HZ_VAL, },
|
|
{ 12, ST_ACCEL_3_ODR_AVL_12HZ_VAL, },
|
|
{ 25, ST_ACCEL_3_ODR_AVL_25HZ_VAL, },
|
|
{ 50, ST_ACCEL_3_ODR_AVL_50HZ_VAL, },
|
|
{ 100, ST_ACCEL_3_ODR_AVL_100HZ_VAL, },
|
|
{ 200, ST_ACCEL_3_ODR_AVL_200HZ_VAL, },
|
|
{ 400, ST_ACCEL_3_ODR_AVL_400HZ_VAL, },
|
|
{ 800, ST_ACCEL_3_ODR_AVL_800HZ_VAL, },
|
|
{ 1600, ST_ACCEL_3_ODR_AVL_1600HZ_VAL, },
|
|
},
|
|
},
|
|
.pw = {
|
|
.addr = ST_ACCEL_3_ODR_ADDR,
|
|
.mask = ST_ACCEL_3_ODR_MASK,
|
|
.value_off = ST_SENSORS_DEFAULT_POWER_OFF_VALUE,
|
|
},
|
|
.enable_axis = {
|
|
.addr = ST_SENSORS_DEFAULT_AXIS_ADDR,
|
|
.mask = ST_SENSORS_DEFAULT_AXIS_MASK,
|
|
},
|
|
.fs = {
|
|
.addr = ST_ACCEL_3_FS_ADDR,
|
|
.mask = ST_ACCEL_3_FS_MASK,
|
|
.fs_avl = {
|
|
[0] = {
|
|
.num = ST_ACCEL_FS_AVL_2G,
|
|
.value = ST_ACCEL_3_FS_AVL_2_VAL,
|
|
.gain = ST_ACCEL_3_FS_AVL_2_GAIN,
|
|
},
|
|
[1] = {
|
|
.num = ST_ACCEL_FS_AVL_4G,
|
|
.value = ST_ACCEL_3_FS_AVL_4_VAL,
|
|
.gain = ST_ACCEL_3_FS_AVL_4_GAIN,
|
|
},
|
|
[2] = {
|
|
.num = ST_ACCEL_FS_AVL_6G,
|
|
.value = ST_ACCEL_3_FS_AVL_6_VAL,
|
|
.gain = ST_ACCEL_3_FS_AVL_6_GAIN,
|
|
},
|
|
[3] = {
|
|
.num = ST_ACCEL_FS_AVL_8G,
|
|
.value = ST_ACCEL_3_FS_AVL_8_VAL,
|
|
.gain = ST_ACCEL_3_FS_AVL_8_GAIN,
|
|
},
|
|
[4] = {
|
|
.num = ST_ACCEL_FS_AVL_16G,
|
|
.value = ST_ACCEL_3_FS_AVL_16_VAL,
|
|
.gain = ST_ACCEL_3_FS_AVL_16_GAIN,
|
|
},
|
|
},
|
|
},
|
|
.bdu = {
|
|
.addr = ST_ACCEL_3_BDU_ADDR,
|
|
.mask = ST_ACCEL_3_BDU_MASK,
|
|
},
|
|
.drdy_irq = {
|
|
.addr = ST_ACCEL_3_DRDY_IRQ_ADDR,
|
|
.mask_int1 = ST_ACCEL_3_DRDY_IRQ_INT1_MASK,
|
|
.mask_int2 = ST_ACCEL_3_DRDY_IRQ_INT2_MASK,
|
|
.ig1 = {
|
|
.en_addr = ST_ACCEL_3_IG1_EN_ADDR,
|
|
.en_mask = ST_ACCEL_3_IG1_EN_MASK,
|
|
},
|
|
},
|
|
.multi_read_bit = ST_ACCEL_3_MULTIREAD_BIT,
|
|
.bootime = 2,
|
|
},
|
|
};
|
|
|
|
static int st_accel_read_raw(struct iio_dev *indio_dev,
|
|
struct iio_chan_spec const *ch, int *val,
|
|
int *val2, long mask)
|
|
{
|
|
int err;
|
|
struct st_sensor_data *adata = iio_priv(indio_dev);
|
|
|
|
switch (mask) {
|
|
case IIO_CHAN_INFO_RAW:
|
|
err = st_sensors_read_info_raw(indio_dev, ch, val);
|
|
if (err < 0)
|
|
goto read_error;
|
|
|
|
return IIO_VAL_INT;
|
|
case IIO_CHAN_INFO_SCALE:
|
|
*val = 0;
|
|
*val2 = adata->current_fullscale->gain;
|
|
return IIO_VAL_INT_PLUS_MICRO;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
read_error:
|
|
return err;
|
|
}
|
|
|
|
static int st_accel_write_raw(struct iio_dev *indio_dev,
|
|
struct iio_chan_spec const *chan, int val, int val2, long mask)
|
|
{
|
|
int err;
|
|
|
|
switch (mask) {
|
|
case IIO_CHAN_INFO_SCALE:
|
|
err = st_sensors_set_fullscale_by_gain(indio_dev, val2);
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
static ST_SENSOR_DEV_ATTR_SAMP_FREQ();
|
|
static ST_SENSORS_DEV_ATTR_SAMP_FREQ_AVAIL();
|
|
static ST_SENSORS_DEV_ATTR_SCALE_AVAIL(in_accel_scale_available);
|
|
|
|
static struct attribute *st_accel_attributes[] = {
|
|
&iio_dev_attr_sampling_frequency_available.dev_attr.attr,
|
|
&iio_dev_attr_in_accel_scale_available.dev_attr.attr,
|
|
&iio_dev_attr_sampling_frequency.dev_attr.attr,
|
|
NULL,
|
|
};
|
|
|
|
static const struct attribute_group st_accel_attribute_group = {
|
|
.attrs = st_accel_attributes,
|
|
};
|
|
|
|
static const struct iio_info accel_info = {
|
|
.driver_module = THIS_MODULE,
|
|
.attrs = &st_accel_attribute_group,
|
|
.read_raw = &st_accel_read_raw,
|
|
.write_raw = &st_accel_write_raw,
|
|
};
|
|
|
|
#ifdef CONFIG_IIO_TRIGGER
|
|
static const struct iio_trigger_ops st_accel_trigger_ops = {
|
|
.owner = THIS_MODULE,
|
|
.set_trigger_state = ST_ACCEL_TRIGGER_SET_STATE,
|
|
};
|
|
#define ST_ACCEL_TRIGGER_OPS (&st_accel_trigger_ops)
|
|
#else
|
|
#define ST_ACCEL_TRIGGER_OPS NULL
|
|
#endif
|
|
|
|
int st_accel_common_probe(struct iio_dev *indio_dev,
|
|
struct st_sensors_platform_data *plat_data)
|
|
{
|
|
struct st_sensor_data *adata = iio_priv(indio_dev);
|
|
int irq = adata->get_irq_data_ready(indio_dev);
|
|
int err;
|
|
|
|
indio_dev->modes = INDIO_DIRECT_MODE;
|
|
indio_dev->info = &accel_info;
|
|
|
|
err = st_sensors_check_device_support(indio_dev,
|
|
ARRAY_SIZE(st_accel_sensors), st_accel_sensors);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
adata->num_data_channels = ST_ACCEL_NUMBER_DATA_CHANNELS;
|
|
adata->multiread_bit = adata->sensor->multi_read_bit;
|
|
indio_dev->channels = adata->sensor->ch;
|
|
indio_dev->num_channels = ST_SENSORS_NUMBER_ALL_CHANNELS;
|
|
|
|
adata->current_fullscale = (struct st_sensor_fullscale_avl *)
|
|
&adata->sensor->fs.fs_avl[0];
|
|
adata->odr = adata->sensor->odr.odr_avl[0].hz;
|
|
|
|
if (!plat_data)
|
|
plat_data =
|
|
(struct st_sensors_platform_data *)&default_accel_pdata;
|
|
|
|
err = st_sensors_init_sensor(indio_dev, plat_data);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
if (irq > 0) {
|
|
err = st_accel_allocate_ring(indio_dev);
|
|
if (err < 0)
|
|
return err;
|
|
|
|
err = st_sensors_allocate_trigger(indio_dev,
|
|
ST_ACCEL_TRIGGER_OPS);
|
|
if (err < 0)
|
|
goto st_accel_probe_trigger_error;
|
|
}
|
|
|
|
err = iio_device_register(indio_dev);
|
|
if (err)
|
|
goto st_accel_device_register_error;
|
|
|
|
return 0;
|
|
|
|
st_accel_device_register_error:
|
|
if (irq > 0)
|
|
st_sensors_deallocate_trigger(indio_dev);
|
|
st_accel_probe_trigger_error:
|
|
if (irq > 0)
|
|
st_accel_deallocate_ring(indio_dev);
|
|
|
|
return err;
|
|
}
|
|
EXPORT_SYMBOL(st_accel_common_probe);
|
|
|
|
void st_accel_common_remove(struct iio_dev *indio_dev)
|
|
{
|
|
struct st_sensor_data *adata = iio_priv(indio_dev);
|
|
|
|
iio_device_unregister(indio_dev);
|
|
if (adata->get_irq_data_ready(indio_dev) > 0) {
|
|
st_sensors_deallocate_trigger(indio_dev);
|
|
st_accel_deallocate_ring(indio_dev);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(st_accel_common_remove);
|
|
|
|
MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
|
|
MODULE_DESCRIPTION("STMicroelectronics accelerometers driver");
|
|
MODULE_LICENSE("GPL v2");
|