mirror of
https://github.com/torvalds/linux.git
synced 2026-06-09 23:23:53 +02:00
Merge branch 'develop' of 10.10.10.29:/home/rockchip/kernel into develop
This commit is contained in:
cwz
commit
fa54e18945
|
|
@ -1406,6 +1406,38 @@ struct platform_device rk28_device_headset = {
|
|||
};
|
||||
#endif
|
||||
|
||||
#if defined(CONFIG_GS_L3G4200D)
|
||||
|
||||
#include <linux/l3g4200d.h>
|
||||
#define L3G4200D_INT_PIN RK29_PIN5_PA3
|
||||
|
||||
static int l3g4200d_init_platform_hw(void)
|
||||
{
|
||||
if (gpio_request(L3G4200D_INT_PIN, NULL) != 0) {
|
||||
gpio_free(L3G4200D_INT_PIN);
|
||||
printk("%s: request l3g4200d int pin error\n", __func__);
|
||||
return -EIO;
|
||||
}
|
||||
gpio_pull_updown(L3G4200D_INT_PIN, 1);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct l3g4200d_platform_data l3g4200d_info = {
|
||||
.fs_range = 1,
|
||||
|
||||
.axis_map_x = 0,
|
||||
.axis_map_y = 1,
|
||||
.axis_map_z = 2,
|
||||
|
||||
.negate_x = 1,
|
||||
.negate_y = 1,
|
||||
.negate_z = 0,
|
||||
|
||||
.init = l3g4200d_init_platform_hw,
|
||||
};
|
||||
|
||||
#endif
|
||||
|
||||
/*****************************************************************************************
|
||||
* i2c devices
|
||||
* author: kfx@rock-chips.com
|
||||
|
|
@ -1569,6 +1601,15 @@ static struct i2c_board_info __initdata board_i2c0_devices[] = {
|
|||
.irq = RK29_PIN2_PA3,
|
||||
},
|
||||
#endif
|
||||
#if defined (CONFIG_GS_L3G4200D)
|
||||
{
|
||||
.type = "gs_l3g4200d",
|
||||
.addr = 0x69,
|
||||
.flags = 0,
|
||||
.irq = L3G4200D_INT_PIN,
|
||||
.platform_data = &l3g4200d_info,
|
||||
},
|
||||
#endif
|
||||
};
|
||||
#endif
|
||||
|
||||
|
|
|
|||
|
|
@ -26,4 +26,13 @@ config GS_MMA8452
|
|||
help
|
||||
To have support for your specific gsesnor you will have to
|
||||
select the proper drivers which depend on this option.
|
||||
|
||||
config GS_L3G4200D
|
||||
bool "gs_l3g4200d"
|
||||
depends on G_SENSOR_DEVICE
|
||||
default y
|
||||
help
|
||||
To have support for your specific gsesnor you will have to
|
||||
select the proper drivers which depend on this option.
|
||||
|
||||
endif
|
||||
|
|
|
|||
|
|
@ -2,3 +2,4 @@
|
|||
|
||||
obj-$(CONFIG_GS_MMA7660) += mma7660.o
|
||||
obj-$(CONFIG_GS_MMA8452) += mma8452.o
|
||||
obj-$(CONFIG_GS_L3G4200D) += l3g4200d.o
|
||||
|
|
|
|||
879
drivers/input/gsensor/l3g4200d.c
Executable file
879
drivers/input/gsensor/l3g4200d.c
Executable file
|
|
@ -0,0 +1,879 @@
|
|||
/* drivers/i2c/chips/l3g4200d.c - l3g4200d compass driver
|
||||
*
|
||||
* Copyright (C) 2007-2008 HTC Corporation.
|
||||
* Author: Hou-Kun Chen <houkun.chen@gmail.com>
|
||||
*
|
||||
* This software is licensed under the terms of the GNU General Public
|
||||
* License version 2, as published by the Free Software Foundation, and
|
||||
* may be copied, distributed, and modified under those terms.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/miscdevice.h>
|
||||
#include <linux/gpio.h>
|
||||
#include <asm/uaccess.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/workqueue.h>
|
||||
#include <linux/freezer.h>
|
||||
#include <linux/l3g4200d.h>
|
||||
#include <mach/gpio.h>
|
||||
#include <mach/board.h>
|
||||
#ifdef CONFIG_HAS_EARLYSUSPEND
|
||||
#include <linux/earlysuspend.h>
|
||||
#endif
|
||||
|
||||
#if 1
|
||||
#define mmaprintk(x...) printk(x)
|
||||
#else
|
||||
#define mmaprintk(x...)
|
||||
#endif
|
||||
static int l3g4200d_probe(struct i2c_client *client, const struct i2c_device_id *id);
|
||||
|
||||
#define L3G4200D_SPEED 200 * 1000
|
||||
#define L3G4200D_DEVID 0xD3
|
||||
|
||||
#define L3G4200D_MAJOR 102
|
||||
#define L3G4200D_MINOR 4
|
||||
|
||||
/* l3g4200d gyroscope registers */
|
||||
#define WHO_AM_I 0x0F
|
||||
|
||||
#define CTRL_REG1 0x20 /* power control reg */
|
||||
#define CTRL_REG2 0x21 /* power control reg */
|
||||
#define CTRL_REG3 0x22 /* power control reg */
|
||||
#define CTRL_REG4 0x23 /* interrupt control reg */
|
||||
#define CTRL_REG5 0x24 /* interrupt control reg */
|
||||
#define AXISDATA_REG 0x28
|
||||
|
||||
|
||||
/* Addresses to scan -- protected by sense_data_mutex */
|
||||
//static char sense_data[RBUFF_SIZE + 1];
|
||||
static struct i2c_client *this_client;
|
||||
static struct l3g4200d_data *this_data;
|
||||
static struct miscdevice l3g4200d_device;
|
||||
|
||||
static DECLARE_WAIT_QUEUE_HEAD(data_ready_wq);
|
||||
|
||||
#ifdef CONFIG_HAS_EARLYSUSPEND
|
||||
static struct early_suspend l3g4200d_early_suspend;
|
||||
#endif
|
||||
static int revision = -1;
|
||||
/* AKM HW info */
|
||||
static ssize_t gsensor_vendor_show(struct device *dev,
|
||||
struct device_attribute *attr, char *buf)
|
||||
{
|
||||
ssize_t ret = 0;
|
||||
|
||||
sprintf(buf, "%#x\n", revision);
|
||||
ret = strlen(buf) + 1;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static DEVICE_ATTR(vendor, 0444, gsensor_vendor_show, NULL);
|
||||
|
||||
static struct kobject *android_gsensor_kobj;
|
||||
|
||||
static int gsensor_sysfs_init(void)
|
||||
{
|
||||
int ret ;
|
||||
|
||||
android_gsensor_kobj = kobject_create_and_add("android_gyrosensor", NULL);
|
||||
if (android_gsensor_kobj == NULL) {
|
||||
mmaprintk(KERN_ERR
|
||||
"L3G4200D gsensor_sysfs_init:"\
|
||||
"subsystem_register failed\n");
|
||||
ret = -ENOMEM;
|
||||
goto err;
|
||||
}
|
||||
|
||||
ret = sysfs_create_file(android_gsensor_kobj, &dev_attr_vendor.attr);
|
||||
if (ret) {
|
||||
mmaprintk(KERN_ERR
|
||||
"L3G4200D gsensor_sysfs_init:"\
|
||||
"sysfs_create_group failed\n");
|
||||
goto err4;
|
||||
}
|
||||
|
||||
return 0 ;
|
||||
err4:
|
||||
kobject_del(android_gsensor_kobj);
|
||||
err:
|
||||
return ret ;
|
||||
}
|
||||
|
||||
#if 0
|
||||
static int l3g4200d_rx_data(struct i2c_client *client, char *rxData, int length)
|
||||
{
|
||||
int ret = 0;
|
||||
char reg = rxData[0];
|
||||
ret = i2c_master_reg8_recv(client, reg, rxData, length, L3G4200D_SPEED);
|
||||
return (ret > 0)? 0 : ret;
|
||||
}
|
||||
#else
|
||||
static int l3g4200d_rx_data(struct i2c_client *client, char *rxData, int length)
|
||||
{
|
||||
int ret = 0;
|
||||
int retry = 3;
|
||||
char reg = rxData[0];
|
||||
again:
|
||||
ret = i2c_master_reg8_recv(client, reg, rxData, length, L3G4200D_SPEED);
|
||||
if(ret < 0)
|
||||
{
|
||||
retry--;
|
||||
mdelay(1);
|
||||
goto again;
|
||||
}
|
||||
return (ret > 0)? 0 : ret;
|
||||
}
|
||||
#endif
|
||||
#if 0
|
||||
static int l3g4200d_tx_data(struct i2c_client *client, char *txData, int length)
|
||||
{
|
||||
int ret = 0;
|
||||
char reg = txData[0];
|
||||
ret = i2c_master_reg8_send(client, reg, &txData[1], length-1, L3G4200D_SPEED);
|
||||
return (ret > 0)? 0 : ret;
|
||||
}
|
||||
#else
|
||||
static int l3g4200d_tx_data(struct i2c_client *client, char *txData, int length)
|
||||
{
|
||||
int ret = 0;
|
||||
char reg = txData[0];
|
||||
int retry = 3;
|
||||
again:
|
||||
ret = i2c_master_reg8_send(client, reg, &txData[1], length-1, L3G4200D_SPEED);
|
||||
if(ret < 0)
|
||||
{
|
||||
retry--;
|
||||
mdelay(1);
|
||||
goto again;
|
||||
}
|
||||
return (ret > 0)? 0 : ret;
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
static int gyro_rx_data(struct i2c_client *client, char *rxData, int length)
|
||||
{
|
||||
int ret = 0;
|
||||
int retry = 3;
|
||||
char reg = rxData[0];
|
||||
again:
|
||||
ret = i2c_master_reg8_recv(client, reg, rxData, length, L3G4200D_SPEED);
|
||||
if(ret < 0)
|
||||
{
|
||||
retry--;
|
||||
mdelay(1);
|
||||
goto again;
|
||||
}
|
||||
return (ret > 0)? 0 : ret;
|
||||
}
|
||||
|
||||
static int gyro_tx_data(struct i2c_client *client, char *txData, int length)
|
||||
{
|
||||
int ret = 0;
|
||||
char reg = txData[0];
|
||||
int retry = 3;
|
||||
again:
|
||||
ret = i2c_master_reg8_send(client, reg, &txData[1], length-1, L3G4200D_SPEED);
|
||||
if(ret < 0)
|
||||
{
|
||||
retry--;
|
||||
mdelay(1);
|
||||
goto again;
|
||||
}
|
||||
return (ret > 0)? 0 : ret;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
/* i2c read routine for l3g4200d digital gyroscope */
|
||||
static char l3g4200d_i2c_read(unsigned char reg_addr,
|
||||
unsigned char *data,
|
||||
unsigned char len)
|
||||
{
|
||||
char tmp;
|
||||
int ret = 0;
|
||||
if (this_client == NULL) /* No global client pointer? */
|
||||
return -1;
|
||||
|
||||
data[0]=reg_addr;
|
||||
ret = gyro_rx_data(this_client, data, len);
|
||||
return tmp;
|
||||
}
|
||||
/* i2c write routine for l3g4200d digital gyroscope */
|
||||
static char l3g4200d_i2c_write(unsigned char reg_addr,
|
||||
unsigned char *data,
|
||||
unsigned char len)
|
||||
{
|
||||
|
||||
char buffer[3];
|
||||
int ret = 0;
|
||||
int i = 0;
|
||||
if (this_client == NULL) /* No global client pointer? */
|
||||
return -1;
|
||||
for (i = 0; i < len; i++)
|
||||
{
|
||||
buffer[0] = reg_addr+i;
|
||||
buffer[1] = data[i];
|
||||
ret = gyro_tx_data(this_client, &buffer[0], 2);
|
||||
}
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
static char l3g4200d_read_reg(struct i2c_client *client,int addr)
|
||||
{
|
||||
char tmp;
|
||||
int ret = 0;
|
||||
|
||||
tmp = addr;
|
||||
// ret = l3g4200d_tx_data(client, &tmp, 1);
|
||||
ret = l3g4200d_rx_data(client, &tmp, 1);
|
||||
return tmp;
|
||||
}
|
||||
|
||||
static int l3g4200d_write_reg(struct i2c_client *client,int addr,int value)
|
||||
{
|
||||
char buffer[3];
|
||||
int ret = 0;
|
||||
|
||||
buffer[0] = addr;
|
||||
buffer[1] = value;
|
||||
ret = l3g4200d_tx_data(client, &buffer[0], 2);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
static char l3g4200d_get_devid(struct i2c_client *client)
|
||||
{
|
||||
int tempvalue;
|
||||
tempvalue=l3g4200d_read_reg(client, WHO_AM_I);
|
||||
if ((tempvalue & 0x00FF) == 0x00D3) {
|
||||
#if DEBUG
|
||||
printk(KERN_INFO "I2C driver registered!\n");
|
||||
#endif
|
||||
return 1;
|
||||
} else {
|
||||
|
||||
#if DEBUG
|
||||
printk(KERN_INFO "I2C driver %d!\n",tempvalue);
|
||||
#endif
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
static int l3g4200d_active(struct i2c_client *client,int enable)
|
||||
{
|
||||
int tmp;
|
||||
int ret = 0;
|
||||
|
||||
tmp = l3g4200d_read_reg(client,CTRL_REG1);
|
||||
if(enable)
|
||||
tmp |=ACTIVE_MASK;
|
||||
else
|
||||
tmp &=~ACTIVE_MASK;
|
||||
mmaprintk("l3g4200d_active %s (0x%x)\n",enable?"active":"standby",tmp);
|
||||
ret = l3g4200d_write_reg(client,CTRL_REG1,tmp);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
|
||||
static int device_init(void)
|
||||
{
|
||||
int res;
|
||||
unsigned char buf[5];
|
||||
buf[0] = 0x07; //27
|
||||
buf[1] = 0x00;
|
||||
buf[2] = 0x00;
|
||||
buf[3] = 0x20; //0x00
|
||||
buf[4] = 0x00;
|
||||
res = l3g4200d_i2c_write(CTRL_REG1, &buf[0], 5);
|
||||
return res;
|
||||
}
|
||||
|
||||
int l3g4200d_set_bandwidth(char bw)
|
||||
{
|
||||
int res = 0;
|
||||
unsigned char data;
|
||||
|
||||
res = l3g4200d_read_reg(this_client, CTRL_REG1);
|
||||
if (res >= 0)
|
||||
data = res & 0x000F;
|
||||
|
||||
data = data + bw;
|
||||
res = l3g4200d_i2c_write(CTRL_REG1, &data, 1);
|
||||
return res;
|
||||
}
|
||||
|
||||
static int l3g4200d_start_dev(struct i2c_client *client, char rate)
|
||||
{
|
||||
int ret = 0;
|
||||
int tmp;
|
||||
struct l3g4200d_data *l3g4200d = (struct l3g4200d_data *)i2c_get_clientdata(client);
|
||||
|
||||
/* standby */
|
||||
l3g4200d_active(client,0);
|
||||
device_init();
|
||||
l3g4200d_set_bandwidth(rate);
|
||||
l3g4200d_active(client,1);
|
||||
|
||||
enable_irq(client->irq);
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
static int l3g4200d_start(struct i2c_client *client, char rate)
|
||||
{
|
||||
struct l3g4200d_data *l3g4200d = (struct l3g4200d_data *)i2c_get_clientdata(client);
|
||||
|
||||
printk("%s::enter\n",__FUNCTION__);
|
||||
if (l3g4200d->status == L3G4200D_OPEN) {
|
||||
return 0;
|
||||
}
|
||||
l3g4200d->status = L3G4200D_OPEN;
|
||||
return l3g4200d_start_dev(client, rate);
|
||||
}
|
||||
|
||||
static int l3g4200d_close_dev(struct i2c_client *client)
|
||||
{
|
||||
mmaprintk("%s :enter\n",__FUNCTION__);
|
||||
disable_irq_nosync(client->irq);
|
||||
return l3g4200d_active(client,0);
|
||||
}
|
||||
|
||||
static int l3g4200d_close(struct i2c_client *client)
|
||||
{
|
||||
struct l3g4200d_data *l3g4200d = (struct l3g4200d_data *)i2c_get_clientdata(client);
|
||||
printk("%s::enter\n",__FUNCTION__);
|
||||
l3g4200d->status = L3G4200D_CLOSE;
|
||||
|
||||
return l3g4200d_close_dev(client);
|
||||
}
|
||||
|
||||
static int l3g4200d_reset_rate(struct i2c_client *client, char rate)
|
||||
{
|
||||
int ret = 0;
|
||||
|
||||
mmaprintk("\n----------------------------l3g4200d_reset_rate------------------------\n");
|
||||
|
||||
ret = l3g4200d_close_dev(client);
|
||||
ret = l3g4200d_start_dev(client, rate);
|
||||
|
||||
return ret ;
|
||||
}
|
||||
|
||||
static inline int l3g4200d_convert_to_int(char value)
|
||||
{
|
||||
int result;
|
||||
|
||||
if (value < 1) {
|
||||
result = value * 1;
|
||||
} else {
|
||||
result = ~(((~value & 0x7f) + 1)* 1) + 1;
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
static void l3g4200d_report_value(struct i2c_client *client, struct l3g4200d_axis *axis)
|
||||
{
|
||||
struct l3g4200d_data *l3g4200d = i2c_get_clientdata(client);
|
||||
//struct l3g4200d_axis *axis = (struct l3g4200d_axis *)rbuf;
|
||||
|
||||
/* Report acceleration sensor information */
|
||||
input_report_abs(l3g4200d->input_dev, ABS_RX, axis->x);
|
||||
input_report_abs(l3g4200d->input_dev, ABS_RY, axis->y);
|
||||
input_report_abs(l3g4200d->input_dev, ABS_RZ, axis->z);
|
||||
input_sync(l3g4200d->input_dev);
|
||||
mmaprintk("Gsensor x==%d y==%d z==%d\n",axis->x,axis->y,axis->z);
|
||||
}
|
||||
|
||||
|
||||
static int l3g4200d_get_data(struct i2c_client *client)
|
||||
{
|
||||
char buffer[6];
|
||||
int ret,i;
|
||||
struct l3g4200d_axis axis;
|
||||
struct l3g4200d_platform_data *pdata = pdata = client->dev.platform_data;
|
||||
|
||||
int res;
|
||||
unsigned char gyro_data[6];
|
||||
/* x,y,z hardware data */
|
||||
int hw_d[3] = { 0 };
|
||||
|
||||
for(i=0;i<6;i++)
|
||||
{
|
||||
gyro_data[i] = AXISDATA_REG+i;
|
||||
//ret = l3g4200d_tx_data(client, &buffer[0], 1);
|
||||
ret = l3g4200d_rx_data(client, &gyro_data[i], 1);
|
||||
}
|
||||
|
||||
hw_d[0] = (short) (((gyro_data[1]) << 8) | gyro_data[0]);
|
||||
hw_d[1] = (short) (((gyro_data[3]) << 8) | gyro_data[2]);
|
||||
hw_d[2] = (short) (((gyro_data[5]) << 8) | gyro_data[4]);
|
||||
|
||||
//mmaprintk("Gsensor x==%d y==%d z==%d x==%d y==%d z==%d\n",gyro_data[0],gyro_data[1],gyro_data[2],gyro_data[3],gyro_data[4],gyro_data[5]);
|
||||
|
||||
|
||||
axis.x = ((this_data->pdata->negate_x) ? (-hw_d[this_data->pdata->axis_map_x])
|
||||
: (hw_d[this_data->pdata->axis_map_x]));
|
||||
axis.y = ((this_data->pdata->negate_y) ? (-hw_d[this_data->pdata->axis_map_y])
|
||||
: (hw_d[this_data->pdata->axis_map_y]));
|
||||
axis.z = ((this_data->pdata->negate_z) ? (-hw_d[this_data->pdata->axis_map_z])
|
||||
: (hw_d[this_data->pdata->axis_map_z]));
|
||||
|
||||
l3g4200d_report_value(client, &axis);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
static int l3g4200d_trans_buff(char *rbuf, int size)
|
||||
{
|
||||
//wait_event_interruptible_timeout(data_ready_wq,
|
||||
// atomic_read(&data_ready), 1000);
|
||||
wait_event_interruptible(data_ready_wq,
|
||||
atomic_read(&data_ready));
|
||||
|
||||
atomic_set(&data_ready, 0);
|
||||
memcpy(rbuf, &sense_data[0], size);
|
||||
|
||||
return 0;
|
||||
}
|
||||
*/
|
||||
|
||||
static int l3g4200d_open(struct inode *inode, struct file *file)
|
||||
{
|
||||
mmaprintk("%s :enter\n",__FUNCTION__);
|
||||
return 0;//nonseekable_open(inode, file);
|
||||
}
|
||||
|
||||
static int l3g4200d_release(struct inode *inode, struct file *file)
|
||||
{
|
||||
mmaprintk("%s :enter\n",__FUNCTION__);
|
||||
return 0;
|
||||
}
|
||||
#define RBUFF_SIZE 12 /* Rx buffer size */
|
||||
|
||||
static int l3g4200d_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
|
||||
unsigned long arg)
|
||||
{
|
||||
|
||||
struct l3g4200d_data *l3g4200d = (struct l3g4200d_data *)i2c_get_clientdata(this_client);
|
||||
void __user *argp = (void __user *)arg;
|
||||
char msg[RBUFF_SIZE + 1];
|
||||
int ret = -1;
|
||||
char rate;
|
||||
struct i2c_client *client = container_of(l3g4200d_device.parent, struct i2c_client, dev);
|
||||
printk(KERN_ERR "l3g4200d_ioctl,%d,%d,%d,%d,%d,%d,%d\n",cmd,GYROSENSOR_IOCTL_ENABLE,GYROSENSOR_IOCTL_GET_ENABLED,ECS_IOCTL_APP_GET_ABS,ECS_IOCTL_START,ECS_IOCTL_CLOSE,ECS_IOCTL_APP_SET_RATE);
|
||||
switch (cmd) {
|
||||
case ECS_IOCTL_APP_SET_RATE:
|
||||
if (copy_from_user(&rate, argp, sizeof(rate)))
|
||||
return -EFAULT;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
switch (cmd) {
|
||||
case ECS_IOCTL_START:
|
||||
case GYROSENSOR_IOCTL_ENABLE:
|
||||
ret = l3g4200d_start(client, ODR100_BW12_5);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
break;
|
||||
case ECS_IOCTL_CLOSE:
|
||||
ret = l3g4200d_close(client);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
break;
|
||||
case ECS_IOCTL_APP_SET_RATE:
|
||||
ret = l3g4200d_reset_rate(client, 0x00);//rate<<4);//0x20
|
||||
printk(KERN_ERR "%d\n",rate);
|
||||
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
break;
|
||||
case GYROSENSOR_IOCTL_GET_ENABLED:
|
||||
break;
|
||||
/*
|
||||
case ECS_IOCTL_GETDATA:
|
||||
ret = l3g4200d_trans_buff(msg, RBUFF_SIZE);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
break;
|
||||
*/
|
||||
default:
|
||||
return -ENOTTY;
|
||||
}
|
||||
|
||||
switch (cmd) {
|
||||
case ECS_IOCTL_GETDATA:
|
||||
case ECS_IOCTL_APP_GET_ABS:
|
||||
if (copy_to_user(argp, &msg, sizeof(msg)))
|
||||
return -EFAULT;
|
||||
break;
|
||||
case GYROSENSOR_IOCTL_GET_ENABLED:
|
||||
mmaprintk("%s :enter\n",__FUNCTION__);
|
||||
ret=!l3g4200d->status;
|
||||
if (copy_to_user(argp, &ret, sizeof(ret)))
|
||||
return 0;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void l3g4200d_work_func(struct work_struct *work)
|
||||
{
|
||||
struct l3g4200d_data *l3g4200d = container_of(work, struct l3g4200d_data, work);
|
||||
struct i2c_client *client = l3g4200d->client;
|
||||
|
||||
if (l3g4200d_get_data(client) < 0)
|
||||
mmaprintk(KERN_ERR "L3G4200D mma_work_func: Get data failed\n");
|
||||
|
||||
enable_irq(client->irq);
|
||||
}
|
||||
|
||||
static void l3g4200d_delaywork_func(struct work_struct *work)
|
||||
{
|
||||
struct delayed_work *delaywork = container_of(work, struct delayed_work, work);
|
||||
struct l3g4200d_data *l3g4200d = container_of(delaywork, struct l3g4200d_data, delaywork);
|
||||
struct i2c_client *client = l3g4200d->client;
|
||||
|
||||
if (l3g4200d_get_data(client) < 0)
|
||||
mmaprintk(KERN_ERR "L3G4200D mma_work_func: Get data failed\n");
|
||||
enable_irq(client->irq);
|
||||
}
|
||||
|
||||
static irqreturn_t l3g4200d_interrupt(int irq, void *dev_id)
|
||||
{
|
||||
struct l3g4200d_data *l3g4200d = (struct l3g4200d_data *)dev_id;
|
||||
|
||||
disable_irq_nosync(irq);
|
||||
schedule_delayed_work(&l3g4200d->delaywork, msecs_to_jiffies(200));
|
||||
//mmaprintk("%s :enter\n",__FUNCTION__);
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static struct file_operations l3g4200d_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.open = l3g4200d_open,
|
||||
.release = l3g4200d_release,
|
||||
.ioctl = l3g4200d_ioctl,
|
||||
};
|
||||
|
||||
static struct miscdevice l3g4200d_device = {
|
||||
.minor = MISC_DYNAMIC_MINOR,
|
||||
.name = "gyrosensor",//"l3g4200d_daemon",
|
||||
.fops = &l3g4200d_fops,
|
||||
};
|
||||
|
||||
static int l3g4200d_remove(struct i2c_client *client)
|
||||
{
|
||||
struct l3g4200d_data *l3g4200d = i2c_get_clientdata(client);
|
||||
|
||||
misc_deregister(&l3g4200d_device);
|
||||
input_unregister_device(l3g4200d->input_dev);
|
||||
input_free_device(l3g4200d->input_dev);
|
||||
free_irq(client->irq, l3g4200d);
|
||||
kfree(l3g4200d);
|
||||
#ifdef CONFIG_HAS_EARLYSUSPEND
|
||||
unregister_early_suspend(&l3g4200d_early_suspend);
|
||||
#endif
|
||||
this_client = NULL;
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_HAS_EARLYSUSPEND
|
||||
static void l3g4200d_suspend(struct early_suspend *h)
|
||||
{
|
||||
struct i2c_client *client = container_of(l3g4200d_device.parent, struct i2c_client, dev);
|
||||
struct l3g4200d_data *l3g4200d = (struct l3g4200d_data *)i2c_get_clientdata(client);
|
||||
// if(l3g4200d->status == L3G4200D_OPEN)
|
||||
// {
|
||||
//l3g4200d->status = L3G4200D_SUSPEND;
|
||||
// l3g4200d_close_dev(client);
|
||||
// }
|
||||
}
|
||||
|
||||
static void l3g4200d_resume(struct early_suspend *h)
|
||||
{
|
||||
struct i2c_client *client = container_of(l3g4200d_device.parent, struct i2c_client, dev);
|
||||
struct l3g4200d_data *l3g4200d = (struct l3g4200d_data *)i2c_get_clientdata(client);
|
||||
mmaprintk("Gsensor mma7760 resume!! l3g4200d->status %d\n",l3g4200d->status);
|
||||
//if((l3g4200d->status == L3G4200D_SUSPEND) && (l3g4200d->status != L3G4200D_OPEN))
|
||||
// if (l3g4200d->status == L3G4200D_OPEN)
|
||||
// l3g4200d_start_dev(client,l3g4200d->curr_tate);
|
||||
}
|
||||
#else
|
||||
static int l3g4200d_suspend(struct i2c_client *client, pm_message_t mesg)
|
||||
{
|
||||
int ret;
|
||||
mmaprintk("Gsensor mma7760 enter 2 level suspend l3g4200d->status %d\n",l3g4200d->status);
|
||||
struct l3g4200d_data *l3g4200d = (struct l3g4200d_data *)i2c_get_clientdata(client);
|
||||
// if(l3g4200d->status == L3G4200D_OPEN)
|
||||
// {
|
||||
// l3g4200d->status = L3G4200D_SUSPEND;
|
||||
// ret = l3g4200d_close_dev(client);
|
||||
// }
|
||||
return ret;
|
||||
}
|
||||
static int l3g4200d_resume(struct i2c_client *client)
|
||||
{
|
||||
int ret;
|
||||
struct l3g4200d_data *l3g4200d = (struct l3g4200d_data *)i2c_get_clientdata(client);
|
||||
mmaprintk("Gsensor mma7760 2 level resume!! l3g4200d->status %d\n",l3g4200d->status);
|
||||
// if((l3g4200d->status == L3G4200D_SUSPEND) && (l3g4200d->status != L3G4200D_OPEN))
|
||||
//if (l3g4200d->status == L3G4200D_OPEN)
|
||||
// ret = l3g4200d_start_dev(client, l3g4200d->curr_tate);
|
||||
return ret;
|
||||
}
|
||||
#endif
|
||||
|
||||
static const struct i2c_device_id l3g4200d_id[] = {
|
||||
{"gs_l3g4200d", 0},
|
||||
{ }
|
||||
};
|
||||
|
||||
static struct i2c_driver l3g4200d_driver = {
|
||||
.driver = {
|
||||
.name = "gs_l3g4200d",
|
||||
},
|
||||
.id_table = l3g4200d_id,
|
||||
.probe = l3g4200d_probe,
|
||||
.remove = __devexit_p(l3g4200d_remove),
|
||||
#ifndef CONFIG_HAS_EARLYSUSPEND
|
||||
.suspend = &l3g4200d_suspend,
|
||||
.resume = &l3g4200d_resume,
|
||||
#endif
|
||||
};
|
||||
|
||||
|
||||
static int l3g4200d_init_client(struct i2c_client *client)
|
||||
{
|
||||
struct l3g4200d_data *l3g4200d;
|
||||
int ret;
|
||||
l3g4200d = i2c_get_clientdata(client);
|
||||
mmaprintk("gpio_to_irq(%d) is %d\n",client->irq,gpio_to_irq(client->irq));
|
||||
if ( !gpio_is_valid(client->irq)) {
|
||||
mmaprintk("+++++++++++gpio_is_invalid\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
ret = gpio_request(client->irq, "l3g4200d_int");
|
||||
if (ret) {
|
||||
mmaprintk( "failed to request mma7990_trig GPIO%d\n",gpio_to_irq(client->irq));
|
||||
return ret;
|
||||
}
|
||||
ret = gpio_direction_input(client->irq);
|
||||
if (ret) {
|
||||
mmaprintk("failed to set mma7990_trig GPIO gpio input\n");
|
||||
return ret;
|
||||
}
|
||||
gpio_pull_updown(client->irq, GPIOPullUp);
|
||||
client->irq = gpio_to_irq(client->irq);
|
||||
ret = request_irq(client->irq, l3g4200d_interrupt, IRQF_TRIGGER_LOW, client->dev.driver->name, l3g4200d);
|
||||
mmaprintk("request irq is %d,ret is 0x%x\n",client->irq,ret);
|
||||
if (ret ) {
|
||||
mmaprintk(KERN_ERR "l3g4200d_init_client: request irq failed,ret is %d\n",ret);
|
||||
return ret;
|
||||
}
|
||||
disable_irq(client->irq);
|
||||
init_waitqueue_head(&data_ready_wq);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
static int l3g4200d_validate_pdata(struct l3g4200d_data *gyro)
|
||||
{
|
||||
if (gyro->pdata->axis_map_x > 2 ||
|
||||
gyro->pdata->axis_map_y > 2 ||
|
||||
gyro->pdata->axis_map_z > 2) {
|
||||
dev_err(&gyro->client->dev,
|
||||
"invalid axis_map value x:%u y:%u z%u\n",
|
||||
gyro->pdata->axis_map_x, gyro->pdata->axis_map_y,
|
||||
gyro->pdata->axis_map_z);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/* Only allow 0 and 1 for negation boolean flag */
|
||||
if (gyro->pdata->negate_x > 1 ||
|
||||
gyro->pdata->negate_y > 1 ||
|
||||
gyro->pdata->negate_z > 1) {
|
||||
dev_err(&gyro->client->dev,
|
||||
"invalid negate value x:%u y:%u z:%u\n",
|
||||
gyro->pdata->negate_x, gyro->pdata->negate_y,
|
||||
gyro->pdata->negate_z);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
static int l3g4200d_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
||||
{
|
||||
struct l3g4200d_data *l3g4200d;
|
||||
struct l3g4200d_platform_data *pdata = pdata = client->dev.platform_data;
|
||||
int err;
|
||||
|
||||
mmaprintk("%s enter\n",__FUNCTION__);
|
||||
|
||||
l3g4200d = kzalloc(sizeof(struct l3g4200d_data), GFP_KERNEL);
|
||||
if (!l3g4200d) {
|
||||
mmaprintk("[l3g4200d]:alloc data failed.\n");
|
||||
err = -ENOMEM;
|
||||
goto exit_alloc_data_failed;
|
||||
}
|
||||
|
||||
INIT_WORK(&l3g4200d->work, l3g4200d_work_func);
|
||||
INIT_DELAYED_WORK(&l3g4200d->delaywork, l3g4200d_delaywork_func);
|
||||
|
||||
l3g4200d->client = client;
|
||||
i2c_set_clientdata(client, l3g4200d);
|
||||
|
||||
this_client = client;
|
||||
|
||||
err = l3g4200d_init_client(client);
|
||||
if (err < 0) {
|
||||
mmaprintk(KERN_ERR
|
||||
"l3g4200d_probe: l3g4200d_init_client failed\n");
|
||||
goto exit_request_gpio_irq_failed;
|
||||
}
|
||||
|
||||
|
||||
l3g4200d->pdata = kmalloc(sizeof(*l3g4200d->pdata), GFP_KERNEL);
|
||||
|
||||
if (l3g4200d->pdata == NULL)
|
||||
goto exit_kfree;
|
||||
|
||||
memcpy(l3g4200d->pdata, client->dev.platform_data, sizeof(*l3g4200d->pdata));
|
||||
|
||||
err = l3g4200d_validate_pdata(l3g4200d);
|
||||
if (err < 0) {
|
||||
dev_err(&client->dev, "failed to validate platform data\n");
|
||||
goto exit_kfree_pdata;
|
||||
}
|
||||
this_data=l3g4200d;
|
||||
|
||||
|
||||
|
||||
|
||||
l3g4200d->input_dev = input_allocate_device();
|
||||
if (!l3g4200d->input_dev) {
|
||||
err = -ENOMEM;
|
||||
mmaprintk(KERN_ERR
|
||||
"l3g4200d_probe: Failed to allocate input device\n");
|
||||
goto exit_input_allocate_device_failed;
|
||||
}
|
||||
|
||||
set_bit(EV_ABS, l3g4200d->input_dev->evbit);
|
||||
|
||||
/* x-axis acceleration */
|
||||
input_set_abs_params(l3g4200d->input_dev, ABS_RX, -28571, 28571, 0, 0); //2g full scale range
|
||||
/* y-axis acceleration */
|
||||
input_set_abs_params(l3g4200d->input_dev, ABS_RY, -28571, 28571, 0, 0); //2g full scale range
|
||||
/* z-axis acceleration */
|
||||
input_set_abs_params(l3g4200d->input_dev, ABS_RZ, -28571, 28571, 0, 0); //2g full scale range
|
||||
|
||||
l3g4200d->input_dev->name = "gyro";
|
||||
l3g4200d->input_dev->dev.parent = &client->dev;
|
||||
|
||||
err = input_register_device(l3g4200d->input_dev);
|
||||
if (err < 0) {
|
||||
mmaprintk(KERN_ERR
|
||||
"l3g4200d_probe: Unable to register input device: %s\n",
|
||||
l3g4200d->input_dev->name);
|
||||
goto exit_input_register_device_failed;
|
||||
}
|
||||
|
||||
l3g4200d_device.parent = &client->dev;
|
||||
err = misc_register(&l3g4200d_device);
|
||||
if (err < 0) {
|
||||
mmaprintk(KERN_ERR
|
||||
"l3g4200d_probe: mmad_device register failed\n");
|
||||
goto exit_misc_device_register_l3g4200d_device_failed;
|
||||
}
|
||||
|
||||
err = gsensor_sysfs_init();
|
||||
if (err < 0) {
|
||||
mmaprintk(KERN_ERR
|
||||
"l3g4200d_probe: gsensor sysfs init failed\n");
|
||||
goto exit_gsensor_sysfs_init_failed;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_HAS_EARLYSUSPEND
|
||||
l3g4200d_early_suspend.suspend = l3g4200d_suspend;
|
||||
l3g4200d_early_suspend.resume = l3g4200d_resume;
|
||||
l3g4200d_early_suspend.level = 0x2;
|
||||
register_early_suspend(&l3g4200d_early_suspend);
|
||||
#endif
|
||||
if(l3g4200d_get_devid(this_client))
|
||||
printk(KERN_INFO "l3g4200d probe ok\n");
|
||||
else
|
||||
printk(KERN_INFO "l3g4200d probe error\n");
|
||||
|
||||
|
||||
l3g4200d->status = -1;
|
||||
#if 0
|
||||
// l3g4200d_start_test(this_client);
|
||||
l3g4200d_start(client, L3G4200D_RATE_12P5);
|
||||
#endif
|
||||
return 0;
|
||||
|
||||
exit_gsensor_sysfs_init_failed:
|
||||
misc_deregister(&l3g4200d_device);
|
||||
exit_misc_device_register_l3g4200d_device_failed:
|
||||
input_unregister_device(l3g4200d->input_dev);
|
||||
exit_input_register_device_failed:
|
||||
input_free_device(l3g4200d->input_dev);
|
||||
exit_input_allocate_device_failed:
|
||||
free_irq(client->irq, l3g4200d);
|
||||
exit_kfree_pdata:
|
||||
kfree(l3g4200d->pdata);
|
||||
exit_kfree:
|
||||
exit_request_gpio_irq_failed:
|
||||
kfree(l3g4200d);
|
||||
exit_alloc_data_failed:
|
||||
;
|
||||
exit:
|
||||
mmaprintk("%s error\n",__FUNCTION__);
|
||||
return err;
|
||||
}
|
||||
|
||||
|
||||
static int __init l3g4200d_i2c_init(void)
|
||||
{
|
||||
return i2c_add_driver(&l3g4200d_driver);
|
||||
}
|
||||
|
||||
static void __exit l3g4200d_i2c_exit(void)
|
||||
{
|
||||
i2c_del_driver(&l3g4200d_driver);
|
||||
}
|
||||
|
||||
module_init(l3g4200d_i2c_init);
|
||||
module_exit(l3g4200d_i2c_exit);
|
||||
|
||||
|
||||
|
|
@ -11,6 +11,8 @@
|
|||
#include <mach/gpio.h>
|
||||
#include <mach/iomux.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <asm/uaccess.h>
|
||||
#include <linux/wait.h>
|
||||
#include "rk29_gps.h"
|
||||
#if 0
|
||||
#define DBG(x...) printk(KERN_INFO x)
|
||||
|
|
@ -111,9 +113,8 @@ int rk29_gps_suspend(struct platform_device *pdev, pm_message_t state)
|
|||
|
||||
if(pdata->power_flag == 1)
|
||||
{
|
||||
rk29_gps_uart_to_gpio(pdata->uart_id);
|
||||
pdata->power_down();
|
||||
pdata->reset(GPIO_LOW);
|
||||
pdata->suspend = 1;
|
||||
queue_work(pdata->wq, &pdata->work);
|
||||
}
|
||||
|
||||
printk("%s\n",__FUNCTION__);
|
||||
|
|
@ -130,12 +131,8 @@ int rk29_gps_resume(struct platform_device *pdev)
|
|||
|
||||
if(pdata->power_flag == 1)
|
||||
{
|
||||
pdata->reset(GPIO_LOW);
|
||||
mdelay(10);
|
||||
pdata->power_up();
|
||||
mdelay(500);
|
||||
pdata->reset(GPIO_HIGH);
|
||||
rk29_gps_gpio_to_uart(pdata->uart_id);
|
||||
pdata->suspend = 0;
|
||||
queue_work(pdata->wq, &pdata->work);
|
||||
}
|
||||
|
||||
printk("%s\n",__FUNCTION__);
|
||||
|
|
@ -143,6 +140,37 @@ int rk29_gps_resume(struct platform_device *pdev)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void rk29_gps_delay_power_downup(struct work_struct *work)
|
||||
{
|
||||
//int ret;
|
||||
struct rk29_gps_data *pdata = container_of(work, struct rk29_gps_data, work);
|
||||
if (pdata == NULL) {
|
||||
printk("%s: pdata = NULL\n", __func__);
|
||||
return;
|
||||
}
|
||||
|
||||
down(&pdata->power_sem);
|
||||
//if (ret < 0) {
|
||||
// printk("%s: down power_sem error ret = %d\n", __func__, ret);
|
||||
// return ;
|
||||
//}
|
||||
|
||||
if (pdata->suspend) {
|
||||
rk29_gps_uart_to_gpio(pdata->uart_id);
|
||||
pdata->power_down();
|
||||
pdata->reset(GPIO_LOW);
|
||||
}
|
||||
else {
|
||||
pdata->reset(GPIO_LOW);
|
||||
mdelay(10);
|
||||
pdata->power_up();
|
||||
mdelay(500);
|
||||
pdata->reset(GPIO_HIGH);
|
||||
rk29_gps_gpio_to_uart(pdata->uart_id);
|
||||
}
|
||||
up(&pdata->power_sem);
|
||||
}
|
||||
|
||||
int rk29_gps_open(struct inode *inode, struct file *filp)
|
||||
{
|
||||
DBG("rk29_gps_open\n");
|
||||
|
|
@ -150,6 +178,18 @@ int rk29_gps_open(struct inode *inode, struct file *filp)
|
|||
return 0;
|
||||
}
|
||||
|
||||
ssize_t rk29_gps_read(struct file *filp, char __user *ptr, size_t size, loff_t *pos)
|
||||
{
|
||||
if (ptr == NULL)
|
||||
printk("%s: user space address is NULL\n", __func__);
|
||||
if (pgps == NULL)
|
||||
printk("%s: pgps addr is NULL\n", __func__);
|
||||
|
||||
put_user(pgps->uart_id, ptr);
|
||||
|
||||
return sizeof(int);
|
||||
}
|
||||
|
||||
int rk29_gps_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg)
|
||||
{
|
||||
int ret = 0;
|
||||
|
|
@ -181,7 +221,7 @@ int rk29_gps_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, uns
|
|||
pdata->reset(GPIO_LOW);
|
||||
pdata->power_flag = 0;
|
||||
break;
|
||||
|
||||
|
||||
default:
|
||||
printk("unknown ioctl cmd!\n");
|
||||
up(&pdata->power_sem);
|
||||
|
|
@ -205,6 +245,7 @@ int rk29_gps_release(struct inode *inode, struct file *filp)
|
|||
static struct file_operations rk29_gps_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.open = rk29_gps_open,
|
||||
.read = rk29_gps_read,
|
||||
.ioctl = rk29_gps_ioctl,
|
||||
.release = rk29_gps_release,
|
||||
};
|
||||
|
|
@ -219,7 +260,6 @@ static struct miscdevice rk29_gps_dev =
|
|||
static int rk29_gps_probe(struct platform_device *pdev)
|
||||
{
|
||||
int ret = 0;
|
||||
printk("\n\n=========================\n%s\n", __func__);
|
||||
struct rk29_gps_data *pdata = pdev->dev.platform_data;
|
||||
if(!pdata)
|
||||
return -1;
|
||||
|
|
@ -231,7 +271,10 @@ static int rk29_gps_probe(struct platform_device *pdev)
|
|||
}
|
||||
|
||||
init_MUTEX(&pdata->power_sem);
|
||||
pdata->wq = create_freezeable_workqueue("rk29_gps");
|
||||
INIT_WORK(&pdata->work, rk29_gps_delay_power_downup);
|
||||
pdata->power_flag = 0;
|
||||
pdata->suspend = 0;
|
||||
|
||||
pgps = pdata;
|
||||
|
||||
|
|
@ -241,8 +284,21 @@ static int rk29_gps_probe(struct platform_device *pdev)
|
|||
return ret;
|
||||
}
|
||||
|
||||
static int rk29_gps_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct rk29_gps_data *pdata = pdev->dev.platform_data;
|
||||
if(!pdata)
|
||||
return -1;
|
||||
|
||||
misc_deregister(&rk29_gps_dev);
|
||||
destroy_workqueue(pdata->wq);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct platform_driver rk29_gps_driver = {
|
||||
.probe = rk29_gps_probe,
|
||||
.remove = rk29_gps_remove,
|
||||
.suspend = rk29_gps_suspend,
|
||||
.resume = rk29_gps_resume,
|
||||
.driver = {
|
||||
|
|
|
|||
|
|
@ -11,7 +11,10 @@ struct rk29_gps_data {
|
|||
int (*reset)(int);
|
||||
int uart_id;
|
||||
int power_flag;
|
||||
int suspend;
|
||||
struct semaphore power_sem;
|
||||
struct workqueue_struct *wq;
|
||||
struct work_struct work;
|
||||
};
|
||||
|
||||
#endif
|
||||
|
|
|
|||
|
|
@ -81,7 +81,7 @@ M```8,)_E'R``XJ`"H.$!P*#C`!&3YQPB@>$`(8/G'O\OX6P``/48,)_E'R``
|
|||
MXJ`"H.$!P*#C`!&3YQPBP>$`(8/G'O\OX6P``/4``*#C'O\OX1`PG^7Z'Z#C
|
||||
M$$`MZ1`"D^7^___K$("]Z``````00"WI$$"?Y1``G^44$I3E_O__ZQ0"E.40
|
||||
M@+WH``````````#^___JJ#"?Y0$`4..D()_E$$`MZ5`0D^4#&\'C4!"#Y0`0
|
||||
MDN4@$,'C`!""Y000DN4@$('C!!""Y1@``!H``)+ER$"@XW`0G^4@`(#C``""
|
||||
MDN4@$,'C`!""Y000DN4@$('C!!""Y1@``!H``)+E?4^@XW`0G^4@`(#C``""
|
||||
MY6`@D^4"**#A(BB@X6`@@^5D()/E#R#"XV0@@^4`,)'E_SO#XP,\P^,`,('E
|
||||
M!#"1Y?\[@^,#/(/C!#"!Y0```.K^___K`4!4XB``G^7[__\J$#"?Y0`@D^4@
|
||||
M(,+C`""#Y1"`O>@`@`#U```(]0"`"/6P968&$$`MZ6``G^7^___K7#"?Y0`0
|
||||
|
|
|
|||
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
141
include/linux/l3g4200d.h
Executable file
141
include/linux/l3g4200d.h
Executable file
|
|
@ -0,0 +1,141 @@
|
|||
/******************** (C) COPYRIGHT 2010 STMicroelectronics ********************
|
||||
*
|
||||
* File Name : l3g4200d.c
|
||||
* Authors : MH - C&I BU - Application Team
|
||||
* : Carmine Iascone (carmine.iascone@st.com)
|
||||
* : Matteo Dameno (matteo.dameno@st.com)
|
||||
* Version : V 0.2
|
||||
* Date : 09/04/2010
|
||||
* Description : L3G4200D digital output gyroscope sensor API
|
||||
*
|
||||
********************************************************************************
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 as
|
||||
* published by the Free Software Foundation.
|
||||
*
|
||||
* THE PRESENT SOFTWARE IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES
|
||||
* OR CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED, FOR THE SOLE
|
||||
* PURPOSE TO SUPPORT YOUR APPLICATION DEVELOPMENT.
|
||||
* AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT,
|
||||
* INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE
|
||||
* CONTENT OF SUCH SOFTWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING
|
||||
* INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
|
||||
*
|
||||
* THIS SOFTWARE IS SPECIFICALLY DESIGNED FOR EXCLUSIVE USE WITH ST PARTS.
|
||||
*
|
||||
********************************************************************************
|
||||
* REVISON HISTORY
|
||||
*
|
||||
* VERSION | DATE | AUTHORS | DESCRIPTION
|
||||
*
|
||||
* 0.1 | 29/01/2010 | Carmine Iascone | First Release
|
||||
*
|
||||
* 0.2 | 09/04/2010 | Carmine Iascone | Updated the struct l3g4200d_t
|
||||
*
|
||||
*******************************************************************************/
|
||||
|
||||
#ifndef __L3G4200D_H__
|
||||
#define __L3G4200D_H__
|
||||
|
||||
#include <linux/ioctl.h> /* For IOCTL macros */
|
||||
|
||||
/** This define controls compilation of the master device interface */
|
||||
/*#define L3G4200D_MASTER_DEVICE*/
|
||||
|
||||
#define L3G4200D_IOCTL_BASE 'g'
|
||||
/* The following define the IOCTL command values via the ioctl macros */
|
||||
#define L3G4200D_SET_RANGE _IOW(L3G4200D_IOCTL_BASE, 1, int)
|
||||
#define L3G4200D_SET_MODE _IOW(L3G4200D_IOCTL_BASE, 2, int)
|
||||
#define L3G4200D_SET_BANDWIDTH _IOW(L3G4200D_IOCTL_BASE, 3, int)
|
||||
#define L3G4200D_READ_GYRO_VALUES _IOW(L3G4200D_IOCTL_BASE, 4, int)
|
||||
|
||||
#define L3G4200D_FS_250DPS 0x00
|
||||
#define L3G4200D_FS_500DPS 0x10
|
||||
#define L3G4200D_FS_2000DPS 0x30
|
||||
|
||||
#define PM_OFF 0x00
|
||||
#define PM_NORMAL 0x08
|
||||
#define ENABLE_ALL_AXES 0x07
|
||||
|
||||
/*status*/
|
||||
#define L3G4200D_SUSPEND 2
|
||||
#define L3G4200D_OPEN 1
|
||||
#define L3G4200D_CLOSE 0
|
||||
|
||||
#define ODR100_BW12_5 0x00 /* ODR = 100Hz; BW = 12.5Hz */
|
||||
#define ODR100_BW25 0x10 /* ODR = 100Hz; BW = 25Hz */
|
||||
#define ODR200_BW12_5 0x40 /* ODR = 200Hz; BW = 12.5Hz */
|
||||
#define ODR200_BW25 0x50 /* ODR = 200Hz; BW = 25Hz */
|
||||
#define ODR200_BW50 0x60 /* ODR = 200Hz; BW = 50Hz */
|
||||
#define ODR400_BW25 0x90 /* ODR = 400Hz; BW = 25Hz */
|
||||
#define ODR400_BW50 0xA0 /* ODR = 400Hz; BW = 50Hz */
|
||||
#define ODR400_BW110 0xB0 /* ODR = 400Hz; BW = 110Hz */
|
||||
#define ODR800_BW50 0xE0 /* ODR = 800Hz; BW = 50Hz */
|
||||
#define ODR800_BW100 0xF0 /* ODR = 800Hz; BW = 100Hz */
|
||||
|
||||
#define L3G4200D_REG_WHO_AM_I 0x0f
|
||||
#define L3G4200D_REG_CTRL_REG1 0x20
|
||||
#define ACTIVE_MASK 0x08
|
||||
|
||||
#ifdef __KERNEL__
|
||||
struct l3g4200d_platform_data {
|
||||
u8 fs_range;
|
||||
|
||||
u8 axis_map_x;
|
||||
u8 axis_map_y;
|
||||
u8 axis_map_z;
|
||||
|
||||
u8 negate_x;
|
||||
u8 negate_y;
|
||||
u8 negate_z;
|
||||
|
||||
int (*init)(void);
|
||||
void (*exit)(void);
|
||||
int (*power_on)(void);
|
||||
int (*power_off)(void);
|
||||
|
||||
};
|
||||
|
||||
#endif /* __KERNEL__ */
|
||||
|
||||
#define MMAIO 0xA1
|
||||
|
||||
/* IOCTLs for MMA8452 library */
|
||||
#define ECS_IOCTL_INIT _IO(MMAIO, 0x01)
|
||||
#define ECS_IOCTL_RESET _IO(MMAIO, 0x04)
|
||||
#define ECS_IOCTL_CLOSE _IO(MMAIO, 0x02)
|
||||
#define ECS_IOCTL_START _IO(MMAIO, 0x03)
|
||||
#define ECS_IOCTL_GETDATA _IOR(MMAIO, 0x08, char[RBUFF_SIZE+1])
|
||||
|
||||
#define GYROSENSOR_IOCTL_MAGIC 'l'
|
||||
#define GYROSENSOR_IOCTL_GET_ENABLED _IOR(GYROSENSOR_IOCTL_MAGIC, 1, int *)
|
||||
#define GYROSENSOR_IOCTL_ENABLE _IOW(GYROSENSOR_IOCTL_MAGIC, 2, int *)
|
||||
|
||||
/* IOCTLs for APPs */
|
||||
#define ECS_IOCTL_APP_SET_RATE _IOW(MMAIO, 0x10, char)
|
||||
|
||||
#define EVENT_TYPE_GYRO_X ABS_RY
|
||||
#define ECS_IOCTL_APP_GET_ABS EVIOCGABS(EVENT_TYPE_GYRO_X)
|
||||
|
||||
|
||||
struct l3g4200d_data {
|
||||
char status;
|
||||
char curr_tate;
|
||||
struct input_dev *input_dev;
|
||||
struct i2c_client *client;
|
||||
struct work_struct work;
|
||||
struct delayed_work delaywork; /*report second event*/
|
||||
struct l3g4200d_platform_data *pdata;
|
||||
};
|
||||
|
||||
struct l3g4200d_axis {
|
||||
int x;
|
||||
int y;
|
||||
int z;
|
||||
};
|
||||
|
||||
#define GSENSOR_DEV_PATH "/dev/gyrosensors"
|
||||
|
||||
|
||||
#endif /* __L3G4200D_H__ */
|
||||
Loading…
Reference in New Issue
Block a user