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
> > + 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
--
UNIX is Sexy: who | grep -i blonde | talk; cd ~; wine; talk; touch; unzip; touch; strip; gasp; finger; gasp; mount; fsck; more; yes; gasp; umount; make clean; sleep
--
To unsubscribe from this list: send the line "unsubscribe linux-iio" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
