iio: imu: st_lsm6dsx: support open drain mode
authorLorenzo Bianconi <lorenzo.bianconi83@gmail.com>
Wed, 21 Jun 2017 19:21:28 +0000 (21:21 +0200)
committerJonathan Cameron <jic23@kernel.org>
Sat, 1 Jul 2017 09:17:00 +0000 (10:17 +0100)
Add open drain support in order to share requested IRQ line between
st_lsm6dsx device and other peripherals

Signed-off-by: Lorenzo Bianconi <lorenzo.bianconi@st.com>
Signed-off-by: Jonathan Cameron <jic23@kernel.org>
drivers/iio/imu/st_lsm6dsx/st_lsm6dsx_buffer.c

index 2a72acc6e0493e48ae6391ae38c29da24fb38d5b..e2737dc71b677665a5a67b319d1a8c22a91b0efc 100644 (file)
@@ -31,6 +31,8 @@
 #include <linux/iio/iio.h>
 #include <linux/iio/buffer.h>
 
+#include <linux/platform_data/st_sensors_pdata.h>
+
 #include "st_lsm6dsx.h"
 
 #define ST_LSM6DSX_REG_FIFO_THL_ADDR           0x06
@@ -39,6 +41,8 @@
 #define ST_LSM6DSX_REG_FIFO_DEC_GXL_ADDR       0x08
 #define ST_LSM6DSX_REG_HLACTIVE_ADDR           0x12
 #define ST_LSM6DSX_REG_HLACTIVE_MASK           BIT(5)
+#define ST_LSM6DSX_REG_PP_OD_ADDR              0x12
+#define ST_LSM6DSX_REG_PP_OD_MASK              BIT(4)
 #define ST_LSM6DSX_REG_FIFO_MODE_ADDR          0x0a
 #define ST_LSM6DSX_FIFO_MODE_MASK              GENMASK(2, 0)
 #define ST_LSM6DSX_FIFO_ODR_MASK               GENMASK(6, 3)
@@ -417,6 +421,8 @@ static const struct iio_buffer_setup_ops st_lsm6dsx_buffer_ops = {
 
 int st_lsm6dsx_fifo_setup(struct st_lsm6dsx_hw *hw)
 {
+       struct device_node *np = hw->dev->of_node;
+       struct st_sensors_platform_data *pdata;
        struct iio_buffer *buffer;
        unsigned long irq_type;
        bool irq_active_low;
@@ -444,6 +450,17 @@ int st_lsm6dsx_fifo_setup(struct st_lsm6dsx_hw *hw)
        if (err < 0)
                return err;
 
+       pdata = (struct st_sensors_platform_data *)hw->dev->platform_data;
+       if ((np && of_property_read_bool(np, "drive-open-drain")) ||
+           (pdata && pdata->open_drain)) {
+               err = st_lsm6dsx_write_with_mask(hw, ST_LSM6DSX_REG_PP_OD_ADDR,
+                                                ST_LSM6DSX_REG_PP_OD_MASK, 1);
+               if (err < 0)
+                       return err;
+
+               irq_type |= IRQF_SHARED;
+       }
+
        err = devm_request_threaded_irq(hw->dev, hw->irq,
                                        st_lsm6dsx_handler_irq,
                                        st_lsm6dsx_handler_thread,