#include <linux/l3g4200d.h>\r
#include <linux/sensor-dev.h>\r
\r
-#define SENSOR_ON 1\r
-#define SENSOR_OFF 0\r
\r
#if 0\r
#define SENSOR_DEBUG_TYPE SENSOR_TYPE_ACCEL\r
goto error; \r
}\r
client->irq = irq;\r
- if((sensor->pdata->type == SENSOR_TYPE_GYROSCOPE))\r
+ if((sensor->pdata->type == SENSOR_TYPE_GYROSCOPE) || (sensor->pdata->type == SENSOR_TYPE_ACCEL))\r
disable_irq_nosync(client->irq);//disable irq\r
printk("%s:use irq=%d\n",__func__,irq);\r
}\r
} \r
if(sensor->pdata->irq_enable)\r
{\r
- //printk("%s:enable irq,irq=%d\n",__func__,client->irq);\r
- //enable_irq(client->irq); //enable irq\r
+ DBG("%s:enable irq,irq=%d\n",__func__,client->irq);\r
+ enable_irq(client->irq); //enable irq\r
} \r
else\r
{\r
\r
if(sensor->pdata->irq_enable)\r
{ \r
- //printk("%s:disable irq,irq=%d\n",__func__,client->irq);\r
- //disable_irq_nosync(client->irq);//disable irq\r
+ DBG("%s:disable irq,irq=%d\n",__func__,client->irq);\r
+ disable_irq_nosync(client->irq);//disable irq\r
}\r
else\r
cancel_delayed_work_sync(&sensor->delaywork); \r
mutex_unlock(&sensor->operation_mutex);\r
goto error;\r
}\r
- if(sensor->status_cur == SENSOR_OFF)\r
- { \r
- if(sensor->pdata->irq_enable)\r
- {\r
- //printk("%s:enable irq,irq=%d\n",__func__,client->irq);\r
- //enable_irq(client->irq); //enable irq\r
- } \r
- else\r
- {\r
- PREPARE_DELAYED_WORK(&sensor->delaywork, sensor_delaywork_func);\r
- schedule_delayed_work(&sensor->delaywork, msecs_to_jiffies(sensor->pdata->poll_delay_ms));\r
- }\r
- sensor->status_cur = SENSOR_ON;\r
- } \r
+\r
+ sensor->status_cur = SENSOR_ON;\r
mutex_unlock(&sensor->operation_mutex); \r
DBG("%s:GSENSOR_IOCTL_APP_SET_RATE OK\n", __func__);\r
break;\r