Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history
yaml
---
r: 176409
b: refs/heads/master
c: 641615a
h: refs/heads/master
i:
  176407: 872a9d9
v: v3
  • Loading branch information
Samu Onkalo authored and Linus Torvalds committed Dec 15, 2009
1 parent fe92aec commit a158394
Show file tree
Hide file tree
Showing 3 changed files with 29 additions and 15 deletions.
2 changes: 1 addition & 1 deletion [refs]
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: 4b5d95b3809bcd77599122494aa3f575cd6ab1b9
refs/heads/master: 641615abfac0b7c5e6f242a6db77f7690925b443
41 changes: 27 additions & 14 deletions trunk/drivers/hwmon/lis3lv02d.c
Original file line number Diff line number Diff line change
Expand Up @@ -50,6 +50,9 @@
* joystick.
*/

#define LIS3_PWRON_DELAY_WAI_12B (5000)
#define LIS3_PWRON_DELAY_WAI_8B (3000)

struct lis3lv02d lis3_dev = {
.misc_wait = __WAIT_QUEUE_HEAD_INITIALIZER(lis3_dev.misc_wait),
};
Expand Down Expand Up @@ -112,6 +115,24 @@ static void lis3lv02d_get_xyz(struct lis3lv02d *lis3, int *x, int *y, int *z)
*z = lis3lv02d_get_axis(lis3->ac.z, position);
}

/* 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 lis3lv02d_get_odr(void)
{
u8 ctrl;
int val;

lis3_dev.read(&lis3_dev, CTRL_REG1, &ctrl);

if (lis3_dev.whoami == WAI_12B)
val = lis3_12_rates[(ctrl & (CTRL1_DF0 | CTRL1_DF1)) >> 4];
else
val = lis3_8_rates[(ctrl & CTRL1_DR) >> 7];
return val;
}

void lis3lv02d_poweroff(struct lis3lv02d *lis3)
{
/* disable X,Y,Z axis and power down */
Expand All @@ -125,6 +146,9 @@ 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
Expand Down Expand Up @@ -364,23 +388,10 @@ static ssize_t lis3lv02d_calibrate_store(struct device *dev,
return count;
}

/* 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 ssize_t lis3lv02d_rate_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
u8 ctrl;
int val;

lis3_dev.read(&lis3_dev, CTRL_REG1, &ctrl);

if (lis3_dev.whoami == WAI_12B)
val = lis3_12_rates[(ctrl & (CTRL1_DF0 | CTRL1_DF1)) >> 4];
else
val = lis3_8_rates[(ctrl & CTRL1_DR) >> 7];

return sprintf(buf, "%d\n", val);
return sprintf(buf, "%d\n", lis3lv02d_get_odr());
}

static DEVICE_ATTR(position, S_IRUGO, lis3lv02d_position_show, NULL);
Expand Down Expand Up @@ -430,11 +441,13 @@ int lis3lv02d_init_device(struct lis3lv02d *dev)
printk(KERN_INFO DRIVER_NAME ": 12 bits sensor found\n");
dev->read_data = lis3lv02d_read_12;
dev->mdps_max_val = 2048;
dev->pwron_delay = LIS3_PWRON_DELAY_WAI_12B;
break;
case WAI_8B:
printk(KERN_INFO DRIVER_NAME ": 8 bits sensor found\n");
dev->read_data = lis3lv02d_read_8;
dev->mdps_max_val = 128;
dev->pwron_delay = LIS3_PWRON_DELAY_WAI_8B;
break;
default:
printk(KERN_ERR DRIVER_NAME
Expand Down
1 change: 1 addition & 0 deletions trunk/drivers/hwmon/lis3lv02d.h
Original file line number Diff line number Diff line change
Expand Up @@ -202,6 +202,7 @@ struct lis3lv02d {
u8 whoami; /* indicates measurement precision */
s16 (*read_data) (struct lis3lv02d *lis3, int reg);
int mdps_max_val;
int pwron_delay;

struct input_polled_dev *idev; /* input device */
struct platform_device *pdev; /* platform device */
Expand Down

0 comments on commit a158394

Please sign in to comment.