1 /* drivers/i2c/chips/mma8452.c - mma8452 compass driver
3 * Copyright (C) 2007-2008 HTC Corporation.
4 * Author: Hou-Kun Chen <houkun.chen@gmail.com>
6 * This software is licensed under the terms of the GNU General Public
7 * License version 2, as published by the Free Software Foundation, and
8 * may be copied, distributed, and modified under those terms.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
17 #include <linux/interrupt.h>
18 #include <linux/i2c.h>
19 #include <linux/slab.h>
20 #include <linux/irq.h>
21 #include <linux/miscdevice.h>
22 #include <linux/gpio.h>
23 #include <asm/uaccess.h>
24 #include <asm/atomic.h>
25 #include <linux/delay.h>
26 #include <linux/input.h>
27 #include <linux/workqueue.h>
28 #include <linux/freezer.h>
29 #include <linux/mma8452.h>
30 #include <mach/gpio.h>
31 #include <mach/board.h>
34 #define mmaprintk(x...) printk(x)
36 #define mmaprintk(x...)
40 #define mmaprintkd(x...) printk(x)
42 #define mmaprintkd(x...)
46 #define mmaprintkf(x...) printk(x)
48 #define mmaprintkf(x...)
51 static int mma8452_probe(struct i2c_client *client, const struct i2c_device_id *id);
53 #define MMA8452_SPEED 200 * 1000
54 #define MMA8451_DEVID 0x1a
55 #define MMA8452_DEVID 0x2a
56 #define MMA8453_DEVID 0x3a
57 /* Addresses to scan -- protected by sense_data_mutex */
58 //static char sense_data[RBUFF_SIZE + 1];
59 static struct i2c_client *this_client;
60 static struct miscdevice mma8452_device;
62 static DECLARE_WAIT_QUEUE_HEAD(data_ready_wq);
64 static int revision = -1;
65 static const char* vendor = "Freescale Semiconductor";
69 typedef char status_t;
71 #define MMA8452_OPEN 1
72 #define MMA8452_CLOSE 0
77 struct input_dev *input_dev;
78 struct i2c_client *client;
79 struct work_struct work;
80 struct delayed_work delaywork; /*report second event*/
82 struct mma8452_axis sense_data;
83 struct mutex sense_data_mutex;
85 wait_queue_head_t data_ready_wq;
88 struct mutex operation_mutex;
92 static ssize_t gsensor_vendor_show(struct device *dev,
93 struct device_attribute *attr, char *buf)
97 // sprintf(buf, "%#x\n", revision);
98 sprintf(buf, "%s.\n", vendor);
99 ret = strlen(buf) + 1;
104 static DEVICE_ATTR(vendor, 0444, gsensor_vendor_show, NULL);
106 static struct kobject *android_gsensor_kobj;
108 static int gsensor_sysfs_init(void)
112 android_gsensor_kobj = kobject_create_and_add("android_gsensor", NULL);
113 if (android_gsensor_kobj == NULL) {
115 "MMA8452 gsensor_sysfs_init:"\
116 "subsystem_register failed\n");
121 ret = sysfs_create_file(android_gsensor_kobj, &dev_attr_vendor.attr); // "vendor"
124 "MMA8452 gsensor_sysfs_init:"\
125 "sysfs_create_group failed\n");
131 kobject_del(android_gsensor_kobj);
136 static int mma8452_rx_data(struct i2c_client *client, char *rxData, int length)
139 char reg = rxData[0];
140 ret = i2c_master_reg8_recv(client, reg, rxData, length, MMA8452_SPEED);
141 return (ret > 0)? 0 : ret;
144 static int mma8452_tx_data(struct i2c_client *client, char *txData, int length)
147 char reg = txData[0];
148 ret = i2c_master_reg8_send(client, reg, &txData[1], length-1, MMA8452_SPEED);
149 return (ret > 0)? 0 : ret;
152 static char mma845x_read_reg(struct i2c_client *client,int addr)
158 // ret = mma8452_tx_data(client, &tmp, 1);
159 ret = mma8452_rx_data(client, &tmp, 1);
163 static int mma845x_write_reg(struct i2c_client *client,int addr,int value)
170 ret = mma8452_tx_data(client, &buffer[0], 2);
175 static char mma8452_get_devid(struct i2c_client *client)
177 printk("mma8452 devid:%x\n",mma845x_read_reg(client,MMA8452_REG_WHO_AM_I));
178 return mma845x_read_reg(client,MMA8452_REG_WHO_AM_I);
181 static int mma845x_active(struct i2c_client *client,int enable)
186 tmp = mma845x_read_reg(client,MMA8452_REG_CTRL_REG1);
191 mmaprintkd("mma845x_active %s (0x%x)\n",enable?"active":"standby",tmp);
192 ret = mma845x_write_reg(client,MMA8452_REG_CTRL_REG1,tmp);
196 static int mma8452_start_test(struct i2c_client *client)
201 mmaprintkf("-------------------------mma8452 start test------------------------\n");
204 mma845x_active(client,0);
205 mmaprintkd("mma8452 MMA8452_REG_SYSMOD:%x\n",mma845x_read_reg(client,MMA8452_REG_SYSMOD));
207 /* disable FIFO FMODE = 0*/
208 ret = mma845x_write_reg(client,MMA8452_REG_F_SETUP,0);
209 mmaprintkd("mma8452 MMA8452_REG_F_SETUP:%x\n",mma845x_read_reg(client,MMA8452_REG_F_SETUP));
211 /* set full scale range to 2g */
212 ret = mma845x_write_reg(client,MMA8452_REG_XYZ_DATA_CFG,0);
213 mmaprintkd("mma8452 MMA8452_REG_XYZ_DATA_CFG:%x\n",mma845x_read_reg(client,MMA8452_REG_XYZ_DATA_CFG));
215 /* set bus 8bit/14bit(FREAD = 1,FMODE = 0) ,data rate*/
216 tmp = (MMA8452_RATE_12P5<< MMA8452_RATE_SHIFT) | FREAD_MASK;
217 ret = mma845x_write_reg(client,MMA8452_REG_CTRL_REG1,tmp);
218 mmaprintkd("mma8452 MMA8452_REG_CTRL_REG1:%x\n",mma845x_read_reg(client,MMA8452_REG_CTRL_REG1));
220 mmaprintkd("mma8452 MMA8452_REG_SYSMOD:%x\n",mma845x_read_reg(client,MMA8452_REG_SYSMOD));
222 ret = mma845x_write_reg(client,MMA8452_REG_CTRL_REG3,5);
223 mmaprintkd("mma8452 MMA8452_REG_CTRL_REG3:%x\n",mma845x_read_reg(client,MMA8452_REG_CTRL_REG3));
225 ret = mma845x_write_reg(client,MMA8452_REG_CTRL_REG4,1);
226 mmaprintkd("mma8452 MMA8452_REG_CTRL_REG4:%x\n",mma845x_read_reg(client,MMA8452_REG_CTRL_REG4));
228 ret = mma845x_write_reg(client,MMA8452_REG_CTRL_REG5,1);
229 mmaprintkd("mma8452 MMA8452_REG_CTRL_REG5:%x\n",mma845x_read_reg(client,MMA8452_REG_CTRL_REG5));
231 mmaprintkd("mma8452 MMA8452_REG_SYSMOD:%x\n",mma845x_read_reg(client,MMA8452_REG_SYSMOD));
232 mma845x_active(client,1);
233 mmaprintkd("mma8452 MMA8452_REG_SYSMOD:%x\n",mma845x_read_reg(client,MMA8452_REG_SYSMOD));
235 enable_irq(client->irq);
241 static int mma8452_start_dev(struct i2c_client *client, char rate)
245 struct mma8452_data *mma8452 = (struct mma8452_data *)i2c_get_clientdata(client); // mma8452_data ¶¨ÒåÔÚ mma8452.h ÖÐ.
247 mmaprintkf("-------------------------mma8452 start ------------------------\n");
249 mma845x_active(client,0);
250 mmaprintkd("mma8452 MMA8452_REG_SYSMOD:%x\n",mma845x_read_reg(client,MMA8452_REG_SYSMOD));
252 /* disable FIFO FMODE = 0*/
253 ret = mma845x_write_reg(client,MMA8452_REG_F_SETUP,0);
254 mmaprintkd("mma8452 MMA8452_REG_F_SETUP:%x\n",mma845x_read_reg(client,MMA8452_REG_F_SETUP));
256 /* set full scale range to 2g */
257 ret = mma845x_write_reg(client,MMA8452_REG_XYZ_DATA_CFG,0);
258 mmaprintkd("mma8452 MMA8452_REG_XYZ_DATA_CFG:%x\n",mma845x_read_reg(client,MMA8452_REG_XYZ_DATA_CFG));
260 /* set bus 8bit/14bit(FREAD = 1,FMODE = 0) ,data rate*/
261 tmp = (rate<< MMA8452_RATE_SHIFT) | FREAD_MASK;
262 ret = mma845x_write_reg(client,MMA8452_REG_CTRL_REG1,tmp);
263 mma8452->curr_tate = rate;
264 mmaprintkd("mma8452 MMA8452_REG_CTRL_REG1:%x\n",mma845x_read_reg(client,MMA8452_REG_CTRL_REG1));
266 mmaprintkd("mma8452 MMA8452_REG_SYSMOD:%x\n",mma845x_read_reg(client,MMA8452_REG_SYSMOD));
268 ret = mma845x_write_reg(client,MMA8452_REG_CTRL_REG3,5);
269 mmaprintkd("mma8452 MMA8452_REG_CTRL_REG3:%x\n",mma845x_read_reg(client,MMA8452_REG_CTRL_REG3));
271 ret = mma845x_write_reg(client,MMA8452_REG_CTRL_REG4,1);
272 mmaprintkd("mma8452 MMA8452_REG_CTRL_REG4:%x\n",mma845x_read_reg(client,MMA8452_REG_CTRL_REG4));
274 ret = mma845x_write_reg(client,MMA8452_REG_CTRL_REG5,1);
275 mmaprintkd("mma8452 MMA8452_REG_CTRL_REG5:%x\n",mma845x_read_reg(client,MMA8452_REG_CTRL_REG5));
277 mmaprintkd("mma8452 MMA8452_REG_SYSMOD:%x\n",mma845x_read_reg(client,MMA8452_REG_SYSMOD));
278 mma845x_active(client,1);
279 mmaprintkd("mma8452 MMA8452_REG_SYSMOD:%x\n",mma845x_read_reg(client,MMA8452_REG_SYSMOD));
281 enable_irq(client->irq);
286 static int mma8452_start(struct i2c_client *client, char rate)
288 struct mma8452_data *mma8452 = (struct mma8452_data *)i2c_get_clientdata(client);
290 mmaprintkf("%s::enter\n",__FUNCTION__);
291 if (mma8452->status == MMA8452_OPEN) {
294 mma8452->status = MMA8452_OPEN;
295 return mma8452_start_dev(client, rate);
298 static int mma8452_close_dev(struct i2c_client *client)
300 disable_irq_nosync(client->irq);
301 return mma845x_active(client,0);
304 static int mma8452_close(struct i2c_client *client)
306 struct mma8452_data *mma8452 = (struct mma8452_data *)i2c_get_clientdata(client);
307 mmaprintkf("%s::enter\n",__FUNCTION__);
308 mma8452->status = MMA8452_CLOSE;
310 return mma8452_close_dev(client);
313 static int mma8452_reset_rate(struct i2c_client *client, char rate)
317 mmaprintkf("\n----------------------------mma8452_reset_rate------------------------\n");
319 ret = mma8452_close_dev(client);
320 ret = mma8452_start_dev(client, rate);
325 static inline int mma8452_convert_to_int(const char high_byte, const char low_byte)
328 /* enabled only if FREAD MODE */
330 if (high_byte < MMA8452_BOUNDARY) {
331 result = high_byte * MMA8452_GRAVITY_STEP;
333 result = ~(((~high_byte&0x7f) + 1) * MMA8452_GRAVITY_STEP) + 1;
339 result = ((int)high_byte << (MMA8451_PRECISION-8))
340 | ((int)low_byte >> (16-MMA8451_PRECISION));
341 if (result < MMA8451_BOUNDARY)
342 result = result* MMA8451_GRAVITY_STEP;
344 result = ~( ((~result & (0x7fff>>(16-MMA8451_PRECISION)) ) + 1)
345 * MMA8451_GRAVITY_STEP) + 1;
349 result = ((int)high_byte << (MMA8452_PRECISION-8))
350 | ((int)low_byte >> (16-MMA8452_PRECISION));
351 if (result < MMA8452_BOUNDARY)
352 result = result* MMA8452_GRAVITY_STEP;
354 result = ~( ((~result & (0x7fff>>(16-MMA8452_PRECISION)) ) + 1)
355 * MMA8452_GRAVITY_STEP) + 1;
359 result = ((int)high_byte << (MMA8453_PRECISION-8))
360 | ((int)low_byte >> (16-MMA8453_PRECISION));
361 if (result < MMA8453_BOUNDARY)
362 result = result* MMA8453_GRAVITY_STEP;
364 result = ~( ((~result & (0x7fff>>(16-MMA8453_PRECISION)) ) + 1)
365 * MMA8453_GRAVITY_STEP) + 1;
370 "mma8452_convert_to_int: devid wasn't set correctly\n");
377 static void mma8452_report_value(struct i2c_client *client, struct mma8452_axis *axis)
379 struct mma8452_data *mma8452 = i2c_get_clientdata(client);
380 //struct mma8452_axis *axis = (struct mma8452_axis *)rbuf;
382 /* Report acceleration sensor information */
383 input_report_abs(mma8452->input_dev, ABS_X, axis->x);
384 input_report_abs(mma8452->input_dev, ABS_Y, axis->y);
385 input_report_abs(mma8452->input_dev, ABS_Z, axis->z);
386 input_sync(mma8452->input_dev);
387 mmaprintkd("Gsensor x==%d y==%d z==%d\n",axis->x,axis->y,axis->z);
390 /** ÔÚ µ×°ë²¿Ö´ÐÐ, ¾ßÌå»ñÈ¡ g sensor Êý¾Ý. */
391 static int mma8452_get_data(struct i2c_client *client)
393 struct mma8452_data* mma8452 = i2c_get_clientdata(client);
396 struct mma8452_axis axis;
397 struct gsensor_platform_data *pdata = pdata = client->dev.platform_data;
399 /* enabled only if FREAD MODE */
403 memset(buffer, 0, 3);
404 buffer[0] = MMA8452_REG_X_OUT_MSB;
405 ret = mma8452_rx_data(client, &buffer[0], 3);
410 x = mma8452_convert_to_int(buffer[0],0);
411 y = mma8452_convert_to_int(buffer[1],0);
412 z = mma8452_convert_to_int(buffer[2],0);
416 memset(buffer, 0, 6);
417 buffer[0] = MMA8452_REG_X_OUT_MSB;
418 ret = mma8452_rx_data(client, &buffer[0], 6);
423 x = mma8452_convert_to_int(buffer[0],buffer[1]);
424 y = mma8452_convert_to_int(buffer[2],buffer[3]);
425 z = mma8452_convert_to_int(buffer[4],buffer[5]);
427 if (pdata->swap_xyz) {
428 axis.x = (pdata->orientation[0])*x + (pdata->orientation[1])*y + (pdata->orientation[2])*z;
429 axis.y = (pdata->orientation[3])*x + (pdata->orientation[4])*y + (pdata->orientation[5])*z;
430 axis.z = (pdata->orientation[6])*x + (pdata->orientation[7])*y + (pdata->orientation[8])*z;
444 mmaprintkd( "%s: ------------------mma8452_GetData axis = %d %d %d--------------\n",
445 __func__, axis.x, axis.y, axis.z);
447 //memcpy(sense_data, &axis, sizeof(axis));
448 mma8452_report_value(client, &axis);
449 //atomic_set(&data_ready, 0);
450 //wake_up(&data_ready_wq);
452 /* »¥³âµØ»º´æÊý¾Ý. */
453 mutex_lock(&(mma8452->sense_data_mutex) );
454 mma8452->sense_data = axis;
455 mutex_unlock(&(mma8452->sense_data_mutex) );
457 /* ÖÃλ data_ready */
458 atomic_set(&(mma8452->data_ready), 1);
459 /* »½ÐÑ data_ready µÈ´ý¶ÓÁÐÍ·. */
460 wake_up(&(mma8452->data_ready_wq) );
466 static int mma8452_trans_buff(char *rbuf, int size)
468 //wait_event_interruptible_timeout(data_ready_wq,
469 // atomic_read(&data_ready), 1000);
470 wait_event_interruptible(data_ready_wq,
471 atomic_read(&data_ready));
473 atomic_set(&data_ready, 0);
474 memcpy(rbuf, &sense_data[0], size);
480 static int mma8452_get_cached_data(struct i2c_client* client, struct mma8452_axis* sense_data)
482 struct mma8452_data* this = (struct mma8452_data *)i2c_get_clientdata(client);
484 wait_event_interruptible_timeout(this->data_ready_wq,
485 atomic_read(&(this->data_ready) ),
486 msecs_to_jiffies(1000) );
487 if ( 0 == atomic_read(&(this->data_ready) ) ) {
488 printk("waiting 'data_ready_wq' timed out.");
491 mutex_lock(&(this->sense_data_mutex) );
492 *sense_data = this->sense_data;
493 mutex_unlock(&(this->sense_data_mutex) );
497 static int mma8452_open(struct inode *inode, struct file *file)
499 return 0;//nonseekable_open(inode, file);
502 static int mma8452_release(struct inode *inode, struct file *file)
507 static long mma8452_ioctl( struct file *file, unsigned int cmd,unsigned long arg)
510 void __user *argp = (void __user *)arg;
511 // char msg[RBUFF_SIZE + 1];
512 struct mma8452_axis sense_data = {0};
515 struct i2c_client *client = container_of(mma8452_device.parent, struct i2c_client, dev);
516 struct mma8452_data* this = (struct mma8452_data *)i2c_get_clientdata(client); /* É豸Êý¾ÝʵÀýµÄÖ¸Õë. */
519 case MMA_IOCTL_APP_SET_RATE:
520 if (copy_from_user(&rate, argp, sizeof(rate)))
528 case MMA_IOCTL_START:
529 mutex_lock(&(this->operation_mutex) );
530 mmaprintkd("to perform 'MMA_IOCTL_START', former 'start_count' is %d.", this->start_count);
531 (this->start_count)++;
532 if ( 1 == this->start_count ) {
533 atomic_set(&(this->data_ready), 0);
534 if ( (ret = mma8452_start(client, MMA8452_RATE_12P5) ) < 0 ) {
535 mutex_unlock(&(this->operation_mutex) );
539 mutex_unlock(&(this->operation_mutex) );
540 mmaprintkd("finish 'MMA_IOCTL_START', ret = %d.", ret);
543 case MMA_IOCTL_CLOSE:
544 mutex_lock(&(this->operation_mutex) );
545 mmaprintkd("to perform 'MMA_IOCTL_CLOSE', former 'start_count' is %d, PID : %d", this->start_count, get_current()->pid);
546 if ( 0 == (--(this->start_count) ) ) {
547 atomic_set(&(this->data_ready), 0);
548 if ( (ret = mma8452_close(client) ) < 0 ) {
549 mutex_unlock(&(this->operation_mutex) );
553 mutex_unlock(&(this->operation_mutex) );
556 case MMA_IOCTL_APP_SET_RATE:
557 ret = mma8452_reset_rate(client, rate);
561 case MMA_IOCTL_GETDATA:
562 // ret = mma8452_trans_buff(msg, RBUFF_SIZE);
563 if ( (ret = mma8452_get_cached_data(client, &sense_data) ) < 0 ) {
564 printk("failed to get cached sense data, ret = %d.", ret);
573 case MMA_IOCTL_GETDATA:
575 if (copy_to_user(argp, &msg, sizeof(msg)))
578 if ( copy_to_user(argp, &sense_data, sizeof(sense_data) ) ) {
579 printk("failed to copy sense data to user space.");
590 static void mma8452_work_func(struct work_struct *work)
592 struct mma8452_data *mma8452 = container_of(work, struct mma8452_data, work);
593 struct i2c_client *client = mma8452->client;
595 if (mma8452_get_data(client) < 0)
596 mmaprintkd(KERN_ERR "MMA8452 mma_work_func: Get data failed\n");
598 enable_irq(client->irq);
601 static void mma8452_delaywork_func(struct work_struct *work)
603 struct delayed_work *delaywork = container_of(work, struct delayed_work, work);
604 struct mma8452_data *mma8452 = container_of(delaywork, struct mma8452_data, delaywork);
605 struct i2c_client *client = mma8452->client;
607 if (mma8452_get_data(client) < 0)
608 printk(KERN_ERR "MMA8452 mma_work_func: Get data failed\n");
609 mmaprintkd("%s :int src:0x%02x\n",__FUNCTION__,mma845x_read_reg(mma8452->client,MMA8452_REG_INTSRC));
610 enable_irq(client->irq);
613 static irqreturn_t mma8452_interrupt(int irq, void *dev_id)
615 struct mma8452_data *mma8452 = (struct mma8452_data *)dev_id;
617 disable_irq_nosync(irq);
618 schedule_delayed_work(&mma8452->delaywork, msecs_to_jiffies(30));
619 mmaprintkf("%s :enter\n",__FUNCTION__);
623 static struct file_operations mma8452_fops = {
624 .owner = THIS_MODULE,
625 .open = mma8452_open,
626 .release = mma8452_release,
627 .unlocked_ioctl = mma8452_ioctl,
630 static struct miscdevice mma8452_device = {
631 .minor = MISC_DYNAMIC_MINOR,
632 .name = "mma8452_daemon",//"mma8452_daemon",
633 .fops = &mma8452_fops,
636 static int mma8452_remove(struct i2c_client *client)
638 struct mma8452_data *mma8452 = i2c_get_clientdata(client);
640 misc_deregister(&mma8452_device);
641 input_unregister_device(mma8452->input_dev);
642 input_free_device(mma8452->input_dev);
643 free_irq(client->irq, mma8452);
649 static const struct i2c_device_id mma8452_id[] = {
654 static struct i2c_driver mma8452_driver = {
656 .name = "gs_mma8452",
658 .id_table = mma8452_id,
659 .probe = mma8452_probe,
660 .remove = __devexit_p(mma8452_remove),
664 static int mma8452_init_client(struct i2c_client *client)
666 struct mma8452_data *mma8452;
668 mma8452 = i2c_get_clientdata(client);
669 mmaprintk("gpio_to_irq(%d) is %d\n",client->irq,gpio_to_irq(client->irq));
670 if ( !gpio_is_valid(client->irq)) {
671 mmaprintk("+++++++++++gpio_is_invalid\n");
674 ret = gpio_request(client->irq, "mma8452_int");
676 mmaprintk( "failed to request mma7990_trig GPIO%d\n",gpio_to_irq(client->irq));
679 ret = gpio_direction_input(client->irq);
681 mmaprintk("failed to set mma7990_trig GPIO gpio input\n");
682 gpio_free(client->irq);
685 gpio_pull_updown(client->irq, GPIOPullUp);
686 irq = gpio_to_irq(client->irq);
687 ret = request_irq(irq, mma8452_interrupt, IRQF_TRIGGER_LOW, client->dev.driver->name, mma8452);
688 mmaprintk("request irq is %d,ret is 0x%x\n",irq,ret);
690 gpio_free(client->irq);
691 mmaprintk(KERN_ERR "mma8452_init_client: request irq failed,ret is %d\n",ret);
695 disable_irq(client->irq);
696 init_waitqueue_head(&data_ready_wq);
701 static int mma8452_probe(struct i2c_client *client, const struct i2c_device_id *id)
703 struct mma8452_data *mma8452;
704 struct gsensor_platform_data *pdata = pdata = client->dev.platform_data;
707 mmaprintkf("%s enter\n",__FUNCTION__);
709 mma8452 = kzalloc(sizeof(struct mma8452_data), GFP_KERNEL);
711 mmaprintk("[mma8452]:alloc data failed.\n");
713 goto exit_alloc_data_failed;
716 INIT_WORK(&mma8452->work, mma8452_work_func);
717 INIT_DELAYED_WORK(&mma8452->delaywork, mma8452_delaywork_func);
719 memset(&(mma8452->sense_data), 0, sizeof(struct mma8452_axis) );
720 mutex_init(&(mma8452->sense_data_mutex) );
722 atomic_set(&(mma8452->data_ready), 0);
723 init_waitqueue_head(&(mma8452->data_ready_wq) );
725 mma8452->start_count = 0;
726 mutex_init(&(mma8452->operation_mutex) );
728 mma8452->status = MMA8452_CLOSE;
730 mma8452->client = client;
731 i2c_set_clientdata(client, mma8452);
733 this_client = client;
735 devid = mma8452_get_devid(this_client);
736 if ((MMA8452_DEVID != devid)
737 && (MMA8451_DEVID != devid)
738 && (MMA8453_DEVID != devid)) {
739 pr_info("mma8452: invalid devid\n");
740 goto exit_invalid_devid;
743 err = mma8452_init_client(client);
746 "mma8452_probe: mma8452_init_client failed\n");
747 goto exit_request_gpio_irq_failed;
750 mma8452->input_dev = input_allocate_device();
751 if (!mma8452->input_dev) {
754 "mma8452_probe: Failed to allocate input device\n");
755 goto exit_input_allocate_device_failed;
758 set_bit(EV_ABS, mma8452->input_dev->evbit);
760 /* x-axis acceleration */
761 input_set_abs_params(mma8452->input_dev, ABS_X, -MMA845X_RANGE, MMA845X_RANGE, 0, 0); //2g full scale range
762 /* y-axis acceleration */
763 input_set_abs_params(mma8452->input_dev, ABS_Y, -MMA845X_RANGE, MMA845X_RANGE, 0, 0); //2g full scale range
764 /* z-axis acceleration */
765 input_set_abs_params(mma8452->input_dev, ABS_Z, -MMA845X_RANGE, MMA845X_RANGE, 0, 0); //2g full scale range
767 // mma8452->input_dev->name = "compass";
768 mma8452->input_dev->name = "gsensor";
769 mma8452->input_dev->dev.parent = &client->dev;
771 err = input_register_device(mma8452->input_dev);
774 "mma8452_probe: Unable to register input device: %s\n",
775 mma8452->input_dev->name);
776 goto exit_input_register_device_failed;
779 mma8452_device.parent = &client->dev;
780 err = misc_register(&mma8452_device);
783 "mma8452_probe: mmad_device register failed\n");
784 goto exit_misc_device_register_mma8452_device_failed;
787 err = gsensor_sysfs_init();
790 "mma8452_probe: gsensor sysfs init failed\n");
791 goto exit_gsensor_sysfs_init_failed;
794 printk(KERN_INFO "mma8452 probe ok\n");
796 // mma8452_start_test(this_client);
797 mma8452_start(client, MMA8452_RATE_12P5);
801 exit_gsensor_sysfs_init_failed:
802 misc_deregister(&mma8452_device);
803 exit_misc_device_register_mma8452_device_failed:
804 input_unregister_device(mma8452->input_dev);
805 exit_input_register_device_failed:
806 input_free_device(mma8452->input_dev);
807 exit_input_allocate_device_failed:
808 free_irq(client->irq, mma8452);
809 exit_request_gpio_irq_failed:
810 cancel_delayed_work_sync(&mma8452->delaywork);
811 cancel_work_sync(&mma8452->work);
814 exit_alloc_data_failed:
816 mmaprintk("%s error\n",__FUNCTION__);
821 static int __init mma8452_i2c_init(void)
823 return i2c_add_driver(&mma8452_driver);
826 static void __exit mma8452_i2c_exit(void)
828 i2c_del_driver(&mma8452_driver);
831 module_init(mma8452_i2c_init);
832 module_exit(mma8452_i2c_exit);