|
@@ -31,9 +31,11 @@
|
|
|
#include <linux/delay.h>
|
|
|
#include <linux/wait.h>
|
|
|
#include <linux/poll.h>
|
|
|
+#include <linux/slab.h>
|
|
|
#include <linux/freezer.h>
|
|
|
#include <linux/uaccess.h>
|
|
|
#include <linux/miscdevice.h>
|
|
|
+#include <linux/pm_runtime.h>
|
|
|
#include <asm/atomic.h>
|
|
|
#include "lis3lv02d.h"
|
|
|
|
|
@@ -43,6 +45,16 @@
|
|
|
#define MDPS_POLL_INTERVAL 50
|
|
|
#define MDPS_POLL_MIN 0
|
|
|
#define MDPS_POLL_MAX 2000
|
|
|
+
|
|
|
+#define LIS3_SYSFS_POWERDOWN_DELAY 5000 /* In milliseconds */
|
|
|
+
|
|
|
+#define SELFTEST_OK 0
|
|
|
+#define SELFTEST_FAIL -1
|
|
|
+#define SELFTEST_IRQ -2
|
|
|
+
|
|
|
+#define IRQ_LINE0 0
|
|
|
+#define IRQ_LINE1 1
|
|
|
+
|
|
|
/*
|
|
|
* The sensor can also generate interrupts (DRDY) but it's pretty pointless
|
|
|
* because they are generated even if the data do not change. So it's better
|
|
@@ -66,8 +78,10 @@
|
|
|
#define LIS3_SENSITIVITY_12B ((LIS3_ACCURACY * 1000) / 1024)
|
|
|
#define LIS3_SENSITIVITY_8B (18 * LIS3_ACCURACY)
|
|
|
|
|
|
-#define LIS3_DEFAULT_FUZZ 3
|
|
|
-#define LIS3_DEFAULT_FLAT 3
|
|
|
+#define LIS3_DEFAULT_FUZZ_12B 3
|
|
|
+#define LIS3_DEFAULT_FLAT_12B 3
|
|
|
+#define LIS3_DEFAULT_FUZZ_8B 1
|
|
|
+#define LIS3_DEFAULT_FLAT_8B 1
|
|
|
|
|
|
struct lis3lv02d lis3_dev = {
|
|
|
.misc_wait = __WAIT_QUEUE_HEAD_INITIALIZER(lis3_dev.misc_wait),
|
|
@@ -75,6 +89,30 @@ struct lis3lv02d lis3_dev = {
|
|
|
|
|
|
EXPORT_SYMBOL_GPL(lis3_dev);
|
|
|
|
|
|
+/* just like param_set_int() but does sanity-check so that it won't point
|
|
|
+ * over the axis array size
|
|
|
+ */
|
|
|
+static int param_set_axis(const char *val, const struct kernel_param *kp)
|
|
|
+{
|
|
|
+ int ret = param_set_int(val, kp);
|
|
|
+ if (!ret) {
|
|
|
+ int val = *(int *)kp->arg;
|
|
|
+ if (val < 0)
|
|
|
+ val = -val;
|
|
|
+ if (!val || val > 3)
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
+static struct kernel_param_ops param_ops_axis = {
|
|
|
+ .set = param_set_axis,
|
|
|
+ .get = param_get_int,
|
|
|
+};
|
|
|
+
|
|
|
+module_param_array_named(axes, lis3_dev.ac.as_array, axis, NULL, 0644);
|
|
|
+MODULE_PARM_DESC(axes, "Axis-mapping for x,y,z directions");
|
|
|
+
|
|
|
static s16 lis3lv02d_read_8(struct lis3lv02d *lis3, int reg)
|
|
|
{
|
|
|
s8 lo;
|
|
@@ -123,9 +161,24 @@ static void lis3lv02d_get_xyz(struct lis3lv02d *lis3, int *x, int *y, int *z)
|
|
|
int position[3];
|
|
|
int i;
|
|
|
|
|
|
- position[0] = lis3->read_data(lis3, OUTX);
|
|
|
- position[1] = lis3->read_data(lis3, OUTY);
|
|
|
- position[2] = lis3->read_data(lis3, OUTZ);
|
|
|
+ if (lis3->blkread) {
|
|
|
+ if (lis3_dev.whoami == WAI_12B) {
|
|
|
+ u16 data[3];
|
|
|
+ lis3->blkread(lis3, OUTX_L, 6, (u8 *)data);
|
|
|
+ for (i = 0; i < 3; i++)
|
|
|
+ position[i] = (s16)le16_to_cpu(data[i]);
|
|
|
+ } else {
|
|
|
+ u8 data[5];
|
|
|
+ /* Data: x, dummy, y, dummy, z */
|
|
|
+ lis3->blkread(lis3, OUTX, 5, data);
|
|
|
+ for (i = 0; i < 3; i++)
|
|
|
+ position[i] = (s8)data[i * 2];
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ position[0] = lis3->read_data(lis3, OUTX);
|
|
|
+ position[1] = lis3->read_data(lis3, OUTY);
|
|
|
+ position[2] = lis3->read_data(lis3, OUTZ);
|
|
|
+ }
|
|
|
|
|
|
for (i = 0; i < 3; i++)
|
|
|
position[i] = (position[i] * lis3->scale) / LIS3_ACCURACY;
|
|
@@ -138,6 +191,7 @@ static void lis3lv02d_get_xyz(struct lis3lv02d *lis3, int *x, int *y, int *z)
|
|
|
/* conversion btw sampling rate and the register values */
|
|
|
static int lis3_12_rates[4] = {40, 160, 640, 2560};
|
|
|
static int lis3_8_rates[2] = {100, 400};
|
|
|
+static int lis3_3dc_rates[16] = {0, 1, 10, 25, 50, 100, 200, 400, 1600, 5000};
|
|
|
|
|
|
/* ODR is Output Data Rate */
|
|
|
static int lis3lv02d_get_odr(void)
|
|
@@ -156,6 +210,9 @@ static int lis3lv02d_set_odr(int rate)
|
|
|
u8 ctrl;
|
|
|
int i, len, shift;
|
|
|
|
|
|
+ if (!rate)
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
lis3_dev.read(&lis3_dev, CTRL_REG1, &ctrl);
|
|
|
ctrl &= ~lis3_dev.odr_mask;
|
|
|
len = 1 << hweight_long(lis3_dev.odr_mask); /* # of possible values */
|
|
@@ -172,19 +229,42 @@ static int lis3lv02d_set_odr(int rate)
|
|
|
|
|
|
static int lis3lv02d_selftest(struct lis3lv02d *lis3, s16 results[3])
|
|
|
{
|
|
|
- u8 reg;
|
|
|
+ u8 ctlreg, reg;
|
|
|
s16 x, y, z;
|
|
|
u8 selftest;
|
|
|
int ret;
|
|
|
+ u8 ctrl_reg_data;
|
|
|
+ unsigned char irq_cfg;
|
|
|
|
|
|
mutex_lock(&lis3->mutex);
|
|
|
- if (lis3_dev.whoami == WAI_12B)
|
|
|
- selftest = CTRL1_ST;
|
|
|
- else
|
|
|
- selftest = CTRL1_STP;
|
|
|
|
|
|
- lis3->read(lis3, CTRL_REG1, ®);
|
|
|
- lis3->write(lis3, CTRL_REG1, (reg | selftest));
|
|
|
+ irq_cfg = lis3->irq_cfg;
|
|
|
+ if (lis3_dev.whoami == WAI_8B) {
|
|
|
+ lis3->data_ready_count[IRQ_LINE0] = 0;
|
|
|
+ lis3->data_ready_count[IRQ_LINE1] = 0;
|
|
|
+
|
|
|
+ /* Change interrupt cfg to data ready for selftest */
|
|
|
+ atomic_inc(&lis3_dev.wake_thread);
|
|
|
+ lis3->irq_cfg = LIS3_IRQ1_DATA_READY | LIS3_IRQ2_DATA_READY;
|
|
|
+ lis3->read(lis3, CTRL_REG3, &ctrl_reg_data);
|
|
|
+ lis3->write(lis3, CTRL_REG3, (ctrl_reg_data &
|
|
|
+ ~(LIS3_IRQ1_MASK | LIS3_IRQ2_MASK)) |
|
|
|
+ (LIS3_IRQ1_DATA_READY | LIS3_IRQ2_DATA_READY));
|
|
|
+ }
|
|
|
+
|
|
|
+ if (lis3_dev.whoami == WAI_3DC) {
|
|
|
+ ctlreg = CTRL_REG4;
|
|
|
+ selftest = CTRL4_ST0;
|
|
|
+ } else {
|
|
|
+ ctlreg = CTRL_REG1;
|
|
|
+ if (lis3_dev.whoami == WAI_12B)
|
|
|
+ selftest = CTRL1_ST;
|
|
|
+ else
|
|
|
+ selftest = CTRL1_STP;
|
|
|
+ }
|
|
|
+
|
|
|
+ lis3->read(lis3, ctlreg, ®);
|
|
|
+ lis3->write(lis3, ctlreg, (reg | selftest));
|
|
|
msleep(lis3->pwron_delay / lis3lv02d_get_odr());
|
|
|
|
|
|
/* Read directly to avoid axis remap */
|
|
@@ -193,7 +273,7 @@ static int lis3lv02d_selftest(struct lis3lv02d *lis3, s16 results[3])
|
|
|
z = lis3->read_data(lis3, OUTZ);
|
|
|
|
|
|
/* back to normal settings */
|
|
|
- lis3->write(lis3, CTRL_REG1, reg);
|
|
|
+ lis3->write(lis3, ctlreg, reg);
|
|
|
msleep(lis3->pwron_delay / lis3lv02d_get_odr());
|
|
|
|
|
|
results[0] = x - lis3->read_data(lis3, OUTX);
|
|
@@ -201,13 +281,33 @@ static int lis3lv02d_selftest(struct lis3lv02d *lis3, s16 results[3])
|
|
|
results[2] = z - lis3->read_data(lis3, OUTZ);
|
|
|
|
|
|
ret = 0;
|
|
|
+
|
|
|
+ if (lis3_dev.whoami == WAI_8B) {
|
|
|
+ /* Restore original interrupt configuration */
|
|
|
+ atomic_dec(&lis3_dev.wake_thread);
|
|
|
+ lis3->write(lis3, CTRL_REG3, ctrl_reg_data);
|
|
|
+ lis3->irq_cfg = irq_cfg;
|
|
|
+
|
|
|
+ if ((irq_cfg & LIS3_IRQ1_MASK) &&
|
|
|
+ lis3->data_ready_count[IRQ_LINE0] < 2) {
|
|
|
+ ret = SELFTEST_IRQ;
|
|
|
+ goto fail;
|
|
|
+ }
|
|
|
+
|
|
|
+ if ((irq_cfg & LIS3_IRQ2_MASK) &&
|
|
|
+ lis3->data_ready_count[IRQ_LINE1] < 2) {
|
|
|
+ ret = SELFTEST_IRQ;
|
|
|
+ goto fail;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
if (lis3->pdata) {
|
|
|
int i;
|
|
|
for (i = 0; i < 3; i++) {
|
|
|
/* Check against selftest acceptance limits */
|
|
|
if ((results[i] < lis3->pdata->st_min_limits[i]) ||
|
|
|
(results[i] > lis3->pdata->st_max_limits[i])) {
|
|
|
- ret = -EIO;
|
|
|
+ ret = SELFTEST_FAIL;
|
|
|
goto fail;
|
|
|
}
|
|
|
}
|
|
@@ -219,10 +319,46 @@ fail:
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
+/*
|
|
|
+ * Order of registers in the list affects to order of the restore process.
|
|
|
+ * Perhaps it is a good idea to set interrupt enable register as a last one
|
|
|
+ * after all other configurations
|
|
|
+ */
|
|
|
+static u8 lis3_wai8_regs[] = { FF_WU_CFG_1, FF_WU_THS_1, FF_WU_DURATION_1,
|
|
|
+ FF_WU_CFG_2, FF_WU_THS_2, FF_WU_DURATION_2,
|
|
|
+ CLICK_CFG, CLICK_SRC, CLICK_THSY_X, CLICK_THSZ,
|
|
|
+ CLICK_TIMELIMIT, CLICK_LATENCY, CLICK_WINDOW,
|
|
|
+ CTRL_REG1, CTRL_REG2, CTRL_REG3};
|
|
|
+
|
|
|
+static u8 lis3_wai12_regs[] = {FF_WU_CFG, FF_WU_THS_L, FF_WU_THS_H,
|
|
|
+ FF_WU_DURATION, DD_CFG, DD_THSI_L, DD_THSI_H,
|
|
|
+ DD_THSE_L, DD_THSE_H,
|
|
|
+ CTRL_REG1, CTRL_REG3, CTRL_REG2};
|
|
|
+
|
|
|
+static inline void lis3_context_save(struct lis3lv02d *lis3)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ for (i = 0; i < lis3->regs_size; i++)
|
|
|
+ lis3->read(lis3, lis3->regs[i], &lis3->reg_cache[i]);
|
|
|
+ lis3->regs_stored = true;
|
|
|
+}
|
|
|
+
|
|
|
+static inline void lis3_context_restore(struct lis3lv02d *lis3)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ if (lis3->regs_stored)
|
|
|
+ for (i = 0; i < lis3->regs_size; i++)
|
|
|
+ lis3->write(lis3, lis3->regs[i], lis3->reg_cache[i]);
|
|
|
+}
|
|
|
+
|
|
|
void lis3lv02d_poweroff(struct lis3lv02d *lis3)
|
|
|
{
|
|
|
+ if (lis3->reg_ctrl)
|
|
|
+ lis3_context_save(lis3);
|
|
|
/* disable X,Y,Z axis and power down */
|
|
|
lis3->write(lis3, CTRL_REG1, 0x00);
|
|
|
+ if (lis3->reg_ctrl)
|
|
|
+ lis3->reg_ctrl(lis3, LIS3_REG_OFF);
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(lis3lv02d_poweroff);
|
|
|
|
|
@@ -232,19 +368,24 @@ void lis3lv02d_poweron(struct lis3lv02d *lis3)
|
|
|
|
|
|
lis3->init(lis3);
|
|
|
|
|
|
- /* LIS3 power on delay is quite long */
|
|
|
- msleep(lis3->pwron_delay / lis3lv02d_get_odr());
|
|
|
-
|
|
|
/*
|
|
|
* Common configuration
|
|
|
* BDU: (12 bits sensors only) LSB and MSB values are not updated until
|
|
|
* both have been read. So the value read will always be correct.
|
|
|
+ * Set BOOT bit to refresh factory tuning values.
|
|
|
*/
|
|
|
- if (lis3->whoami == WAI_12B) {
|
|
|
- lis3->read(lis3, CTRL_REG2, ®);
|
|
|
- reg |= CTRL2_BDU;
|
|
|
- lis3->write(lis3, CTRL_REG2, reg);
|
|
|
- }
|
|
|
+ lis3->read(lis3, CTRL_REG2, ®);
|
|
|
+ if (lis3->whoami == WAI_12B)
|
|
|
+ reg |= CTRL2_BDU | CTRL2_BOOT;
|
|
|
+ else
|
|
|
+ reg |= CTRL2_BOOT_8B;
|
|
|
+ lis3->write(lis3, CTRL_REG2, reg);
|
|
|
+
|
|
|
+ /* LIS3 power on delay is quite long */
|
|
|
+ msleep(lis3->pwron_delay / lis3lv02d_get_odr());
|
|
|
+
|
|
|
+ if (lis3->reg_ctrl)
|
|
|
+ lis3_context_restore(lis3);
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(lis3lv02d_poweron);
|
|
|
|
|
@@ -262,6 +403,27 @@ static void lis3lv02d_joystick_poll(struct input_polled_dev *pidev)
|
|
|
mutex_unlock(&lis3_dev.mutex);
|
|
|
}
|
|
|
|
|
|
+static void lis3lv02d_joystick_open(struct input_polled_dev *pidev)
|
|
|
+{
|
|
|
+ if (lis3_dev.pm_dev)
|
|
|
+ pm_runtime_get_sync(lis3_dev.pm_dev);
|
|
|
+
|
|
|
+ if (lis3_dev.pdata && lis3_dev.whoami == WAI_8B && lis3_dev.idev)
|
|
|
+ atomic_set(&lis3_dev.wake_thread, 1);
|
|
|
+ /*
|
|
|
+ * Update coordinates for the case where poll interval is 0 and
|
|
|
+ * the chip in running purely under interrupt control
|
|
|
+ */
|
|
|
+ lis3lv02d_joystick_poll(pidev);
|
|
|
+}
|
|
|
+
|
|
|
+static void lis3lv02d_joystick_close(struct input_polled_dev *pidev)
|
|
|
+{
|
|
|
+ atomic_set(&lis3_dev.wake_thread, 0);
|
|
|
+ if (lis3_dev.pm_dev)
|
|
|
+ pm_runtime_put(lis3_dev.pm_dev);
|
|
|
+}
|
|
|
+
|
|
|
static irqreturn_t lis302dl_interrupt(int irq, void *dummy)
|
|
|
{
|
|
|
if (!test_bit(0, &lis3_dev.misc_opened))
|
|
@@ -277,8 +439,7 @@ static irqreturn_t lis302dl_interrupt(int irq, void *dummy)
|
|
|
wake_up_interruptible(&lis3_dev.misc_wait);
|
|
|
kill_fasync(&lis3_dev.async_queue, SIGIO, POLL_IN);
|
|
|
out:
|
|
|
- if (lis3_dev.pdata && lis3_dev.whoami == WAI_8B && lis3_dev.idev &&
|
|
|
- lis3_dev.idev->input->users)
|
|
|
+ if (atomic_read(&lis3_dev.wake_thread))
|
|
|
return IRQ_WAKE_THREAD;
|
|
|
return IRQ_HANDLED;
|
|
|
}
|
|
@@ -309,44 +470,41 @@ static void lis302dl_interrupt_handle_click(struct lis3lv02d *lis3)
|
|
|
mutex_unlock(&lis3->mutex);
|
|
|
}
|
|
|
|
|
|
-static void lis302dl_interrupt_handle_ff_wu(struct lis3lv02d *lis3)
|
|
|
+static inline void lis302dl_data_ready(struct lis3lv02d *lis3, int index)
|
|
|
{
|
|
|
- u8 wu1_src;
|
|
|
- u8 wu2_src;
|
|
|
-
|
|
|
- lis3->read(lis3, FF_WU_SRC_1, &wu1_src);
|
|
|
- lis3->read(lis3, FF_WU_SRC_2, &wu2_src);
|
|
|
+ int dummy;
|
|
|
|
|
|
- wu1_src = wu1_src & FF_WU_SRC_IA ? wu1_src : 0;
|
|
|
- wu2_src = wu2_src & FF_WU_SRC_IA ? wu2_src : 0;
|
|
|
-
|
|
|
- /* joystick poll is internally protected by the lis3->mutex. */
|
|
|
- if (wu1_src || wu2_src)
|
|
|
- lis3lv02d_joystick_poll(lis3_dev.idev);
|
|
|
+ /* Dummy read to ack interrupt */
|
|
|
+ lis3lv02d_get_xyz(lis3, &dummy, &dummy, &dummy);
|
|
|
+ lis3->data_ready_count[index]++;
|
|
|
}
|
|
|
|
|
|
static irqreturn_t lis302dl_interrupt_thread1_8b(int irq, void *data)
|
|
|
{
|
|
|
-
|
|
|
struct lis3lv02d *lis3 = data;
|
|
|
+ u8 irq_cfg = lis3->irq_cfg & LIS3_IRQ1_MASK;
|
|
|
|
|
|
- if ((lis3->pdata->irq_cfg & LIS3_IRQ1_MASK) == LIS3_IRQ1_CLICK)
|
|
|
+ if (irq_cfg == LIS3_IRQ1_CLICK)
|
|
|
lis302dl_interrupt_handle_click(lis3);
|
|
|
+ else if (unlikely(irq_cfg == LIS3_IRQ1_DATA_READY))
|
|
|
+ lis302dl_data_ready(lis3, IRQ_LINE0);
|
|
|
else
|
|
|
- lis302dl_interrupt_handle_ff_wu(lis3);
|
|
|
+ lis3lv02d_joystick_poll(lis3->idev);
|
|
|
|
|
|
return IRQ_HANDLED;
|
|
|
}
|
|
|
|
|
|
static irqreturn_t lis302dl_interrupt_thread2_8b(int irq, void *data)
|
|
|
{
|
|
|
-
|
|
|
struct lis3lv02d *lis3 = data;
|
|
|
+ u8 irq_cfg = lis3->irq_cfg & LIS3_IRQ2_MASK;
|
|
|
|
|
|
- if ((lis3->pdata->irq_cfg & LIS3_IRQ2_MASK) == LIS3_IRQ2_CLICK)
|
|
|
+ if (irq_cfg == LIS3_IRQ2_CLICK)
|
|
|
lis302dl_interrupt_handle_click(lis3);
|
|
|
+ else if (unlikely(irq_cfg == LIS3_IRQ2_DATA_READY))
|
|
|
+ lis302dl_data_ready(lis3, IRQ_LINE1);
|
|
|
else
|
|
|
- lis302dl_interrupt_handle_ff_wu(lis3);
|
|
|
+ lis3lv02d_joystick_poll(lis3->idev);
|
|
|
|
|
|
return IRQ_HANDLED;
|
|
|
}
|
|
@@ -356,6 +514,9 @@ static int lis3lv02d_misc_open(struct inode *inode, struct file *file)
|
|
|
if (test_and_set_bit(0, &lis3_dev.misc_opened))
|
|
|
return -EBUSY; /* already open */
|
|
|
|
|
|
+ if (lis3_dev.pm_dev)
|
|
|
+ pm_runtime_get_sync(lis3_dev.pm_dev);
|
|
|
+
|
|
|
atomic_set(&lis3_dev.count, 0);
|
|
|
return 0;
|
|
|
}
|
|
@@ -364,6 +525,8 @@ static int lis3lv02d_misc_release(struct inode *inode, struct file *file)
|
|
|
{
|
|
|
fasync_helper(-1, file, 0, &lis3_dev.async_queue);
|
|
|
clear_bit(0, &lis3_dev.misc_opened); /* release the device */
|
|
|
+ if (lis3_dev.pm_dev)
|
|
|
+ pm_runtime_put(lis3_dev.pm_dev);
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
@@ -460,6 +623,8 @@ int lis3lv02d_joystick_enable(void)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
lis3_dev.idev->poll = lis3lv02d_joystick_poll;
|
|
|
+ lis3_dev.idev->open = lis3lv02d_joystick_open;
|
|
|
+ lis3_dev.idev->close = lis3lv02d_joystick_close;
|
|
|
lis3_dev.idev->poll_interval = MDPS_POLL_INTERVAL;
|
|
|
lis3_dev.idev->poll_interval_min = MDPS_POLL_MIN;
|
|
|
lis3_dev.idev->poll_interval_max = MDPS_POLL_MAX;
|
|
@@ -473,8 +638,16 @@ int lis3lv02d_joystick_enable(void)
|
|
|
|
|
|
set_bit(EV_ABS, input_dev->evbit);
|
|
|
max_val = (lis3_dev.mdps_max_val * lis3_dev.scale) / LIS3_ACCURACY;
|
|
|
- fuzz = (LIS3_DEFAULT_FUZZ * lis3_dev.scale) / LIS3_ACCURACY;
|
|
|
- flat = (LIS3_DEFAULT_FLAT * lis3_dev.scale) / LIS3_ACCURACY;
|
|
|
+ if (lis3_dev.whoami == WAI_12B) {
|
|
|
+ fuzz = LIS3_DEFAULT_FUZZ_12B;
|
|
|
+ flat = LIS3_DEFAULT_FLAT_12B;
|
|
|
+ } else {
|
|
|
+ fuzz = LIS3_DEFAULT_FUZZ_8B;
|
|
|
+ flat = LIS3_DEFAULT_FLAT_8B;
|
|
|
+ }
|
|
|
+ fuzz = (fuzz * lis3_dev.scale) / LIS3_ACCURACY;
|
|
|
+ flat = (flat * lis3_dev.scale) / LIS3_ACCURACY;
|
|
|
+
|
|
|
input_set_abs_params(input_dev, ABS_X, -max_val, max_val, fuzz, flat);
|
|
|
input_set_abs_params(input_dev, ABS_Y, -max_val, max_val, fuzz, flat);
|
|
|
input_set_abs_params(input_dev, ABS_Z, -max_val, max_val, fuzz, flat);
|
|
@@ -512,14 +685,47 @@ void lis3lv02d_joystick_disable(void)
|
|
|
EXPORT_SYMBOL_GPL(lis3lv02d_joystick_disable);
|
|
|
|
|
|
/* Sysfs stuff */
|
|
|
+static void lis3lv02d_sysfs_poweron(struct lis3lv02d *lis3)
|
|
|
+{
|
|
|
+ /*
|
|
|
+ * SYSFS functions are fast visitors so put-call
|
|
|
+ * immediately after the get-call. However, keep
|
|
|
+ * chip running for a while and schedule delayed
|
|
|
+ * suspend. This way periodic sysfs calls doesn't
|
|
|
+ * suffer from relatively long power up time.
|
|
|
+ */
|
|
|
+
|
|
|
+ if (lis3->pm_dev) {
|
|
|
+ pm_runtime_get_sync(lis3->pm_dev);
|
|
|
+ pm_runtime_put_noidle(lis3->pm_dev);
|
|
|
+ pm_schedule_suspend(lis3->pm_dev, LIS3_SYSFS_POWERDOWN_DELAY);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
static ssize_t lis3lv02d_selftest_show(struct device *dev,
|
|
|
struct device_attribute *attr, char *buf)
|
|
|
{
|
|
|
- int result;
|
|
|
s16 values[3];
|
|
|
|
|
|
- result = lis3lv02d_selftest(&lis3_dev, values);
|
|
|
- return sprintf(buf, "%s %d %d %d\n", result == 0 ? "OK" : "FAIL",
|
|
|
+ static const char ok[] = "OK";
|
|
|
+ static const char fail[] = "FAIL";
|
|
|
+ static const char irq[] = "FAIL_IRQ";
|
|
|
+ const char *res;
|
|
|
+
|
|
|
+ lis3lv02d_sysfs_poweron(&lis3_dev);
|
|
|
+ switch (lis3lv02d_selftest(&lis3_dev, values)) {
|
|
|
+ case SELFTEST_FAIL:
|
|
|
+ res = fail;
|
|
|
+ break;
|
|
|
+ case SELFTEST_IRQ:
|
|
|
+ res = irq;
|
|
|
+ break;
|
|
|
+ case SELFTEST_OK:
|
|
|
+ default:
|
|
|
+ res = ok;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ return sprintf(buf, "%s %d %d %d\n", res,
|
|
|
values[0], values[1], values[2]);
|
|
|
}
|
|
|
|
|
@@ -528,6 +734,7 @@ static ssize_t lis3lv02d_position_show(struct device *dev,
|
|
|
{
|
|
|
int x, y, z;
|
|
|
|
|
|
+ lis3lv02d_sysfs_poweron(&lis3_dev);
|
|
|
mutex_lock(&lis3_dev.mutex);
|
|
|
lis3lv02d_get_xyz(&lis3_dev, &x, &y, &z);
|
|
|
mutex_unlock(&lis3_dev.mutex);
|
|
@@ -537,6 +744,7 @@ static ssize_t lis3lv02d_position_show(struct device *dev,
|
|
|
static ssize_t lis3lv02d_rate_show(struct device *dev,
|
|
|
struct device_attribute *attr, char *buf)
|
|
|
{
|
|
|
+ lis3lv02d_sysfs_poweron(&lis3_dev);
|
|
|
return sprintf(buf, "%d\n", lis3lv02d_get_odr());
|
|
|
}
|
|
|
|
|
@@ -549,6 +757,7 @@ static ssize_t lis3lv02d_rate_set(struct device *dev,
|
|
|
if (strict_strtoul(buf, 0, &rate))
|
|
|
return -EINVAL;
|
|
|
|
|
|
+ lis3lv02d_sysfs_poweron(&lis3_dev);
|
|
|
if (lis3lv02d_set_odr(rate))
|
|
|
return -EINVAL;
|
|
|
|
|
@@ -585,6 +794,18 @@ int lis3lv02d_remove_fs(struct lis3lv02d *lis3)
|
|
|
{
|
|
|
sysfs_remove_group(&lis3->pdev->dev.kobj, &lis3lv02d_attribute_group);
|
|
|
platform_device_unregister(lis3->pdev);
|
|
|
+ if (lis3->pm_dev) {
|
|
|
+ /* Barrier after the sysfs remove */
|
|
|
+ pm_runtime_barrier(lis3->pm_dev);
|
|
|
+
|
|
|
+ /* SYSFS may have left chip running. Turn off if necessary */
|
|
|
+ if (!pm_runtime_suspended(lis3->pm_dev))
|
|
|
+ lis3lv02d_poweroff(&lis3_dev);
|
|
|
+
|
|
|
+ pm_runtime_disable(lis3->pm_dev);
|
|
|
+ pm_runtime_set_suspended(lis3->pm_dev);
|
|
|
+ }
|
|
|
+ kfree(lis3->reg_cache);
|
|
|
return 0;
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(lis3lv02d_remove_fs);
|
|
@@ -616,16 +837,16 @@ static void lis3lv02d_8b_configure(struct lis3lv02d *dev,
|
|
|
if (p->wakeup_flags) {
|
|
|
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);
|
|
|
+ /* pdata value + 1 to keep this backward compatible*/
|
|
|
+ dev->write(dev, FF_WU_DURATION_1, p->duration1 + 1);
|
|
|
ctrl2 ^= HP_FF_WU1; /* Xor to keep compatible with old pdata*/
|
|
|
}
|
|
|
|
|
|
if (p->wakeup_flags2) {
|
|
|
dev->write(dev, FF_WU_CFG_2, p->wakeup_flags2);
|
|
|
dev->write(dev, FF_WU_THS_2, p->wakeup_thresh2 & 0x7f);
|
|
|
- /* default to 2.5ms for now */
|
|
|
- dev->write(dev, FF_WU_DURATION_2, 1);
|
|
|
+ /* pdata value + 1 to keep this backward compatible*/
|
|
|
+ dev->write(dev, FF_WU_DURATION_2, p->duration2 + 1);
|
|
|
ctrl2 ^= HP_FF_WU2; /* Xor to keep compatible with old pdata*/
|
|
|
}
|
|
|
/* Configure hipass filters */
|
|
@@ -635,8 +856,8 @@ static void lis3lv02d_8b_configure(struct lis3lv02d *dev,
|
|
|
err = request_threaded_irq(p->irq2,
|
|
|
NULL,
|
|
|
lis302dl_interrupt_thread2_8b,
|
|
|
- IRQF_TRIGGER_RISING |
|
|
|
- IRQF_ONESHOT,
|
|
|
+ IRQF_TRIGGER_RISING | IRQF_ONESHOT |
|
|
|
+ (p->irq_flags2 & IRQF_TRIGGER_MASK),
|
|
|
DRIVER_NAME, &lis3_dev);
|
|
|
if (err < 0)
|
|
|
printk(KERN_ERR DRIVER_NAME
|
|
@@ -652,6 +873,7 @@ int lis3lv02d_init_device(struct lis3lv02d *dev)
|
|
|
{
|
|
|
int err;
|
|
|
irq_handler_t thread_fn;
|
|
|
+ int irq_flags = 0;
|
|
|
|
|
|
dev->whoami = lis3lv02d_read_8(dev, WHO_AM_I);
|
|
|
|
|
@@ -664,6 +886,8 @@ int lis3lv02d_init_device(struct lis3lv02d *dev)
|
|
|
dev->odrs = lis3_12_rates;
|
|
|
dev->odr_mask = CTRL1_DF0 | CTRL1_DF1;
|
|
|
dev->scale = LIS3_SENSITIVITY_12B;
|
|
|
+ dev->regs = lis3_wai12_regs;
|
|
|
+ dev->regs_size = ARRAY_SIZE(lis3_wai12_regs);
|
|
|
break;
|
|
|
case WAI_8B:
|
|
|
printk(KERN_INFO DRIVER_NAME ": 8 bits sensor found\n");
|
|
@@ -673,6 +897,17 @@ int lis3lv02d_init_device(struct lis3lv02d *dev)
|
|
|
dev->odrs = lis3_8_rates;
|
|
|
dev->odr_mask = CTRL1_DR;
|
|
|
dev->scale = LIS3_SENSITIVITY_8B;
|
|
|
+ dev->regs = lis3_wai8_regs;
|
|
|
+ dev->regs_size = ARRAY_SIZE(lis3_wai8_regs);
|
|
|
+ break;
|
|
|
+ case WAI_3DC:
|
|
|
+ printk(KERN_INFO DRIVER_NAME ": 8 bits 3DC sensor found\n");
|
|
|
+ dev->read_data = lis3lv02d_read_8;
|
|
|
+ dev->mdps_max_val = 128;
|
|
|
+ dev->pwron_delay = LIS3_PWRON_DELAY_WAI_8B;
|
|
|
+ dev->odrs = lis3_3dc_rates;
|
|
|
+ dev->odr_mask = CTRL1_ODR0|CTRL1_ODR1|CTRL1_ODR2|CTRL1_ODR3;
|
|
|
+ dev->scale = LIS3_SENSITIVITY_8B;
|
|
|
break;
|
|
|
default:
|
|
|
printk(KERN_ERR DRIVER_NAME
|
|
@@ -680,11 +915,25 @@ int lis3lv02d_init_device(struct lis3lv02d *dev)
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
|
|
|
+ dev->reg_cache = kzalloc(max(sizeof(lis3_wai8_regs),
|
|
|
+ sizeof(lis3_wai12_regs)), GFP_KERNEL);
|
|
|
+
|
|
|
+ if (dev->reg_cache == NULL) {
|
|
|
+ printk(KERN_ERR DRIVER_NAME "out of memory\n");
|
|
|
+ return -ENOMEM;
|
|
|
+ }
|
|
|
+
|
|
|
mutex_init(&dev->mutex);
|
|
|
+ atomic_set(&dev->wake_thread, 0);
|
|
|
|
|
|
lis3lv02d_add_fs(dev);
|
|
|
lis3lv02d_poweron(dev);
|
|
|
|
|
|
+ if (dev->pm_dev) {
|
|
|
+ pm_runtime_set_active(dev->pm_dev);
|
|
|
+ pm_runtime_enable(dev->pm_dev);
|
|
|
+ }
|
|
|
+
|
|
|
if (lis3lv02d_joystick_enable())
|
|
|
printk(KERN_ERR DRIVER_NAME ": joystick initialization failed\n");
|
|
|
|
|
@@ -696,8 +945,14 @@ int lis3lv02d_init_device(struct lis3lv02d *dev)
|
|
|
if (dev->whoami == WAI_8B)
|
|
|
lis3lv02d_8b_configure(dev, p);
|
|
|
|
|
|
+ irq_flags = p->irq_flags1 & IRQF_TRIGGER_MASK;
|
|
|
+
|
|
|
+ dev->irq_cfg = p->irq_cfg;
|
|
|
if (p->irq_cfg)
|
|
|
dev->write(dev, CTRL_REG3, p->irq_cfg);
|
|
|
+
|
|
|
+ if (p->default_rate)
|
|
|
+ lis3lv02d_set_odr(p->default_rate);
|
|
|
}
|
|
|
|
|
|
/* bail if we did not get an IRQ from the bus layer */
|
|
@@ -725,7 +980,8 @@ int lis3lv02d_init_device(struct lis3lv02d *dev)
|
|
|
|
|
|
err = request_threaded_irq(dev->irq, lis302dl_interrupt,
|
|
|
thread_fn,
|
|
|
- IRQF_TRIGGER_RISING | IRQF_ONESHOT,
|
|
|
+ IRQF_TRIGGER_RISING | IRQF_ONESHOT |
|
|
|
+ irq_flags,
|
|
|
DRIVER_NAME, &lis3_dev);
|
|
|
|
|
|
if (err < 0) {
|