|
Dave Jones |
abc7c8e |
>From 56fb161a9ca0129f8e266e4dbe79346552ff8089 Mon Sep 17 00:00:00 2001
|
|
Dave Jones |
abc7c8e |
From: =?UTF-8?q?=C3=89ric=20Piel?= <eric.piel@tremplin-utc.net>
|
|
Dave Jones |
abc7c8e |
Date: Thu, 3 Nov 2011 16:22:40 +0100
|
|
Dave Jones |
abc7c8e |
Subject: [PATCH] lis3: Improve handling of null rate
|
|
Dave Jones |
abc7c8e |
MIME-Version: 1.0
|
|
Dave Jones |
abc7c8e |
Content-Type: text/plain; charset=UTF-8
|
|
Dave Jones |
abc7c8e |
Content-Transfer-Encoding: 8bit
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
When obtaining a rate of 0, we would disable the device supposely
|
|
Dave Jones |
abc7c8e |
because it seems to behave incorectly. It actually only comes from the
|
|
Dave Jones |
abc7c8e |
fact that the device is off and on lis3dc it's reflected in the rate.
|
|
Dave Jones |
abc7c8e |
So handle this nicely by just waiting a safe time, and then using the
|
|
Dave Jones |
abc7c8e |
device as normally.
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
Signed-off-by: ??ric Piel <eric.piel@tremplin-utc.net>
|
|
Dave Jones |
abc7c8e |
---
|
|
Dave Jones |
abc7c8e |
drivers/misc/lis3lv02d/lis3lv02d.c | 16 ++++++++--------
|
|
Dave Jones |
abc7c8e |
1 files changed, 8 insertions(+), 8 deletions(-)
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
diff --git a/drivers/misc/lis3lv02d/lis3lv02d.c b/drivers/misc/lis3lv02d/lis3lv02d.c
|
|
Dave Jones |
abc7c8e |
index 35c67e0..42dce2a 100644
|
|
Dave Jones |
abc7c8e |
--- a/drivers/misc/lis3lv02d/lis3lv02d.c
|
|
Dave Jones |
abc7c8e |
+++ b/drivers/misc/lis3lv02d/lis3lv02d.c
|
|
Dave Jones |
abc7c8e |
@@ -188,7 +188,8 @@ static void lis3lv02d_get_xyz(struct lis3lv02d *lis3, int *x, int *y, int *z)
|
|
Dave Jones |
abc7c8e |
/* conversion btw sampling rate and the register values */
|
|
Dave Jones |
abc7c8e |
static int lis3_12_rates[4] = {40, 160, 640, 2560};
|
|
Dave Jones |
abc7c8e |
static int lis3_8_rates[2] = {100, 400};
|
|
Dave Jones |
abc7c8e |
-static int lis3_3dc_rates[16] = {0, 1, 10, 25, 50, 100, 200, 400, 1600, 5000};
|
|
Dave Jones |
abc7c8e |
+/* LIS3DC: 0 = power off, above 9 = undefined */
|
|
Dave Jones |
abc7c8e |
+static int lis3_3dc_rates[16] = {0, 1, 10, 25, 50, 100, 200, 400, 1600, 5000, -1, -1, -1, -1, -1, -1};
|
|
|
fc85362 |
static int lis3_3dlh_rates[4] = {50, 100, 400, 1000};
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
/* ODR is Output Data Rate */
|
|
Dave Jones |
abc7c8e |
@@ -202,12 +203,11 @@ static int lis3lv02d_get_odr(struct lis3lv02d *lis3)
|
|
Dave Jones |
abc7c8e |
return lis3->odrs[(ctrl >> shift)];
|
|
Dave Jones |
abc7c8e |
}
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
-static int lis3lv02d_get_pwron_wait(struct lis3lv02d *lis3)
|
|
Dave Jones |
abc7c8e |
+static int lis3lv02d_wait_pwron(struct lis3lv02d *lis3)
|
|
Dave Jones |
abc7c8e |
{
|
|
Dave Jones |
abc7c8e |
int div = lis3lv02d_get_odr(lis3);
|
|
Dave Jones |
abc7c8e |
-
|
|
Dave Jones |
abc7c8e |
- if (WARN_ONCE(div == 0, "device returned spurious data"))
|
|
Dave Jones |
abc7c8e |
- return -ENXIO;
|
|
Dave Jones |
abc7c8e |
+ if (div <= 0)
|
|
Dave Jones |
abc7c8e |
+ div = 1; /* maximum delay */
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
/* LIS3 power on delay is quite long */
|
|
Dave Jones |
abc7c8e |
msleep(lis3->pwron_delay / div);
|
|
Dave Jones |
abc7c8e |
@@ -274,7 +274,7 @@ static int lis3lv02d_selftest(struct lis3lv02d *lis3, s16 results[3])
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
lis3->read(lis3, ctlreg, ®);
|
|
Dave Jones |
abc7c8e |
lis3->write(lis3, ctlreg, (reg | selftest));
|
|
Dave Jones |
abc7c8e |
- ret = lis3lv02d_get_pwron_wait(lis3);
|
|
Dave Jones |
abc7c8e |
+ ret = lis3lv02d_wait_pwron(lis3);
|
|
Dave Jones |
abc7c8e |
if (ret)
|
|
Dave Jones |
abc7c8e |
goto fail;
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
@@ -285,7 +285,7 @@ static int lis3lv02d_selftest(struct lis3lv02d *lis3, s16 results[3])
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
/* back to normal settings */
|
|
Dave Jones |
abc7c8e |
lis3->write(lis3, ctlreg, reg);
|
|
Dave Jones |
abc7c8e |
- ret = lis3lv02d_get_pwron_wait(lis3);
|
|
Dave Jones |
abc7c8e |
+ ret = lis3lv02d_wait_pwron(lis3);
|
|
Dave Jones |
abc7c8e |
if (ret)
|
|
Dave Jones |
abc7c8e |
goto fail;
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
@@ -397,7 +397,7 @@ int lis3lv02d_poweron(struct lis3lv02d *lis3)
|
|
Dave Jones |
abc7c8e |
lis3->write(lis3, CTRL_REG2, reg);
|
|
Dave Jones |
abc7c8e |
}
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
- err = lis3lv02d_get_pwron_wait(lis3);
|
|
Dave Jones |
abc7c8e |
+ err = lis3lv02d_wait_pwron(lis3);
|
|
Dave Jones |
abc7c8e |
if (err)
|
|
Dave Jones |
abc7c8e |
return err;
|
|
Dave Jones |
abc7c8e |
|
|
Dave Jones |
abc7c8e |
--
|
|
Dave Jones |
abc7c8e |
1.7.7.1
|
|
Dave Jones |
abc7c8e |
|