On 22/01/17 15:20, Lorenzo Bianconi wrote: > Hi Jonathan, > > thanks for the review :) > >> On 22/01/17 10:30, Lorenzo Bianconi wrote: >>> Add capability to route data ready signal on pin 1 or pin 2 of the package >>> >>> Signed-off-by: Lorenzo Bianconi <lorenzo.bianconi@xxxxxx> >>> --- >>> drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c | 66 +++++++++++++++++++++++++--- >>> 1 file changed, 60 insertions(+), 6 deletions(-) >>> >>> diff --git a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c >>> index f869dfa..bc50164 100644 >>> --- a/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c >>> +++ b/drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_core.c >>> @@ -37,11 +37,14 @@ >>> #include <linux/iio/iio.h> >>> #include <linux/iio/sysfs.h> >>> >>> +#include <linux/platform_data/st_sensors_pdata.h> >>> + >>> #include "st_lsm6dsx.h" >>> >>> #define ST_LSM6DSX_REG_ACC_DEC_MASK GENMASK(2, 0) >>> #define ST_LSM6DSX_REG_GYRO_DEC_MASK GENMASK(5, 3) >>> #define ST_LSM6DSX_REG_INT1_ADDR 0x0d >>> +#define ST_LSM6DSX_REG_INT2_ADDR 0x0e >>> #define ST_LSM6DSX_REG_FIFO_FTH_IRQ_MASK BIT(3) >>> #define ST_LSM6DSX_REG_WHOAMI_ADDR 0x0f >>> #define ST_LSM6DSX_REG_RESET_ADDR 0x12 >>> @@ -532,10 +535,63 @@ static const struct iio_info st_lsm6dsx_gyro_info = { >>> >>> static const unsigned long st_lsm6dsx_available_scan_masks[] = {0x7, 0x0}; >>> >>> +#ifdef CONFIG_OF >> Perhaps rely on the -ENOSYS return from >> of_property_read_u32 stub instead of having the ifdefs around something so >> simple. > > ack, will do in v2 > >> >>> +static int st_lsm6dsx_of_get_drdy_pin(struct st_lsm6dsx_hw *hw, int *drdy_pin) >>> +{ >>> + struct device_node *np = hw->dev->of_node; >>> + int err; >>> + >>> + if (!np) >>> + return -EINVAL; >>> + >>> + err = of_property_read_u32(np, "st,drdy-int-pin", drdy_pin); >>> + if (err == -ENODATA) { >>> + /* if the property has not been specified use default value */ >>> + *drdy_pin = 1; >>> + err = 0; >>> + } >>> + >>> + return err; >>> +} >>> +#else >>> +static int st_lsm6dsx_of_get_drdy_pin(struct st_lsm6dsx_hw *hw, int *drdy_pin) >>> +{ >>> + return -EINVAL; >>> +} >>> +#endif /* CONFIG_OF */ >>> + >>> +static int st_lsm6dsx_get_drdy_reg(struct st_lsm6dsx_hw *hw, u8 *drdy_reg) >>> +{ >>> + int err = 0, drdy_pin; >>> + >>> + if (st_lsm6dsx_of_get_drdy_pin(hw, &drdy_pin) < 0) { >>> + struct st_sensors_platform_data *pdata; >>> + struct device *dev = hw->dev; >>> + >>> + pdata = (struct st_sensors_platform_data *)dev->platform_data; >>> + drdy_pin = pdata ? pdata->drdy_int_pin : 1; >>> + } >>> + >>> + switch (drdy_pin) { >>> + case 1: >>> + *drdy_reg = ST_LSM6DSX_REG_INT1_ADDR; >>> + break; >>> + case 2: >>> + *drdy_reg = ST_LSM6DSX_REG_INT2_ADDR; >>> + break; >>> + default: >>> + dev_err(hw->dev, "unsupported data ready pin\n"); >>> + err = -EINVAL; >>> + break; >>> + } >>> + >>> + return err; >>> +} >>> + >>> static int st_lsm6dsx_init_device(struct st_lsm6dsx_hw *hw) >>> { >>> + u8 data, drdy_int_reg; >>> int err; >>> - u8 data; >>> >>> data = ST_LSM6DSX_REG_RESET_MASK; >>> err = hw->tf->write(hw->dev, ST_LSM6DSX_REG_RESET_ADDR, sizeof(data), >>> @@ -563,14 +619,12 @@ static int st_lsm6dsx_init_device(struct st_lsm6dsx_hw *hw) >>> return err; >>> >>> /* enable FIFO watermak interrupt */ >>> - err = st_lsm6dsx_write_with_mask(hw, ST_LSM6DSX_REG_INT1_ADDR, >>> - ST_LSM6DSX_REG_FIFO_FTH_IRQ_MASK, 1); >>> + err = st_lsm6dsx_get_drdy_reg(hw, &drdy_int_reg); >>> if (err < 0) >>> return err; >>> >>> - /* redirect INT2 on INT1 */ >>> - return st_lsm6dsx_write_with_mask(hw, ST_LSM6DSX_REG_INT2_ON_INT1_ADDR, >>> - ST_LSM6DSX_REG_INT2_ON_INT1_MASK, 1); >> Does removing this potentially break existing setups? >> > > No, it doesn't since INT2 was not configured yet ah. So this was previously effectively a noop. Thanks. > >>> + return st_lsm6dsx_write_with_mask(hw, drdy_int_reg, >>> + ST_LSM6DSX_REG_FIFO_FTH_IRQ_MASK, 1); >>> } >>> >>> static struct iio_dev *st_lsm6dsx_alloc_iiodev(struct st_lsm6dsx_hw *hw, >>> >> > > Regards, > Lorenzo > -- To unsubscribe from this list: send the line "unsubscribe devicetree" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html