drivers/input/sensors/psensor/ps_stk3171.c

   1 /* drivers/input/sensors/access/kxtik.c\r
   2  *\r
   3  * Copyright (C) 2012-2015 ROCKCHIP.\r
   4  * Author: luowei <lw@rock-chips.com>\r
   5  *\r
   6  * This software is licensed under the terms of the GNU General Public\r
   7  * License version 2, as published by the Free Software Foundation, and\r
   8  * may be copied, distributed, and modified under those terms.\r
   9  *\r
  10  * This program is distributed in the hope that it will be useful,\r
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of\r
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\r
  13  * GNU General Public License for more details.\r
  14  *\r
  15  */\r
  16 #include <linux/interrupt.h>\r
  17 #include <linux/i2c.h>\r
  18 #include <linux/slab.h>\r
  19 #include <linux/irq.h>\r
  20 #include <linux/miscdevice.h>\r
  21 #include <linux/gpio.h>\r
  22 #include <asm/uaccess.h>\r
  23 #include <asm/atomic.h>\r
  24 #include <linux/delay.h>\r
  25 #include <linux/input.h>\r
  26 #include <linux/workqueue.h>\r
  27 #include <linux/freezer.h>\r
  28 #include <mach/gpio.h>\r
  29 #include <mach/board.h> \r
  30 #ifdef CONFIG_HAS_EARLYSUSPEND\r
  31 #include <linux/earlysuspend.h>\r
  32 #endif\r
  33 #include <linux/sensor-dev.h>\r
  34 \r
  35 \r
  36 #define ALS_CMD         0x01\r
  37 #define ALS_DT1         0x02\r
  38 #define ALS_DT2         0X03\r
  39 #define ALS_THDH1       0X04\r
  40 #define ALS_THDH2       0X05\r
  41 #define ALS_THDL1       0X06\r
  42 #define ALS_THDL2       0X07\r
  43 #define STA_TUS         0X08\r
  44 #define PS_CMD          0X09\r
  45 #define PS_DT           0X0A\r
  46 #define PS_THDH         0X0B\r
  47 #define PS_THDL         0X0C\r
  48 #define SW_RESET        0X80\r
  49 \r
  50 //ALS_CMD\r
  51 #define ALS_SD_ENABLE   (0<<0)\r
  52 #define ALS_SD_DISABLE  (1<<0)\r
  53 #define ALS_INT_DISABLE (0<<1)\r
  54 #define ALS_INT_ENABLE  (1<<1)\r
  55 #define ALS_1T_100MS    (0<<2)\r
  56 #define ALS_2T_200MS    (1<<2)\r
  57 #define ALS_4T_400MS    (2<<2)\r
  58 #define ALS_8T_800MS    (3<<2)\r
  59 #define ALS_RANGE_57671 (0<<6)\r
  60 #define ALS_RANGE_28836 (1<<6)\r
  61 \r
  62 //PS_CMD\r
  63 #define PS_SD_ENABLE    (0<<0)\r
  64 #define PS_SD_DISABLE   (1<<0)\r
  65 #define PS_INT_DISABLE  (0<<1)\r
  66 #define PS_INT_ENABLE   (1<<1)\r
  67 #define PS_10T_2MS      (0<<2)\r
  68 #define PS_15T_3MS      (1<<2)\r
  69 #define PS_20T_4MS      (2<<2)\r
  70 #define PS_25T_5MS      (3<<2)\r
  71 #define PS_CUR_100MA    (0<<4)\r
  72 #define PS_CUR_200MA    (1<<4)\r
  73 #define PS_SLP_10MS     (0<<5)\r
  74 #define PS_SLP_30MS     (1<<5)\r
  75 #define PS_SLP_90MS     (2<<5)\r
  76 #define PS_SLP_270MS    (3<<5)\r
  77 #define TRIG_PS_OR_LS   (0<<7)\r
  78 #define TRIG_PS_AND_LS  (1<<7)\r
  79 \r
  80 //STA_TUS\r
  81 #define STA_PS_INT      (1<<5)\r
  82 #define STA_ALS_INT     (1<<4)\r
  83 \r
  84 \r
  85 /****************operate according to sensor chip:start************/\r
  86 \r
  87 static int sensor_active(struct i2c_client *client, int enable, int rate)\r
  88 {\r
  89         struct sensor_private_data *sensor =\r
  90             (struct sensor_private_data *) i2c_get_clientdata(client);  \r
  91         int result = 0;\r
  92         int status = 0;\r
  93 \r
  94         sensor->ops->ctrl_data = sensor_read_reg(client, sensor->ops->ctrl_reg);\r
  95         \r
  96         //register setting according to chip datasheet          \r
  97         if(!enable)\r
  98         {       \r
  99                 status = PS_SD_DISABLE; \r
 100                 sensor->ops->ctrl_data |= status;       \r
 101         }\r
 102         else\r
 103         {\r
 104                 status = ~PS_SD_DISABLE;\r
 105                 sensor->ops->ctrl_data &= status;\r
 106         }\r
 107                 \r
 108         DBG("%s:reg=0x%x,reg_ctrl=0x%x,enable=%d\n",__func__,sensor->ops->ctrl_reg, sensor->ops->ctrl_data, enable);\r
 109         result = sensor_write_reg(client, sensor->ops->ctrl_reg, sensor->ops->ctrl_data);\r
 110         if(result)\r
 111                 printk("%s:fail to active sensor\n",__func__);\r
 112 \r
 113         if(enable)\r
 114         sensor->ops->report(sensor->client);\r
 115 \r
 116         return result;\r
 117 \r
 118 }\r
 119 \r
 120 \r
 121 static int sensor_init(struct i2c_client *client)\r
 122 {       \r
 123         struct sensor_private_data *sensor =\r
 124             (struct sensor_private_data *) i2c_get_clientdata(client);  \r
 125         int result = 0;\r
 126         \r
 127         result = sensor->ops->active(client,0,0);\r
 128         if(result)\r
 129         {\r
 130                 printk("%s:line=%d,error\n",__func__,__LINE__);\r
 131                 return result;\r
 132         }\r
 133         \r
 134         sensor->status_cur = SENSOR_OFF;\r
 135 \r
 136         result = sensor_write_reg(client, SW_RESET, 0);\r
 137         if(result)\r
 138         {\r
 139                 printk("%s:line=%d,error\n",__func__,__LINE__);\r
 140                 return result;\r
 141         }\r
 142 \r
 143 \r
 144         sensor->ops->ctrl_data |= PS_15T_3MS| PS_SLP_90MS;\r
 145         sensor->ops->ctrl_data &= ~TRIG_PS_AND_LS;\r
 146 \r
 147         if(sensor->pdata->irq_enable)\r
 148                 sensor->ops->ctrl_data |= PS_INT_ENABLE;\r
 149         else\r
 150                 sensor->ops->ctrl_data &= ~PS_INT_ENABLE;\r
 151         \r
 152         result = sensor_write_reg(client, sensor->ops->ctrl_reg, sensor->ops->ctrl_data);\r
 153         if(result)\r
 154         {\r
 155                 printk("%s:line=%d,error\n",__func__,__LINE__);\r
 156                 return result;\r
 157         }\r
 158                 \r
 159         return result;\r
 160 }\r
 161 \r
 162 \r
 163 \r
 164 static int sensor_report_value(struct i2c_client *client)\r
 165 {\r
 166         struct sensor_private_data *sensor =\r
 167             (struct sensor_private_data *) i2c_get_clientdata(client);  \r
 168         int result = 0;\r
 169         int value = 0;\r
 170         char buffer[1] = {0};   \r
 171         \r
 172         if(sensor->ops->read_len < 1)   //sensor->ops->read_len = 1\r
 173         {\r
 174                 printk("%s:lenth is error,len=%d\n",__func__,sensor->ops->read_len);\r
 175                 return -1;\r
 176         }\r
 177         \r
 178         memset(buffer, 0, 1);\r
 179 \r
 180         buffer[0] = sensor->ops->read_reg;\r
 181         result = sensor_rx_data(client, buffer, sensor->ops->read_len); \r
 182         if(result)\r
 183         {\r
 184                 printk("%s:line=%d,error\n",__func__,__LINE__);\r
 185                 return result;\r
 186         }\r
 187 \r
 188 \r
 189         value = buffer[0];\r
 190         \r
 191         input_report_abs(sensor->input_dev, ABS_DISTANCE, (value>>2)?0:1);\r
 192         input_sync(sensor->input_dev);\r
 193         DBG("%s:%s result=0x%x,index=%d\n",__func__,sensor->ops->name, value,(value>>2)?0:1);           \r
 194         \r
 195         if(sensor->pdata->irq_enable)\r
 196         {\r
 197                 if(sensor->ops->int_status_reg)\r
 198                 {       \r
 199                         value = sensor_read_reg(client, sensor->ops->int_status_reg);\r
 200                 }\r
 201                 \r
 202                 if(value & STA_PS_INT)\r
 203                 {\r
 204                         value &= ~STA_PS_INT;\r
 205                         result = sensor_write_reg(client, sensor->ops->int_status_reg,value);   //clear int\r
 206                         if(result)\r
 207                         {\r
 208                                 printk("%s:line=%d,error\n",__func__,__LINE__);\r
 209                                 return result;\r
 210                         }\r
 211                 }\r
 212         }\r
 213                                 \r
 214         return result;\r
 215 }\r
 216 \r
 217 struct sensor_operate proximity_stk3171_ops = {\r
 218         .name                           = "ps_stk3171",\r
 219         .type                           = SENSOR_TYPE_PROXIMITY,        //sensor type and it should be correct\r
 220         .id_i2c                         = PROXIMITY_ID_STK3171,         //i2c id number\r
 221         .read_reg                       = PS_DT,                        //read data\r
 222         .read_len                       = 1,                            //data length\r
 223         .id_reg                         = SENSOR_UNKNOW_DATA,           //read device id from this register\r
 224         .id_data                        = SENSOR_UNKNOW_DATA,           //device id\r
 225         .precision                      = 8,                            //8 bits\r
 226         .ctrl_reg                       = PS_CMD,                       //enable or disable \r
 227         .int_status_reg                 = STA_TUS,                      //intterupt status register\r
 228         .range                          = {0,1},                        //range\r
 229         .trig                           = IRQF_TRIGGER_LOW | IRQF_ONESHOT | IRQF_SHARED,                \r
 230         .active                         = sensor_active,        \r
 231         .init                           = sensor_init,\r
 232         .report                         = sensor_report_value,\r
 233 };\r
 234 \r
 235 /****************operate according to sensor chip:end************/\r
 236 \r
 237 //function name should not be changed\r
 238 static struct sensor_operate *proximity_get_ops(void)\r
 239 {\r
 240         return &proximity_stk3171_ops;\r
 241 }\r
 242 \r
 243 static int __init proximity_stk3171_init(void)\r
 244 {\r
 245         struct sensor_operate *ops = proximity_get_ops();\r
 246         int result = 0;\r
 247         int type = ops->type;\r
 248         result = sensor_register_slave(type, NULL, NULL, proximity_get_ops);\r
 249         return result;\r
 250 }\r
 251 \r
 252 static void __exit proximity_stk3171_exit(void)\r
 253 {\r
 254         struct sensor_operate *ops = proximity_get_ops();\r
 255         int type = ops->type;\r
 256         sensor_unregister_slave(type, NULL, NULL, proximity_get_ops);\r
 257 }\r
 258 \r
 259 \r
 260 module_init(proximity_stk3171_init);\r
 261 module_exit(proximity_stk3171_exit);\r
 262 \r
 263 \r