-/* drivers/input/sensors/access/kxtik.c\r
- *\r
- * Copyright (C) 2012-2015 ROCKCHIP.\r
- * Author: luowei <lw@rock-chips.com>\r
- *\r
- * This software is licensed under the terms of the GNU General Public\r
- * License version 2, as published by the Free Software Foundation, and\r
- * may be copied, distributed, and modified under those terms.\r
- *\r
- * This program is distributed in the hope that it will be useful,\r
- * but WITHOUT ANY WARRANTY; without even the implied warranty of\r
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the\r
- * GNU General Public License for more details.\r
- *\r
- */\r
-#include <linux/interrupt.h>\r
-#include <linux/i2c.h>\r
-#include <linux/slab.h>\r
-#include <linux/irq.h>\r
-#include <linux/miscdevice.h>\r
-#include <linux/gpio.h>\r
-#include <asm/uaccess.h>\r
-#include <asm/atomic.h>\r
-#include <linux/delay.h>\r
-#include <linux/input.h>\r
-#include <linux/workqueue.h>\r
-#include <linux/freezer.h>\r
-#include <mach/gpio.h>\r
-#include <mach/board.h> \r
-#ifdef CONFIG_HAS_EARLYSUSPEND\r
-#include <linux/earlysuspend.h>\r
-#endif\r
-#include <linux/sensor-dev.h>\r
-\r
-\r
+/* drivers/input/sensors/access/kxtik.c
+ *
+ * Copyright (C) 2012-2015 ROCKCHIP.
+ * Author: luowei <lw@rock-chips.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.
+ *
+ */
+#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 <asm/uaccess.h>
+#include <asm/atomic.h>
+#include <linux/delay.h>
+#include <linux/input.h>
+#include <linux/workqueue.h>
+#include <linux/freezer.h>
+#include <mach/gpio.h>
+#include <mach/board.h>
+#ifdef CONFIG_HAS_EARLYSUSPEND
+#include <linux/earlysuspend.h>
+#endif
+#include <linux/sensor-dev.h>
+
+
#define AP3212B_NUM_CACHABLE_REGS 23
-#define AP3216C_NUM_CACHABLE_REGS 26\r
-\r
+#define AP3216C_NUM_CACHABLE_REGS 26
+
#define AP3212B_RAN_COMMAND 0x10
#define AP3212B_RAN_MASK 0x30
#define AP3212B_RAN_SHIFT (4)
#define AP3212B_MODE_COMMAND 0x00
#define AP3212B_MODE_SHIFT (0)
-#define AP3212B_MODE_MASK 0x07\r
-\r
+#define AP3212B_MODE_MASK 0x07
+
#define AP3212B_INT_COMMAND 0x01
#define AP3212B_INT_SHIFT (0)
#define AP3212B_INT_MASK 0x03
#define AP3212B_INT_PMASK 0x02
#define AP3212B_INT_AMASK 0x01
-\r
+
#define AP3212B_OBJ_COMMAND 0x0f
#define AP3212B_OBJ_MASK 0x80
-#define AP3212B_OBJ_SHIFT (7)\r
-\r
-\r
+#define AP3212B_OBJ_SHIFT (7)
+
+
/*
* register access helpers
*/
static int __ap321xx_read_reg(struct i2c_client *client,
u32 reg, u8 mask, u8 shift)
{
- u8 val;\r
+ u8 val;
val = i2c_smbus_read_byte_data(client, reg);
- return (val & mask) >> shift;\r
+ return (val & mask) >> shift;
}
static int __ap321xx_write_reg(struct i2c_client *client,
u32 reg, u8 mask, u8 shift, u8 val)
{
- int ret = 0;\r
+ int ret = 0;
u8 tmp;
tmp = i2c_smbus_read_byte_data(client, reg);
tmp |= val << shift;
ret = i2c_smbus_write_byte_data(client, reg, tmp);
-
+
return ret;
}
-\r
-\r
+
+
/*
* internally used functions
- */\r
+ */
/* range */
-static int ap321xx_set_range(struct i2c_client *client, int range)\r
+static int ap321xx_set_range(struct i2c_client *client, int range)
{
return __ap321xx_write_reg(client, AP3212B_RAN_COMMAND,
AP3212B_RAN_MASK, AP3212B_RAN_SHIFT, range);;
/* mode */
static int ap321xx_get_mode(struct i2c_client *client)
{
- struct sensor_private_data *sensor =\r
- (struct sensor_private_data *) i2c_get_clientdata(client); \r
+ struct sensor_private_data *sensor =
+ (struct sensor_private_data *) i2c_get_clientdata(client);
int ret;
ret = __ap321xx_read_reg(client, sensor->ops->ctrl_reg,
AP3212B_MODE_MASK, AP3212B_MODE_SHIFT);
return ret;
}
-static int ap321xx_set_mode(struct i2c_client *client, int mode)\r
+static int ap321xx_set_mode(struct i2c_client *client, int mode)
{
- struct sensor_private_data *sensor =\r
- (struct sensor_private_data *) i2c_get_clientdata(client); \r
+ struct sensor_private_data *sensor =
+ (struct sensor_private_data *) i2c_get_clientdata(client);
int ret;
ret = __ap321xx_write_reg(client, sensor->ops->ctrl_reg,
AP3212B_MODE_MASK, AP3212B_MODE_SHIFT, mode);
return ret;
-}\r
+}
static int ap321xx_get_intstat(struct i2c_client *client)
{
- struct sensor_private_data *sensor =\r
- (struct sensor_private_data *) i2c_get_clientdata(client); \r
- int val;\r
- \r
- val = i2c_smbus_read_byte_data(client, sensor->ops->int_status_reg);\r
- val &= AP3212B_INT_MASK;\r
-\r
- return val >> AP3212B_INT_SHIFT;\r
-}\r
-\r
+ struct sensor_private_data *sensor =
+ (struct sensor_private_data *) i2c_get_clientdata(client);
+ int val;
+
+ val = i2c_smbus_read_byte_data(client, sensor->ops->int_status_reg);
+ val &= AP3212B_INT_MASK;
+
+ return val >> AP3212B_INT_SHIFT;
+}
+
static int ap321xx_get_object(struct i2c_client *client)
{
int val;
return val >> AP3212B_OBJ_SHIFT;
}
-\r
-\r
-static int ap321xx_product_detect(struct i2c_client *client)\r
+
+
+static int ap321xx_product_detect(struct i2c_client *client)
{
int mid = i2c_smbus_read_byte_data(client, 0x03);
int pid = i2c_smbus_read_byte_data(client, 0x04);
int rid = i2c_smbus_read_byte_data(client, 0x05);
- if ( mid == 0x01 && pid == 0x01 &&
+ if ( mid == 0x01 && pid == 0x01 &&
(rid == 0x03 || rid == 0x04) )
{
- //printk("RevID [%d], ==> DA3212 v1.5~1.8 ...... AP3212B detected\n", rid);\r
+ //printk("RevID [%d], ==> DA3212 v1.5~1.8 ...... AP3212B detected\n", rid);
}
- else if ( (mid == 0x01 && pid == 0x02 && rid == 0x00) ||
+ else if ( (mid == 0x01 && pid == 0x02 && rid == 0x00) ||
(mid == 0x02 && pid == 0x02 && rid == 0x01))
{
- //printk("RevID [%d], ==> DA3212 v2.0 ...... AP3212C/AP3216C detected\n", rid);\r
+ //printk("RevID [%d], ==> DA3212 v2.0 ...... AP3212C/AP3216C detected\n", rid);
}
else
{
- printk("MakeID[%d] ProductID[%d] RevID[%d] .... can't detect ... bad reversion!!!\n", mid, pid, rid);\r
+ printk("MakeID[%d] ProductID[%d] RevID[%d] .... can't detect ... bad reversion!!!\n", mid, pid, rid);
return -EIO;
}
-\r
+
return 0;
-}\r
-\r
+}
+
static int ap321xx_init_client(struct i2c_client *client)
{
/* set defaults */
ap321xx_set_mode(client, 0);
return 0;
-}\r
-\r
+}
+
static int ap321xx_psensor_enable(struct i2c_client *client)
{
int ret = 0,mode;
-
+
mode = ap321xx_get_mode(client);
if((mode & 0x02) == 0){
mode |= 0x02;
ret = ap321xx_set_mode(client,mode);
}
-
+
return ret;
}
static int ap321xx_psensor_disable(struct i2c_client *client)
{
int ret = 0,mode;
-
+
mode = ap321xx_get_mode(client);
if(mode & 0x02){
mode &= ~0x02;
ret = ap321xx_set_mode(client,mode);
}
return ret;
-}\r
-\r
-/****************operate according to sensor chip:start************/\r
-\r
-static int sensor_active(struct i2c_client *client, int enable, int rate)\r
-{\r
- int result = 0;\r
- \r
- //register setting according to chip datasheet \r
- if (enable){\r
- result = ap321xx_psensor_enable(client);\r
- }\r
- else\r
- result = ap321xx_psensor_disable(client);\r
-\r
- if(result)\r
- printk("%s:fail to active sensor\n",__func__);\r
-\r
- return result;\r
-\r
-}\r
-\r
-\r
-static int sensor_init(struct i2c_client *client)\r
-{ \r
- struct sensor_private_data *sensor =\r
- (struct sensor_private_data *) i2c_get_clientdata(client); \r
- int result = 0;\r
-\r
- result = ap321xx_product_detect(client);\r
- if (result)\r
+}
+
+/****************operate according to sensor chip:start************/
+
+static int sensor_active(struct i2c_client *client, int enable, int rate)
+{
+ int result = 0;
+
+ //register setting according to chip datasheet
+ if (enable){
+ result = ap321xx_psensor_enable(client);
+ }
+ else
+ result = ap321xx_psensor_disable(client);
+
+ if(result)
+ printk("%s:fail to active sensor\n",__func__);
+
+ return result;
+
+}
+
+
+static int sensor_init(struct i2c_client *client)
+{
+ struct sensor_private_data *sensor =
+ (struct sensor_private_data *) i2c_get_clientdata(client);
+ int result = 0;
+
+ result = ap321xx_product_detect(client);
+ if (result)
{
- dev_err(&client->dev, "ret: %d, product version detect failed.\n",result);\r
- return result;\r
- }\r
-\r
+ dev_err(&client->dev, "ret: %d, product version detect failed.\n",result);
+ return result;
+ }
+
/* initialize the AP3212B chip */
- result = ap321xx_init_client(client);\r
- if (result)\r
- return result;\r
- \r
- result = sensor->ops->active(client,0,0);\r
- if(result)\r
- {\r
- printk("%s:line=%d,error\n",__func__,__LINE__);\r
- return result;\r
- }\r
- \r
- sensor->status_cur = SENSOR_OFF;\r
- \r
- return result;\r
-}\r
-\r
-static int sensor_report_value(struct i2c_client *client)\r
-{\r
- struct sensor_private_data *sensor =\r
- (struct sensor_private_data *) i2c_get_clientdata(client); \r
- int result = 0;\r
- char value = 0;\r
- u8 int_stat;\r
- \r
- int_stat = ap321xx_get_intstat(client);\r
+ result = ap321xx_init_client(client);
+ if (result)
+ return result;
+
+ result = sensor->ops->active(client,0,0);
+ if(result)
+ {
+ printk("%s:line=%d,error\n",__func__,__LINE__);
+ return result;
+ }
+
+ sensor->status_cur = SENSOR_OFF;
+
+ return result;
+}
+
+static int sensor_report_value(struct i2c_client *client)
+{
+ struct sensor_private_data *sensor =
+ (struct sensor_private_data *) i2c_get_clientdata(client);
+ int result = 0;
+ char value = 0;
+ u8 int_stat;
+
+ int_stat = ap321xx_get_intstat(client);
// ALS int
- if (int_stat & AP3212B_INT_PMASK)\r
+ if (int_stat & AP3212B_INT_PMASK)
{
- value = ap321xx_get_object(client);\r
- input_report_abs(sensor->input_dev, ABS_DISTANCE, value);\r
- input_sync(sensor->input_dev);\r
+ value = ap321xx_get_object(client);
+ input_report_abs(sensor->input_dev, ABS_DISTANCE, value);
+ input_sync(sensor->input_dev);
}
- \r
- return result;\r
-}\r
-\r
-struct sensor_operate proximity_ap321xx_ops = {\r
- .name = "ps_ap321xx",\r
- .type = SENSOR_TYPE_PROXIMITY, //sensor type and it should be correct\r
- .id_i2c = PROXIMITY_ID_AP321XX, //i2c id number\r
- .read_reg = SENSOR_UNKNOW_DATA, //read data //there are two regs, we fix them in code.\r
- .read_len = 1, //data length\r
- .id_reg = SENSOR_UNKNOW_DATA, //read device id from this register //there are 3 regs, we fix them in code.\r
- .id_data = SENSOR_UNKNOW_DATA, //device id\r
- .precision = 8, //8 bits\r
- .ctrl_reg = AP3212B_MODE_COMMAND, //enable or disable \r
- .int_status_reg = AP3212B_INT_COMMAND, //intterupt status register\r
- .range = {0,10}, //range\r
- .brightness ={10,255}, // brightness\r
- .trig = IRQF_TRIGGER_FALLING | IRQF_ONESHOT | IRQF_SHARED, \r
- .active = sensor_active, \r
- .init = sensor_init,\r
- .report = sensor_report_value,\r
-};\r
-\r
-/****************operate according to sensor chip:end************/\r
-\r
-//function name should not be changed\r
-static struct sensor_operate *proximity_get_ops(void)\r
-{\r
- return &proximity_ap321xx_ops;\r
-}\r
-\r
-\r
-static int __init proximity_ap321xx_init(void)\r
-{\r
- struct sensor_operate *ops = proximity_get_ops();\r
- int result = 0;\r
- int type = ops->type;\r
- result = sensor_register_slave(type, NULL, NULL, proximity_get_ops);\r
- return result;\r
-}\r
-\r
-static void __exit proximity_ap321xx_exit(void)\r
-{\r
- struct sensor_operate *ops = proximity_get_ops();\r
- int type = ops->type;\r
- sensor_unregister_slave(type, NULL, NULL, proximity_get_ops);\r
-}\r
-\r
-\r
-module_init(proximity_ap321xx_init);\r
-module_exit(proximity_ap321xx_exit);\r
-\r
-\r
+
+ return result;
+}
+
+struct sensor_operate proximity_ap321xx_ops = {
+ .name = "ps_ap321xx",
+ .type = SENSOR_TYPE_PROXIMITY, //sensor type and it should be correct
+ .id_i2c = PROXIMITY_ID_AP321XX, //i2c id number
+ .read_reg = SENSOR_UNKNOW_DATA, //read data //there are two regs, we fix them in code.
+ .read_len = 1, //data length
+ .id_reg = SENSOR_UNKNOW_DATA, //read device id from this register //there are 3 regs, we fix them in code.
+ .id_data = SENSOR_UNKNOW_DATA, //device id
+ .precision = 8, //8 bits
+ .ctrl_reg = AP3212B_MODE_COMMAND, //enable or disable
+ .int_status_reg = AP3212B_INT_COMMAND, //intterupt status register
+ .range = {0,10}, //range
+ .brightness ={10,255}, // brightness
+ .trig = IRQF_TRIGGER_FALLING | IRQF_ONESHOT | IRQF_SHARED,
+ .active = sensor_active,
+ .init = sensor_init,
+ .report = sensor_report_value,
+};
+
+/****************operate according to sensor chip:end************/
+
+//function name should not be changed
+static struct sensor_operate *proximity_get_ops(void)
+{
+ return &proximity_ap321xx_ops;
+}
+
+
+static int __init proximity_ap321xx_init(void)
+{
+ struct sensor_operate *ops = proximity_get_ops();
+ int result = 0;
+ int type = ops->type;
+ result = sensor_register_slave(type, NULL, NULL, proximity_get_ops);
+ return result;
+}
+
+static void __exit proximity_ap321xx_exit(void)
+{
+ struct sensor_operate *ops = proximity_get_ops();
+ int type = ops->type;
+ sensor_unregister_slave(type, NULL, NULL, proximity_get_ops);
+}
+
+
+module_init(proximity_ap321xx_init);
+module_exit(proximity_ap321xx_exit);
+
+