lis3: add free-fall/wakeup function via platform_data

This offers a way for platforms to define flags and thresholds for the
free-fall/wakeup functions of the lis302d chips.

More registers needed to be seperated as they are specific to the

Signed-off-by: Daniel Mack <daniel@caiaq.de>
Acked-by: Pavel Machek <pavel@ucw.cz>
Cc: Eric Piel <eric.piel@tremplin-utc.net>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>

1 files changed, 9 insertions, 0 deletions

diff --git a/drivers/hwmon/lis3lv02d.c b/drivers/hwmon/lis3lv02d.c
index 271338bdb6be..cf5afb9a10ab 100644
--- a/drivers/hwmon/lis3lv02d.c
+++ b/drivers/hwmon/lis3lv02d.c
@@ -454,6 +454,15 @@ int lis3lv02d_init_device(struct lis3lv02d *dev)
                                         (p->click_thresh_y << 4));
                 }
 
+                if (p->wakeup_flags && (dev->whoami == LIS_SINGLE_ID)) {
+                        dev->write(dev, FF_WU_CFG_1, p->wakeup_flags);
+                        dev->write(dev, FF_WU_THS_1, p->wakeup_thresh & 0x7f);
+                        /* default to 2.5ms for now */
+                        dev->write(dev, FF_WU_DURATION_1, 1);
+                        /* enable high pass filter for both free-fall units */
+                        dev->write(dev, CTRL_REG2, HP_FF_WU1 | HP_FF_WU2);
+                }
+
                 if (p->irq_cfg)
                         dev->write(dev, CTRL_REG3, p->irq_cfg);
         }