diff options
Diffstat (limited to 'ANDROID_3.4.5/drivers/misc/akm8975.c')
| -rw-r--r-- | ANDROID_3.4.5/drivers/misc/akm8975.c | 732 |
1 files changed, 0 insertions, 732 deletions
diff --git a/ANDROID_3.4.5/drivers/misc/akm8975.c b/ANDROID_3.4.5/drivers/misc/akm8975.c deleted file mode 100644 index 830d2897..00000000 --- a/ANDROID_3.4.5/drivers/misc/akm8975.c +++ /dev/null @@ -1,732 +0,0 @@ -/* drivers/misc/akm8975.c - akm8975 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. - * - */ - -/* - * Revised by AKM 2009/04/02 - * Revised by Motorola 2010/05/27 - * - */ - -#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 <linux/uaccess.h> -#include <linux/delay.h> -#include <linux/input.h> -#include <linux/workqueue.h> -#include <linux/freezer.h> -#include <linux/akm8975.h> -#include <linux/earlysuspend.h> - -#define AK8975DRV_CALL_DBG 0 -#if AK8975DRV_CALL_DBG -#define FUNCDBG(msg) pr_err("%s:%s\n", __func__, msg); -#else -#define FUNCDBG(msg) -#endif - -#define AK8975DRV_DATA_DBG 0 -#define MAX_FAILURE_COUNT 10 - -struct akm8975_data { - struct i2c_client *this_client; - struct akm8975_platform_data *pdata; - struct input_dev *input_dev; - struct work_struct work; - struct mutex flags_lock; -#ifdef CONFIG_HAS_EARLYSUSPEND - struct early_suspend early_suspend; -#endif -}; - -/* -* Because misc devices can not carry a pointer from driver register to -* open, we keep this global. This limits the driver to a single instance. -*/ -struct akm8975_data *akmd_data; - -static DECLARE_WAIT_QUEUE_HEAD(open_wq); - -static atomic_t open_flag; - -static short m_flag; -static short a_flag; -static short t_flag; -static short mv_flag; - -static short akmd_delay; - -static ssize_t akm8975_show(struct device *dev, struct device_attribute *attr, - char *buf) -{ - struct i2c_client *client = to_i2c_client(dev); - return sprintf(buf, "%u\n", i2c_smbus_read_byte_data(client, - AK8975_REG_CNTL)); -} -static ssize_t akm8975_store(struct device *dev, struct device_attribute *attr, - const char *buf, size_t count) -{ - struct i2c_client *client = to_i2c_client(dev); - unsigned long val; - strict_strtoul(buf, 10, &val); - if (val > 0xff) - return -EINVAL; - i2c_smbus_write_byte_data(client, AK8975_REG_CNTL, val); - return count; -} -static DEVICE_ATTR(akm_ms1, S_IWUSR | S_IRUGO, akm8975_show, akm8975_store); - -static int akm8975_i2c_rxdata(struct akm8975_data *akm, char *buf, int length) -{ - struct i2c_msg msgs[] = { - { - .addr = akm->this_client->addr, - .flags = 0, - .len = 1, - .buf = buf, - }, - { - .addr = akm->this_client->addr, - .flags = I2C_M_RD, - .len = length, - .buf = buf, - }, - }; - - FUNCDBG("called"); - - if (i2c_transfer(akm->this_client->adapter, msgs, 2) < 0) { - pr_err("akm8975_i2c_rxdata: transfer error\n"); - return EIO; - } else - return 0; -} - -static int akm8975_i2c_txdata(struct akm8975_data *akm, char *buf, int length) -{ - struct i2c_msg msgs[] = { - { - .addr = akm->this_client->addr, - .flags = 0, - .len = length, - .buf = buf, - }, - }; - - FUNCDBG("called"); - - if (i2c_transfer(akm->this_client->adapter, msgs, 1) < 0) { - pr_err("akm8975_i2c_txdata: transfer error\n"); - return -EIO; - } else - return 0; -} - -static void akm8975_ecs_report_value(struct akm8975_data *akm, short *rbuf) -{ - struct akm8975_data *data = i2c_get_clientdata(akm->this_client); - - FUNCDBG("called"); - -#if AK8975DRV_DATA_DBG - pr_info("akm8975_ecs_report_value: yaw = %d, pitch = %d, roll = %d\n", - rbuf[0], rbuf[1], rbuf[2]); - pr_info("tmp = %d, m_stat= %d, g_stat=%d\n", rbuf[3], rbuf[4], rbuf[5]); - pr_info("Acceleration: x = %d LSB, y = %d LSB, z = %d LSB\n", - rbuf[6], rbuf[7], rbuf[8]); - pr_info("Magnetic: x = %d LSB, y = %d LSB, z = %d LSB\n\n", - rbuf[9], rbuf[10], rbuf[11]); -#endif - mutex_lock(&akm->flags_lock); - /* Report magnetic sensor information */ - if (m_flag) { - input_report_abs(data->input_dev, ABS_RX, rbuf[0]); - input_report_abs(data->input_dev, ABS_RY, rbuf[1]); - input_report_abs(data->input_dev, ABS_RZ, rbuf[2]); - input_report_abs(data->input_dev, ABS_RUDDER, rbuf[4]); - } - - /* Report acceleration sensor information */ - if (a_flag) { - input_report_abs(data->input_dev, ABS_X, rbuf[6]); - input_report_abs(data->input_dev, ABS_Y, rbuf[7]); - input_report_abs(data->input_dev, ABS_Z, rbuf[8]); - input_report_abs(data->input_dev, ABS_WHEEL, rbuf[5]); - } - - /* Report temperature information */ - if (t_flag) - input_report_abs(data->input_dev, ABS_THROTTLE, rbuf[3]); - - if (mv_flag) { - input_report_abs(data->input_dev, ABS_HAT0X, rbuf[9]); - input_report_abs(data->input_dev, ABS_HAT0Y, rbuf[10]); - input_report_abs(data->input_dev, ABS_BRAKE, rbuf[11]); - } - mutex_unlock(&akm->flags_lock); - - input_sync(data->input_dev); -} - -static void akm8975_ecs_close_done(struct akm8975_data *akm) -{ - FUNCDBG("called"); - mutex_lock(&akm->flags_lock); - m_flag = 1; - a_flag = 1; - t_flag = 1; - mv_flag = 1; - mutex_unlock(&akm->flags_lock); -} - -static int akm_aot_open(struct inode *inode, struct file *file) -{ - int ret = -1; - - FUNCDBG("called"); - if (atomic_cmpxchg(&open_flag, 0, 1) == 0) { - wake_up(&open_wq); - ret = 0; - } - - ret = nonseekable_open(inode, file); - if (ret) - return ret; - - file->private_data = akmd_data; - - return ret; -} - -static int akm_aot_release(struct inode *inode, struct file *file) -{ - FUNCDBG("called"); - atomic_set(&open_flag, 0); - wake_up(&open_wq); - return 0; -} - -static int akm_aot_ioctl(struct inode *inode, struct file *file, - unsigned int cmd, unsigned long arg) -{ - void __user *argp = (void __user *) arg; - short flag; - struct akm8975_data *akm = file->private_data; - - FUNCDBG("called"); - - switch (cmd) { - case ECS_IOCTL_APP_SET_MFLAG: - case ECS_IOCTL_APP_SET_AFLAG: - case ECS_IOCTL_APP_SET_MVFLAG: - if (copy_from_user(&flag, argp, sizeof(flag))) - return -EFAULT; - if (flag < 0 || flag > 1) - return -EINVAL; - break; - case ECS_IOCTL_APP_SET_DELAY: - if (copy_from_user(&flag, argp, sizeof(flag))) - return -EFAULT; - break; - default: - break; - } - - mutex_lock(&akm->flags_lock); - switch (cmd) { - case ECS_IOCTL_APP_SET_MFLAG: - m_flag = flag; - break; - case ECS_IOCTL_APP_GET_MFLAG: - flag = m_flag; - break; - case ECS_IOCTL_APP_SET_AFLAG: - a_flag = flag; - break; - case ECS_IOCTL_APP_GET_AFLAG: - flag = a_flag; - break; - case ECS_IOCTL_APP_SET_MVFLAG: - mv_flag = flag; - break; - case ECS_IOCTL_APP_GET_MVFLAG: - flag = mv_flag; - break; - case ECS_IOCTL_APP_SET_DELAY: - akmd_delay = flag; - break; - case ECS_IOCTL_APP_GET_DELAY: - flag = akmd_delay; - break; - default: - return -ENOTTY; - } - mutex_unlock(&akm->flags_lock); - - switch (cmd) { - case ECS_IOCTL_APP_GET_MFLAG: - case ECS_IOCTL_APP_GET_AFLAG: - case ECS_IOCTL_APP_GET_MVFLAG: - case ECS_IOCTL_APP_GET_DELAY: - if (copy_to_user(argp, &flag, sizeof(flag))) - return -EFAULT; - break; - default: - break; - } - - return 0; -} - -static int akmd_open(struct inode *inode, struct file *file) -{ - int err = 0; - - FUNCDBG("called"); - err = nonseekable_open(inode, file); - if (err) - return err; - - file->private_data = akmd_data; - return 0; -} - -static int akmd_release(struct inode *inode, struct file *file) -{ - struct akm8975_data *akm = file->private_data; - - FUNCDBG("called"); - akm8975_ecs_close_done(akm); - return 0; -} - -static int akmd_ioctl(struct inode *inode, struct file *file, unsigned int cmd, - unsigned long arg) -{ - void __user *argp = (void __user *) arg; - - char rwbuf[16]; - int ret = -1; - int status; - short value[12]; - short delay; - struct akm8975_data *akm = file->private_data; - - FUNCDBG("called"); - - switch (cmd) { - case ECS_IOCTL_READ: - case ECS_IOCTL_WRITE: - if (copy_from_user(&rwbuf, argp, sizeof(rwbuf))) - return -EFAULT; - break; - - case ECS_IOCTL_SET_YPR: - if (copy_from_user(&value, argp, sizeof(value))) - return -EFAULT; - break; - - default: - break; - } - - switch (cmd) { - case ECS_IOCTL_READ: - if (rwbuf[0] < 1) - return -EINVAL; - - ret = akm8975_i2c_rxdata(akm, &rwbuf[1], rwbuf[0]); - if (ret < 0) - return ret; - break; - - case ECS_IOCTL_WRITE: - if (rwbuf[0] < 2) - return -EINVAL; - - ret = akm8975_i2c_txdata(akm, &rwbuf[1], rwbuf[0]); - if (ret < 0) - return ret; - break; - case ECS_IOCTL_SET_YPR: - akm8975_ecs_report_value(akm, value); - break; - - case ECS_IOCTL_GET_OPEN_STATUS: - wait_event_interruptible(open_wq, - (atomic_read(&open_flag) != 0)); - status = atomic_read(&open_flag); - break; - case ECS_IOCTL_GET_CLOSE_STATUS: - wait_event_interruptible(open_wq, - (atomic_read(&open_flag) == 0)); - status = atomic_read(&open_flag); - break; - - case ECS_IOCTL_GET_DELAY: - delay = akmd_delay; - break; - - default: - FUNCDBG("Unknown cmd\n"); - return -ENOTTY; - } - - switch (cmd) { - case ECS_IOCTL_READ: - if (copy_to_user(argp, &rwbuf, sizeof(rwbuf))) - return -EFAULT; - break; - case ECS_IOCTL_GET_OPEN_STATUS: - case ECS_IOCTL_GET_CLOSE_STATUS: - if (copy_to_user(argp, &status, sizeof(status))) - return -EFAULT; - break; - case ECS_IOCTL_GET_DELAY: - if (copy_to_user(argp, &delay, sizeof(delay))) - return -EFAULT; - break; - default: - break; - } - - return 0; -} - -/* needed to clear the int. pin */ -static void akm_work_func(struct work_struct *work) -{ - struct akm8975_data *akm = - container_of(work, struct akm8975_data, work); - - FUNCDBG("called"); - enable_irq(akm->this_client->irq); -} - -static irqreturn_t akm8975_interrupt(int irq, void *dev_id) -{ - struct akm8975_data *akm = dev_id; - FUNCDBG("called"); - - disable_irq_nosync(akm->this_client->irq); - schedule_work(&akm->work); - return IRQ_HANDLED; -} - -static int akm8975_power_off(struct akm8975_data *akm) -{ -#if AK8975DRV_CALL_DBG - pr_info("%s\n", __func__); -#endif - if (akm->pdata->power_off) - akm->pdata->power_off(); - - return 0; -} - -static int akm8975_power_on(struct akm8975_data *akm) -{ - int err; - -#if AK8975DRV_CALL_DBG - pr_info("%s\n", __func__); -#endif - if (akm->pdata->power_on) { - err = akm->pdata->power_on(); - if (err < 0) - return err; - } - return 0; -} - -static int akm8975_suspend(struct i2c_client *client, pm_message_t mesg) -{ - struct akm8975_data *akm = i2c_get_clientdata(client); - -#if AK8975DRV_CALL_DBG - pr_info("%s\n", __func__); -#endif - /* TO DO: might need more work after power mgmt - is enabled */ - return akm8975_power_off(akm); -} - -static int akm8975_resume(struct i2c_client *client) -{ - struct akm8975_data *akm = i2c_get_clientdata(client); - -#if AK8975DRV_CALL_DBG - pr_info("%s\n", __func__); -#endif - /* TO DO: might need more work after power mgmt - is enabled */ - return akm8975_power_on(akm); -} - -#ifdef CONFIG_HAS_EARLYSUSPEND -static void akm8975_early_suspend(struct early_suspend *handler) -{ - struct akm8975_data *akm; - akm = container_of(handler, struct akm8975_data, early_suspend); - -#if AK8975DRV_CALL_DBG - pr_info("%s\n", __func__); -#endif - akm8975_suspend(akm->this_client, PMSG_SUSPEND); -} - -static void akm8975_early_resume(struct early_suspend *handler) -{ - struct akm8975_data *akm; - akm = container_of(handler, struct akm8975_data, early_suspend); - -#if AK8975DRV_CALL_DBG - pr_info("%s\n", __func__); -#endif - akm8975_resume(akm->this_client); -} -#endif - - -static int akm8975_init_client(struct i2c_client *client) -{ - struct akm8975_data *data; - int ret; - - data = i2c_get_clientdata(client); - - ret = request_irq(client->irq, akm8975_interrupt, IRQF_TRIGGER_RISING, - "akm8975", data); - - if (ret < 0) { - pr_err("akm8975_init_client: request irq failed\n"); - goto err; - } - - init_waitqueue_head(&open_wq); - - mutex_lock(&data->flags_lock); - m_flag = 1; - a_flag = 1; - t_flag = 1; - mv_flag = 1; - mutex_unlock(&data->flags_lock); - - return 0; -err: - return ret; -} - -static const struct file_operations akmd_fops = { - .owner = THIS_MODULE, - .open = akmd_open, - .release = akmd_release, - .ioctl = akmd_ioctl, -}; - -static const struct file_operations akm_aot_fops = { - .owner = THIS_MODULE, - .open = akm_aot_open, - .release = akm_aot_release, - .ioctl = akm_aot_ioctl, -}; - -static struct miscdevice akm_aot_device = { - .minor = MISC_DYNAMIC_MINOR, - .name = "akm8975_aot", - .fops = &akm_aot_fops, -}; - -static struct miscdevice akmd_device = { - .minor = MISC_DYNAMIC_MINOR, - .name = "akm8975_dev", - .fops = &akmd_fops, -}; - -int akm8975_probe(struct i2c_client *client, - const struct i2c_device_id *devid) -{ - struct akm8975_data *akm; - int err; - FUNCDBG("called"); - - if (client->dev.platform_data == NULL) { - dev_err(&client->dev, "platform data is NULL. exiting.\n"); - err = -ENODEV; - goto exit_platform_data_null; - } - - if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { - dev_err(&client->dev, "platform data is NULL. exiting.\n"); - err = -ENODEV; - goto exit_check_functionality_failed; - } - - akm = kzalloc(sizeof(struct akm8975_data), GFP_KERNEL); - if (!akm) { - dev_err(&client->dev, - "failed to allocate memory for module data\n"); - err = -ENOMEM; - goto exit_alloc_data_failed; - } - - akm->pdata = client->dev.platform_data; - - mutex_init(&akm->flags_lock); - INIT_WORK(&akm->work, akm_work_func); - i2c_set_clientdata(client, akm); - - err = akm8975_power_on(akm); - if (err < 0) - goto exit_power_on_failed; - - akm8975_init_client(client); - akm->this_client = client; - akmd_data = akm; - - akm->input_dev = input_allocate_device(); - if (!akm->input_dev) { - err = -ENOMEM; - dev_err(&akm->this_client->dev, - "input device allocate failed\n"); - goto exit_input_dev_alloc_failed; - } - - set_bit(EV_ABS, akm->input_dev->evbit); - - /* yaw */ - input_set_abs_params(akm->input_dev, ABS_RX, 0, 23040, 0, 0); - /* pitch */ - input_set_abs_params(akm->input_dev, ABS_RY, -11520, 11520, 0, 0); - /* roll */ - input_set_abs_params(akm->input_dev, ABS_RZ, -5760, 5760, 0, 0); - /* x-axis acceleration */ - input_set_abs_params(akm->input_dev, ABS_X, -5760, 5760, 0, 0); - /* y-axis acceleration */ - input_set_abs_params(akm->input_dev, ABS_Y, -5760, 5760, 0, 0); - /* z-axis acceleration */ - input_set_abs_params(akm->input_dev, ABS_Z, -5760, 5760, 0, 0); - /* temparature */ - input_set_abs_params(akm->input_dev, ABS_THROTTLE, -30, 85, 0, 0); - /* status of magnetic sensor */ - input_set_abs_params(akm->input_dev, ABS_RUDDER, 0, 3, 0, 0); - /* status of acceleration sensor */ - input_set_abs_params(akm->input_dev, ABS_WHEEL, 0, 3, 0, 0); - /* x-axis of raw magnetic vector */ - input_set_abs_params(akm->input_dev, ABS_HAT0X, -20480, 20479, 0, 0); - /* y-axis of raw magnetic vector */ - input_set_abs_params(akm->input_dev, ABS_HAT0Y, -20480, 20479, 0, 0); - /* z-axis of raw magnetic vector */ - input_set_abs_params(akm->input_dev, ABS_BRAKE, -20480, 20479, 0, 0); - - akm->input_dev->name = "compass"; - - err = input_register_device(akm->input_dev); - if (err) { - pr_err("akm8975_probe: Unable to register input device: %s\n", - akm->input_dev->name); - goto exit_input_register_device_failed; - } - - err = misc_register(&akmd_device); - if (err) { - pr_err("akm8975_probe: akmd_device register failed\n"); - goto exit_misc_device_register_failed; - } - - err = misc_register(&akm_aot_device); - if (err) { - pr_err("akm8975_probe: akm_aot_device register failed\n"); - goto exit_misc_device_register_failed; - } - - err = device_create_file(&client->dev, &dev_attr_akm_ms1); - -#ifdef CONFIG_HAS_EARLYSUSPEND - akm->early_suspend.suspend = akm8975_early_suspend; - akm->early_suspend.resume = akm8975_early_resume; - register_early_suspend(&akm->early_suspend); -#endif - return 0; - -exit_misc_device_register_failed: -exit_input_register_device_failed: - input_free_device(akm->input_dev); -exit_input_dev_alloc_failed: - akm8975_power_off(akm); -exit_power_on_failed: - kfree(akm); -exit_alloc_data_failed: -exit_check_functionality_failed: -exit_platform_data_null: - return err; -} - -static int __devexit akm8975_remove(struct i2c_client *client) -{ - struct akm8975_data *akm = i2c_get_clientdata(client); - FUNCDBG("called"); - free_irq(client->irq, NULL); - input_unregister_device(akm->input_dev); - misc_deregister(&akmd_device); - misc_deregister(&akm_aot_device); - akm8975_power_off(akm); - kfree(akm); - return 0; -} - -static const struct i2c_device_id akm8975_id[] = { - { "akm8975", 0 }, - { } -}; - -MODULE_DEVICE_TABLE(i2c, akm8975_id); - -static struct i2c_driver akm8975_driver = { - .probe = akm8975_probe, - .remove = akm8975_remove, -#ifndef CONFIG_HAS_EARLYSUSPEND - .resume = akm8975_resume, - .suspend = akm8975_suspend, -#endif - .id_table = akm8975_id, - .driver = { - .name = "akm8975", - }, -}; - -static int __init akm8975_init(void) -{ - pr_info("AK8975 compass driver: init\n"); - FUNCDBG("AK8975 compass driver: init\n"); - return i2c_add_driver(&akm8975_driver); -} - -static void __exit akm8975_exit(void) -{ - FUNCDBG("AK8975 compass driver: exit\n"); - i2c_del_driver(&akm8975_driver); -} - -module_init(akm8975_init); -module_exit(akm8975_exit); - -MODULE_AUTHOR("Hou-Kun Chen <hk_chen@htc.com>"); -MODULE_DESCRIPTION("AK8975 compass driver"); -MODULE_LICENSE("GPL"); |