From: linjh Date: Wed, 20 Apr 2011 02:11:40 +0000 (+0800) Subject: add gyroscope driver X-Git-Tag: firefly_0821_release~10444^2 X-Git-Url: http://demsky.eecs.uci.edu/git/?a=commitdiff_plain;h=32eef04ee28226c8f1deb84ca2b8adf5ef0420c7;p=firefly-linux-kernel-4.4.55.git add gyroscope driver --- diff --git a/arch/arm/mach-rk29/board-rk29-phonesdk.c b/arch/arm/mach-rk29/board-rk29-phonesdk.c index faa76d81b94e..22234054cf02 100755 --- a/arch/arm/mach-rk29/board-rk29-phonesdk.c +++ b/arch/arm/mach-rk29/board-rk29-phonesdk.c @@ -1406,6 +1406,38 @@ struct platform_device rk28_device_headset = { }; #endif +#if defined(CONFIG_GS_L3G4200D) + +#include +#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 diff --git a/drivers/input/gsensor/Kconfig b/drivers/input/gsensor/Kconfig index 7e2305c9c2e5..31b87eb67403 100644 --- a/drivers/input/gsensor/Kconfig +++ b/drivers/input/gsensor/Kconfig @@ -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 diff --git a/drivers/input/gsensor/Makefile b/drivers/input/gsensor/Makefile index c537a7d9ca5c..77565613a1bb 100644 --- a/drivers/input/gsensor/Makefile +++ b/drivers/input/gsensor/Makefile @@ -2,3 +2,4 @@ obj-$(CONFIG_GS_MMA7660) += mma7660.o obj-$(CONFIG_GS_MMA8452) += mma8452.o +obj-$(CONFIG_GS_L3G4200D) += l3g4200d.o diff --git a/drivers/input/gsensor/l3g4200d.c b/drivers/input/gsensor/l3g4200d.c new file mode 100755 index 000000000000..df4874699fd7 --- /dev/null +++ b/drivers/input/gsensor/l3g4200d.c @@ -0,0 +1,879 @@ +/* drivers/i2c/chips/l3g4200d.c - l3g4200d compass driver + * + * Copyright (C) 2007-2008 HTC Corporation. + * Author: Hou-Kun Chen + * + * 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 +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#ifdef CONFIG_HAS_EARLYSUSPEND +#include +#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); + + diff --git a/include/linux/l3g4200d.h b/include/linux/l3g4200d.h new file mode 100755 index 000000000000..8d90fec4f8b4 --- /dev/null +++ b/include/linux/l3g4200d.h @@ -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 /* 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__ */