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>

2 files changed, 27 insertions, 6 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);
         }
diff --git a/drivers/hwmon/lis3lv02d.h b/drivers/hwmon/lis3lv02d.h
index e320e2f511f1..3e1ff46f72d3 100644
--- a/drivers/hwmon/lis3lv02d.h
+++ b/drivers/hwmon/lis3lv02d.h
@@ -58,15 +58,17 @@ enum lis3_reg {
         OUTZ_L          = 0x2C,
         OUTZ_H          = 0x2D,
         OUTZ            = 0x2D,
-        FF_WU_CFG       = 0x30,
-        FF_WU_SRC       = 0x31,
-        FF_WU_ACK       = 0x32,
-        FF_WU_THS_L     = 0x34,
-        FF_WU_THS_H     = 0x35,
-        FF_WU_DURATION  = 0x36,
 };
 
 enum lis302d_reg {
+        FF_WU_CFG_1     = 0x30,
+        FF_WU_SRC_1     = 0x31,
+        FF_WU_THS_1     = 0x32,
+        FF_WU_DURATION_1 = 0x33,
+        FF_WU_CFG_2     = 0x34,
+        FF_WU_SRC_2     = 0x35,
+        FF_WU_THS_2     = 0x36,
+        FF_WU_DURATION_2 = 0x37,
         CLICK_CFG       = 0x38,
         CLICK_SRC       = 0x39,
         CLICK_THSY_X    = 0x3B,
@@ -77,6 +79,12 @@ enum lis302d_reg {
 };
 
 enum lis3lv02d_reg {
+        FF_WU_CFG       = 0x30,
+        FF_WU_SRC       = 0x31,
+        FF_WU_ACK       = 0x32,
+        FF_WU_THS_L     = 0x34,
+        FF_WU_THS_H     = 0x35,
+        FF_WU_DURATION  = 0x36,
         DD_CFG          = 0x38,
         DD_SRC          = 0x39,
         DD_ACK          = 0x3A,
@@ -107,6 +115,10 @@ enum lis3lv02d_ctrl2 {
         CTRL2_FS        = 0x80, /* Full Scale selection */
 };
 
+enum lis302d_ctrl2 {
+        HP_FF_WU2       = 0x08,
+        HP_FF_WU1       = 0x04,
+};
 
 enum lis3lv02d_ctrl3 {
         CTRL3_CFS0      = 0x01,