mma7660.c的改进
/*当水平放置时，传感器的某个轴重力达到最大时，另外两个轴读数应该为0，但是硬件缺陷使得另两轴会跳值，实验结果，其跳值范围在,1~2，且连续跳值次数极少超过2次。故在report_abs()中加入过滤语句，过滤重力传感器的“自跳”，其逻辑是：在某个轴上，若此次读数小于等于2，且前两次读数至少有一次为0，就认为此读数为自跳，将其置零。其中predata，prepredata是全局变量（所有进程共享）。因为java中没有全局变量的概念，所以若写在顶层java中，会造成不同进程访问各自的predata而延缓反应速度*/
/*
* mma7660.c - Linux kernel modules for 3-Axis Orientation/Motion
* Detection Sensor
*
* Copyright (C) 2009-2010 Freescale Semiconductor Ltd.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* 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.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/i2c.h>
#include <linux/mutex.h>
#include <linux/delay.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/hwmon-sysfs.h>
#include <linux/err.h>
#include <linux/hwmon.h>
#include <linux/input-polldev.h>
#include <linux/device.h>
#include <linux/earlysuspend.h>
#include <mach/system.h>
#include <mach/hardware.h>
#include <mach/sys_config.h>
/*
* Defines
*/
#define assert(expr)\
if (!(expr)) {\
printk(KERN_ERR "Assertion failed! %s,%d,%s,%s\n",\
__FILE__, __LINE__, __func__, #expr);\
}
#define MMA7660_DRV_NAME "mma7660"
#define SENSOR_NAME MMA7660_DRV_NAME
#define MMA7660_XOUT 0x00
#define MMA7660_YOUT 0x01
#define MMA7660_ZOUT 0x02
#define MMA7660_TILT 0x03
#define MMA7660_SRST 0x04
#define MMA7660_SPCNT 0x05
#define MMA7660_INTSU 0x06
#define MMA7660_MODE 0x07
#define MMA7660_SR 0x08
#define MMA7660_PDET 0x09
#define MMA7660_PD 0x0A
#define POLL_INTERVAL_MAX 500
#define POLL_INTERVAL 100
#define INPUT_FUZZ 2
#define INPUT_FLAT 2
#define MK_MMA7660_SR(FILT, AWSR, AMSR)\
(FILT<<5 | AWSR<<3 | AMSR)
#define MK_MMA7660_MODE(IAH, IPP, SCPS, ASE, AWE, TON, MODE)\
(IAH<<7 | IPP<<6 | SCPS<<5 | ASE<<4 | AWE<<3 | TON<<2 | MODE)
#define MK_MMA7660_INTSU(SHINTX, SHINTY, SHINTZ, GINT, ASINT, PDINT, PLINT, FBINT)\
(SHINTX<<7 | SHINTY<<6 | SHINTZ<<5 | GINT<<4 | ASINT<<3 | PDINT<<2 | PLINT<<1 | FBINT)
#define MODE_CHANGE_DELAY_MS 100
static struct device *hwmon_dev;
static struct i2c_client *mma7660_i2c_client;
struct mma7660_data_s {
#ifdef CONFIG_HAS_EARLYSUSPEND
struct early_suspend early_suspend;
volatile int suspend_indator;
#endif
} mma7660_data;
static int gsensor_direct_x = 0;
static int gsensor_direct_y = 0;
static int gsensor_direct_z = 0;
static int gsensor_xy_revert = 0;
static int predata[3] = {0, 0, 0};
static int prepredata[3] = {0, 0, 0};
/* Addresses to scan */
static union{
unsigned short dirty_addr_buf[2];
const unsigned short normal_i2c[2];
}u_i2c_addr = {{0x00},};
static __u32 twi_id = 0;
#ifdef CONFIG_HAS_EARLYSUSPEND
static void mma7660_early_suspend(struct early_suspend *h);
static void mma7660_late_resume(struct early_suspend *h);
#endif
/**
* gsensor_fetch_sysconfig_para - get config info from sysconfig.fex file.
* return value:
* = 0; success;
* < 0; err
*/
static int gsensor_fetch_sysconfig_para(void)
{
int ret = -1;
int device_used = -1;
__u32 twi_addr = 0;
char name[I2C_NAME_SIZE];
script_parser_value_type_t type = SCIRPT_PARSER_VALUE_TYPE_STRING;
printk("========%s===================\n", __func__);
if(SCRIPT_PARSER_OK != (ret = script_parser_fetch("gsensor_para", "gsensor_used", &device_used, 1))){
pr_err("%s: script_parser_fetch err.ret = %d. \n", __func__, ret);
goto script_parser_fetch_err;
}
if(1 == device_used){
if(SCRIPT_PARSER_OK != script_parser_fetch_ex("gsensor_para", "gsenser_name", (int *)(&name), &type, sizeof(name)/sizeof(int))){
pr_err("%s: line: %d script_parser_fetch err. \n", __func__, __LINE__);
goto script_parser_fetch_err;
}
if(strcmp(SENSOR_NAME, name)){
pr_err("%s: name %s does not match SENSOR_NAME. \n", __func__, name);
pr_err(SENSOR_NAME);
//ret = 1;
return ret;
}
if(SCRIPT_PARSER_OK != script_parser_fetch("gsensor_para", "gsensor_twi_addr", &twi_addr, sizeof(twi_addr)/sizeof(__u32))){
pr_err("%s: line: %d: script_parser_fetch err. \n", name, __LINE__);
goto script_parser_fetch_err;
}
u_i2c_addr.dirty_addr_buf[0] = twi_addr;
u_i2c_addr.dirty_addr_buf[1] = I2C_CLIENT_END;
printk("%s: after: gsensor_twi_addr is 0x%x, dirty_addr_buf: 0x%hx. dirty_addr_buf[1]: 0x%hx \n", \
__func__, twi_addr, u_i2c_addr.dirty_addr_buf[0], u_i2c_addr.dirty_addr_buf[1]);
if(SCRIPT_PARSER_OK != script_parser_fetch("gsensor_para", "gsensor_twi_id", &twi_id, 1)){
pr_err("%s: script_parser_fetch err. \n", name);
goto script_parser_fetch_err;
}
printk("%s: twi_id is %d. \n", __func__, twi_id);
if(SCRIPT_PARSER_OK != script_parser_fetch("gsensor_para", "gsensor_direct_x", &gsensor_direct_x, sizeof(gsensor_direct_x)/sizeof(__u32))){
pr_err("%s: line: %d: script_parser_fetch err. \n", name, __LINE__);
goto script_parser_fetch_err;
}
if(SCRIPT_PARSER_OK != script_parser_fetch("gsensor_para", "gsensor_direct_y", &gsensor_direct_y, sizeof(gsensor_direct_y)/sizeof(__u32))){
pr_err("%s: line: %d: script_parser_fetch err. \n", name, __LINE__);
goto script_parser_fetch_err;
}
if(SCRIPT_PARSER_OK != script_parser_fetch("gsensor_para", "gsensor_direct_z", &gsensor_direct_z, sizeof(gsensor_direct_z)/sizeof(__u32))){
pr_err("%s: line: %d: script_parser_fetch err. \n", name, __LINE__);
goto script_parser_fetch_err;
}
if(SCRIPT_PARSER_OK != script_parser_fetch("gsensor_para", "gsensor_xy_revert", &gsensor_xy_revert, sizeof(gsensor_xy_revert)/sizeof(__u32))){
pr_err("%s: line: %d: script_parser_fetch err. \n", name, __LINE__);
goto script_parser_fetch_err;
}
ret = 0;
}else{
pr_err("%s: gsensor_unused. \n", __func__);
ret = -1;
}
return ret;
script_parser_fetch_err:
pr_notice("=========script_parser_fetch_err============\n");
return ret;
}
/**
* gsensor_detect - Device detection callback for automatic device creation
* return value:
* = 0; success;
* < 0; err
*/
int gsensor_detect(struct i2c_client *client, struct i2c_board_info *info)
{
struct i2c_adapter *adapter = client->adapter;
if(twi_id == adapter->nr){
pr_info("%s: Detected chip %s at adapter %d, address 0x%02x\n",
__func__, SENSOR_NAME, i2c_adapter_id(adapter), client->addr);
strlcpy(info->type, SENSOR_NAME, I2C_NAME_SIZE);
return 0;
}else{
return -ENODEV;
}
}
static void mma7660_read_xyz(int idx, s8 *pf)
{
s32 result;
assert(mma7660_i2c_client);
do
{
result=i2c_smbus_read_byte_data(mma7660_i2c_client, idx+MMA7660_XOUT);
assert(result>=0);
}while(result&(1<<6)); //read again if alert
*pf = (result&(1<<5)) ? (result|(~0x0000003f)) : (result&0x0000003f);
}
static ssize_t mma7660_value_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
int i;
s8 xyz[3];
s16 x, y, z;
for(i=0; i<3; i++)
mma7660_read_xyz(i, &xyz[i]);
/* convert signed 8bits to signed 16bits */
x = (((short)xyz[0]) << 8) >> 8;
y = (((short)xyz[1]) << 8) >> 8;
z = (((short)xyz[2]) << 8) >> 8;
return sprintf(buf, "x= %d y= %d z= %d\n", x, y, z);
}
static ssize_t mma7660_enable_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
unsigned long data;
int error;
error = strict_strtoul(buf, 10, &data);
if(error) {
pr_err("%s strict_strtoul error\n", __FUNCTION__);
goto exit;
}
if(data) {
error = i2c_smbus_write_byte_data(mma7660_i2c_client, MMA7660_MODE,
MK_MMA7660_MODE(0, 1, 0, 0, 0, 0, 1));
assert(error==0);
} else {
error = i2c_smbus_write_byte_data(mma7660_i2c_client, MMA7660_MODE,
MK_MMA7660_MODE(0, 0, 0, 0, 0, 0, 0));
assert(error==0);
}
return count;
exit:
return error;
}
static DEVICE_ATTR(enable, S_IRUGO|S_IWUSR|S_IWGRP|S_IWOTH,
NULL, mma7660_enable_store);
static DEVICE_ATTR(value, S_IRUGO|S_IWUSR|S_IWGRP|S_IWOTH,
mma7660_value_show, NULL);
static struct attribute *mma7660_attributes[] = {
&dev_attr_value.attr,
&dev_attr_enable.attr,
NULL
};
static struct attribute_group mma7660_attribute_group = {
.attrs = mma7660_attributes
};
/*
* Initialization function
*/
static int mma7660_init_client(struct i2c_client *client)
{
int result;
mma7660_i2c_client = client;
if(0)
{
/*
* Probe the device. We try to set the device to Test Mode and then to
* write & verify XYZ registers
*/
result = i2c_smbus_write_byte_data(client, MMA7660_MODE,MK_MMA7660_MODE(0, 0, 0, 0, 0, 1, 0));
assert(result==0);
mdelay(MODE_CHANGE_DELAY_MS);
result = i2c_smbus_write_byte_data(client, MMA7660_XOUT, 0x2a);
assert(result==0);
result = i2c_smbus_write_byte_data(client, MMA7660_YOUT, 0x15);
assert(result==0);
result = i2c_smbus_write_byte_data(client, MMA7660_ZOUT, 0x3f);
assert(result==0);
result = i2c_smbus_read_byte_data(client, MMA7660_XOUT);
result= i2c_smbus_read_byte_data(client, MMA7660_YOUT);
result= i2c_smbus_read_byte_data(client, MMA7660_ZOUT);
assert(result=0x3f);
}
// Enable Orientation Detection Logic
result = i2c_smbus_write_byte_data(client,
MMA7660_MODE, MK_MMA7660_MODE(0, 0, 0, 0, 0, 0, 0)); //enter standby
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_SR, MK_MMA7660_SR(2, 2, 1));
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_INTSU, MK_MMA7660_INTSU(0, 0, 0, 0, 1, 0, 1, 1));
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_SPCNT, 0xA0);
assert(result==0);
result = i2c_smbus_write_byte_data(client,
MMA7660_MODE, MK_MMA7660_MODE(0, 1, 0, 0, 0, 0, 1));
assert(result==0);
mdelay(MODE_CHANGE_DELAY_MS);
return result;
}
static struct input_polled_dev *mma7660_idev;
static void report_abs(void)
{
int i, tmp;
s8 xyz[3];
s16 x, y, z;
for(i=0; i<3; i++)
mma7660_read_xyz(i, &xyz[i]);
/* convert signed 8bits to signed 16bits */
x = (((short)xyz[0]) << 8) >> 8;
y = (((short)xyz[1]) << 8) >> 8;
z = (((short)xyz[2]) << 8) >> 8;
//pr_info("xyz[0] = 0x%hx, xyz[1] = 0x%hx, xyz[2] = 0x%hx. \n", xyz[0], xyz[1], xyz[2]);
//pr_info("x[0] = 0x%hx, y[1] = 0x%hx, z[2] = 0x%hx. \n", x, y, z);
// if(x != x_last || y != y_last || z != z_last)
// {
if (gsensor_direct_x == 0)
x = -x;
if (gsensor_direct_y == 0)
y = -y;
if (gsensor_direct_z == 1)
z = -z;
if (gsensor_xy_revert == 0)
{
tmp = x;
x = y;
y = tmp;
}
//printk(KERN_DEBUG"before deal:x=%d y=%d z=%d*******************************************************************\n",x,y,z);
//if( (x >= 20 || x <= -20) && y + z <= 2 )
//z = 0, y = 0;
//if( abs(y) >= 20 && x + z <= 2 )
//x = 0, z = 0;
//if( (z >= 20 || z <= -20) && ( (x < 0)? -x : x) + ( (y < 0)? -y : y) <= 3 )
// x = 0, y = 0;
//printk(KERN_DEBUG" after deal:x=%d y=%d z=%d*******************************************************************\n",x,y,z);
//printk(KERN_DEBUG"before deal: y, predata, prepredata: %d, %d, %d ", y, predata[1], prepredata[1]);
if(y != 0 && y <= 2 && y >= -2 && (predata[1] == 0 || prepredata[1] == 0) ){
//printk(KERN_DEBUG"in if: y, predata, prepredata: %d, %d, %d ", y, predata[1], prepredata[1]);
prepredata[1] = predata[1];
predata[1] = y;
y = 0;
//printk(KERN_DEBUG"set 0");
}else{
//printk(KERN_DEBUG"in else: y, predata, prepredata: %d, %d, %d ", y, predata[1], prepredata[1]);
prepredata[1] = predata[1];
predata[1] = y;
//printk(KERN_DEBUG"report it");
}
//printk(KERN_DEBUG"after deal: y, predata, prepredata: %d, %d, %d ", y, predata[1], prepredata[1]);
if(x != 0 && x <= 2 && x >= -2 && (predata[0] == 0 || prepredata[0] == 0) ){
prepredata[0] = predata[0];
predata[0] = x;
x = 0;
}else{
prepredata[0] = predata[0];
predata[0] = x;
}
if(z != 0 && z <= 2 && z >= -2 && (predata[2] == 0 || prepredata[2] == 0) ){
prepredata[2] = predata[2];
predata[2] = z;
z = 0;
}else{
prepredata[2] = predata[2];
predata[2] = z;
}
input_report_abs(mma7660_idev->input, ABS_X, x);
input_report_abs(mma7660_idev->input, ABS_Y, y);
input_report_abs(mma7660_idev->input, ABS_Z, z);
input_sync(mma7660_idev->input);
}
static void mma7660_dev_poll(struct input_polled_dev *dev)
{
#ifdef CONFIG_HAS_EARLYSUSPEND
if(0 == mma7660_data.suspend_indator){
report_abs();
}
#else
report_abs();
#endif
}
/*
* I2C init/probing/exit functions
*/
static ssize_t device_show (struct device *dev, struct device_attribute *attr, char *buf)
{
return 0;
}
static ssize_t device_store (struct device *dev, struct device_attribute *attr, const char *buf, size_t size)
{
return size;
}
static DEVICE_ATTR (device, S_IRUGO | S_IWUSR, device_show, device_store);
static struct class *class = NULL;
static struct device *device = NULL;
static int create_g_sensor_mma7660_device()
{
int ret = 0;
class = class_create (THIS_MODULE, "g_sensor_mma7660");
if (IS_ERR (class))
{
ret = PTR_ERR (class);
goto err_class_create;
}
device = device_create (class, NULL, MKDEV (0, 1), "%s", "g_sensor_class");
if (IS_ERR (device))
{
ret = PTR_ERR (device);
goto err_device_create;
}
ret = device_create_file (device, &dev_attr_device);
if (ret)
{
goto err_device_create_file;
}
return 0;
err_device_create_file:
device_destroy (class, MKDEV (0, 1));
err_device_create:
class_destroy (class);
err_class_create:
return ret;
}
static void destroy_device (void)
{
device_remove_file (device, &dev_attr_device);
device_destroy (class, MKDEV (0, 1));
class_destroy (class);
}
static int __devinit mma7660_probe(struct i2c_client *client,
const struct i2c_device_id *id)
{
int result;
struct input_dev *idev;
struct i2c_adapter *adapter;
printk(KERN_INFO "mma7660 probe\n");
mma7660_i2c_client = client;
adapter = to_i2c_adapter(client->dev.parent);
result = i2c_check_functionality(adapter,
I2C_FUNC_SMBUS_BYTE |
I2C_FUNC_SMBUS_BYTE_DATA);
assert(result);
/* Initialize the MMA7660 chip */
result = mma7660_init_client(client);
assert(result==0);
if (result != 0)
return - ENODEV;
hwmon_dev = hwmon_device_register(&client->dev);
assert(!(IS_ERR(hwmon_dev)));
dev_info(&client->dev, "build time %s %s\n", __DATE__, __TIME__);
/*input poll device register */
mma7660_idev = input_allocate_polled_device();
if (!mma7660_idev) {
dev_err(&client->dev, "alloc poll device failed!\n");
result = -ENOMEM;
return result;
}
mma7660_idev->poll = mma7660_dev_poll;
mma7660_idev->poll_interval = POLL_INTERVAL;
mma7660_idev->poll_interval_max = POLL_INTERVAL_MAX;
idev = mma7660_idev->input;
idev->name = MMA7660_DRV_NAME;
idev->id.bustype = BUS_I2C;
idev->evbit[0] = BIT_MASK(EV_ABS);
input_set_abs_params(idev, ABS_X, -512, 512, INPUT_FUZZ, INPUT_FLAT);
input_set_abs_params(idev, ABS_Y, -512, 512, INPUT_FUZZ, INPUT_FLAT);
input_set_abs_params(idev, ABS_Z, -512, 512, INPUT_FUZZ, INPUT_FLAT);
result = input_register_polled_device(mma7660_idev);
if (result) {
dev_err(&client->dev, "register poll device failed!\n");
return result;
}
result = sysfs_create_group(&mma7660_idev->input->dev.kobj, &mma7660_attribute_group);
//result = device_create_file(&mma7660_idev->input->dev, &dev_attr_enable);
//result = device_create_file(&mma7660_idev->input->dev, &dev_attr_value);
if(result) {
dev_err(&client->dev, "create sys failed\n");
}
#ifdef CONFIG_HAS_EARLYSUSPEND
mma7660_data.early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN + 1;
mma7660_data.early_suspend.suspend = mma7660_early_suspend;
mma7660_data.early_suspend.resume = mma7660_late_resume;
register_early_suspend(&mma7660_data.early_suspend);
mma7660_data.suspend_indator = 0;
#endif
result = create_g_sensor_mma7660_device();
return result;
}
static int __devexit mma7660_remove(struct i2c_client *client)
{
int result;
result = i2c_smbus_write_byte_data(client,MMA7660_MODE, MK_MMA7660_MODE(0, 0, 0, 0, 0, 0, 0));
assert(result==0);
destroy_device();
hwmon_device_unregister(hwmon_dev);
return result;
}
#ifdef CONFIG_HAS_EARLYSUSPEND
static void mma7660_early_suspend(struct early_suspend *h)
{
int result;
printk(KERN_INFO "mma7660 early suspend\n");
mma7660_data.suspend_indator = 1;
result = i2c_smbus_write_byte_data(mma7660_i2c_client,
MMA7660_MODE, MK_MMA7660_MODE(0, 0, 0, 0, 0, 0, 0));
assert(result==0);
return;
}
static void mma7660_late_resume(struct early_suspend *h)
{
int result;
printk(KERN_INFO "mma7660 late resume\n");
mma7660_data.suspend_indator = 0;
result = i2c_smbus_write_byte_data(mma7660_i2c_client,
MMA7660_MODE, MK_MMA7660_MODE(0, 1, 0, 0, 0, 0, 1));
assert(result==0);
return;
}
#endif /* CONFIG_HAS_EARLYSUSPEND */
static const struct i2c_device_id mma7660_id[] = {
{ MMA7660_DRV_NAME, 1 },
{ }
};
MODULE_DEVICE_TABLE(i2c, mma7660_id);
static struct i2c_driver mma7660_driver = {
.class = I2C_CLASS_HWMON,
.driver = {
.name = MMA7660_DRV_NAME,
.owner = THIS_MODULE,
},
//.suspend = mma7660_suspend,
//.resume = mma7660_resume,
.probe = mma7660_probe,
.remove = __devexit_p(mma7660_remove),
.id_table = mma7660_id,
.address_list = u_i2c_addr.normal_i2c,
};
static int __init mma7660_init(void)
{
int ret = -1;
printk("======%s=========. \n", __func__);
if(gsensor_fetch_sysconfig_para()){
printk("%s: err.\n", __func__);
return -1;
}
printk("%s: after fetch_sysconfig_para: normal_i2c: 0x%hx. normal_i2c[1]: 0x%hx \n", \
__func__, u_i2c_addr.normal_i2c[0], u_i2c_addr.normal_i2c[1]);
mma7660_driver.detect = gsensor_detect;
ret = i2c_add_driver(&mma7660_driver);
if (ret < 0) {
printk(KERN_INFO "add mma7660 i2c driver failed\n");
return -ENODEV;
}
printk(KERN_INFO "add mma7660 i2c driver\n");
return ret;
}
static void __exit mma7660_exit(void)
{
printk(KERN_INFO "remove mma7660 i2c driver.\n");
sysfs_remove_group(&mma7660_idev->input->dev.kobj, &mma7660_attribute_group);
i2c_del_driver(&mma7660_driver);
}
MODULE_AUTHOR("Chen Gang <gang.chen@freescale.com>");
MODULE_DESCRIPTION("MMA7660 3-Axis Orientation/Motion Detection Sensor driver");
MODULE_LICENSE("GPL");
MODULE_VERSION("1.1");
module_init(mma7660_init);
module_exit(mma7660_exit);
