drivers/input/sensors/accel/lsm303d.c

   1 /* drivers/input/sensors/access/kxtik.c\r
   2  *\r
   3  * Copyright (C) 2012-2015 ROCKCHIP.\r
   4  * Author: Bruins <xwj@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 \r
  17 #include <linux/interrupt.h>\r
  18 #include <linux/i2c.h>\r
  19 #include <linux/slab.h>\r
  20 #include <linux/irq.h>\r
  21 #include <linux/miscdevice.h>\r
  22 #include <linux/gpio.h>\r
  23 #include <asm/uaccess.h>\r
  24 #include <asm/atomic.h>\r
  25 #include <linux/delay.h>\r
  26 #include <linux/input.h>\r
  27 #include <linux/workqueue.h>\r
  28 #include <linux/freezer.h>\r
  29 #include <linux/of_gpio.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 LSM303D_WHO_AM_I                (0x0F)\r
  37 \r
  38 /* full scale setting - register & mask */\r
  39 #define LSM303D_CTRL_REG0               (0x1F)\r
  40 #define LSM303D_CTRL_REG1               (0x20)\r
  41 #define LSM303D_CTRL_REG2               (0x21)\r
  42 #define LSM303D_CTRL_REG3               (0x22)\r
  43 #define LSM303D_CTRL_REG4               (0x23)\r
  44 #define LSM303D_CTRL_REG5               (0x24)\r
  45 #define LSM303D_CTRL_REG6               (0x25)\r
  46 #define LSM303D_CTRL_REG7               (0x26)\r
  47 #define LSM303D_STATUS_REG              (0x27)\r
  48 #define LSM303D_OUT_X_L                 (0x28)\r
  49 #define LSM303D_OUT_X_H                 (0x29)\r
  50 #define LSM303D_OUT_Y_L                 (0x2a)\r
  51 #define LSM303D_OUT_Y_H                 (0x2b)\r
  52 #define LSM303D_OUT_Z_L                 (0x2c)\r
  53 #define LSM303D_OUT_Z_H                 (0x2d)\r
  54 #define LSM303D_FIFO_CTRL_REG           (0x2E)\r
  55 #define LSM303D_FIFO_SRC_REG            (0X2F)\r
  56 \r
  57 #define LSM303D_IG_CFG1                 (0x30)\r
  58 #define LSM303D_IG_SRC1                 (0x31)\r
  59 #define LSM303D_IG_THS1                 (0x32)\r
  60 #define LSM303D_IG_DURATION1            (0x33)\r
  61 \r
  62 #define LSM303D_IG_CFG2                 (0x34)\r
  63 #define LSM303D_IG_SRC2                 (0x35)\r
  64 #define LSM303D_IG_THS2                 (0x36)\r
  65 #define LSM303D_IG_DURATION2            (0x37)\r
  66 \r
  67 \r
  68 #define LSM303D_DEVID                   (0x49)  //chip id\r
  69 #define LSM303D_ACC_DISABLE             (0x08)\r
  70 \r
  71 #define LSM303D_RANGE                   2000000\r
  72 \r
  73 /* LSM303D */\r
  74 #define LSM303D_PRECISION               16\r
  75 #define LSM303D_BOUNDARY                        (0x1 << (LSM303D_PRECISION - 1))\r
  76 #define LSM303D_GRAVITY_STEP            (LSM303D_RANGE / LSM303D_BOUNDARY)\r
  77 \r
  78 #define ODR3P25                         0x10  /* 3.25Hz output data rate */\r
  79 #define ODR6P25                         0x20  /* 6.25Hz output data rate */\r
  80 #define ODR12P5                         0x30  /* 12.5Hz output data rate */\r
  81 #define ODR25                           0x40  /* 25Hz output data rate */\r
  82 #define ODR50                           0x50  /* 50Hz output data rate */\r
  83 #define ODR100                          0x60  /* 100Hz output data rate */\r
  84 #define ODR200                          0x70  /* 200Hz output data rate */\r
  85 #define ODR400                          0x80  /* 400Hz output data rate */\r
  86 #define ODR800                          0x90  /* 800Hz output data rate */\r
  87 #define ODR1600                         0xA0  /* 1600Hz output data rate */\r
  88 \r
  89 \r
  90 struct sensor_reg_data {\r
  91         char reg;\r
  92         char data;\r
  93 };\r
  94 \r
  95 /****************operate according to sensor chip:start************/\r
  96 static int sensor_active(struct i2c_client *client, int enable, int rate)\r
  97 {\r
  98         struct sensor_private_data *sensor =\r
  99             (struct sensor_private_data *) i2c_get_clientdata(client);  \r
 100         int result = 0;\r
 101         int status = 0;\r
 102                 \r
 103         sensor->ops->ctrl_data = sensor_read_reg(client, sensor->ops->ctrl_reg);\r
 104 \r
 105         sensor->ops->ctrl_data |= ODR100;       //100HZ,if 0 then power down\r
 106         \r
 107         //register setting according to chip datasheet          \r
 108         if(!enable)\r
 109         {       \r
 110                 status = LSM303D_ACC_DISABLE;   //lis3dh        \r
 111                 sensor->ops->ctrl_data |= status;       \r
 112         }\r
 113         else\r
 114         {\r
 115                 status = ~LSM303D_ACC_DISABLE;  //lis3dh\r
 116                 sensor->ops->ctrl_data &= status;\r
 117         }\r
 118 \r
 119         DBG("%s:reg=0x%x,reg_ctrl=0x%x,enable=%d\n",__func__,sensor->ops->ctrl_reg, sensor->ops->ctrl_data, enable);\r
 120         result = sensor_write_reg(client, sensor->ops->ctrl_reg, sensor->ops->ctrl_data);\r
 121         if(result)\r
 122                 printk("%s:fail to active sensor\n",__func__);\r
 123         \r
 124         return result;\r
 125 \r
 126 }\r
 127 \r
 128 \r
 129 static int sensor_init(struct i2c_client *client)\r
 130 {       \r
 131         struct sensor_private_data *sensor =\r
 132             (struct sensor_private_data *) i2c_get_clientdata(client);  \r
 133         int result = 0;\r
 134         int i;\r
 135 \r
 136         struct sensor_reg_data reg_data[] = \r
 137         {\r
 138                 {LSM303D_CTRL_REG0,0x00},\r
 139                 {LSM303D_CTRL_REG1,0x07},\r
 140                 {LSM303D_CTRL_REG2,0x00},\r
 141                 {LSM303D_CTRL_REG3,0x00},\r
 142                 {LSM303D_CTRL_REG4,0x00},\r
 143                 {LSM303D_CTRL_REG5,0x78},               //High resolution output mode:11,\r
 144                 {LSM303D_CTRL_REG6,0x20},\r
 145                 {LSM303D_CTRL_REG7,0x00},\r
 146                 {LSM303D_FIFO_CTRL_REG,0x00},\r
 147                 {LSM303D_IG_CFG1,0xFF},         //6 direction position recognition      \r
 148                 {LSM303D_IG_THS1,0x7F},         //Interrupt 1 threshold \r
 149                 {LSM303D_IG_DURATION1,0x7F},    //Duration value 0x00->ox7f\r
 150                         \r
 151         /*\r
 152                 {LSM303D_CTRL_REG7,0x00},               \r
 153                 {LSM303D_CTRL_REG4,0x08},               //High resolution output mode: 1, Normal mode   \r
 154                 {LSM303D_CTRL_REG6,0x40},       \r
 155                 \r
 156                 {LSM303D_FIFO_CTRL_REG,0x00},   //      \r
 157                 {LSM303D_IG_CFG1,0xFF},                 //6 direction position recognition      \r
 158                 {LSM303D_IG_THS1,0x7F},                 //Interrupt 1 threshold \r
 159                 {LSM303D_IG_DURATION1,0x7F},    //Duration value 0x00->ox7f\r
 160                 */\r
 161         };  \r
 162         \r
 163         result = sensor->ops->active(client,0,0);\r
 164         if(result)\r
 165         {\r
 166                 printk("%s:line=%d,error\n",__func__,__LINE__);\r
 167                 return result;\r
 168         }\r
 169 \r
 170         sensor->status_cur = SENSOR_OFF;\r
 171         \r
 172         for(i=0;i<(sizeof(reg_data)/sizeof(struct sensor_reg_data));i++)\r
 173         {\r
 174                 result = sensor_write_reg(client, reg_data[i].reg, reg_data[i].data);\r
 175                 if(result)\r
 176                 {\r
 177                         printk("%s:line=%d,i=%d,error\n",__func__,__LINE__,i);\r
 178                         return result;\r
 179                 }\r
 180         }\r
 181 \r
 182         \r
 183         if(sensor->pdata->irq_enable)\r
 184         {\r
 185 \r
 186                 result = sensor_write_reg(client, LSM303D_CTRL_REG3, 0x20);     \r
 187                 if(result)\r
 188                 {\r
 189                         printk("%s:line=%d,error\n",__func__,__LINE__);\r
 190                         return result;\r
 191                 }\r
 192 \r
 193                 i = sensor_read_reg(client,LSM303D_CTRL_REG5);\r
 194                 \r
 195                 result = sensor_write_reg(client, LSM303D_CTRL_REG5, (i|0x01));\r
 196                 if(result)\r
 197                 {\r
 198                         printk("%s:line=%d,error\n",__func__,__LINE__);\r
 199                         return result;\r
 200                 }\r
 201 \r
 202         }\r
 203         \r
 204         return result;\r
 205 }\r
 206 \r
 207 \r
 208 static int sensor_convert_data(struct i2c_client *client, char high_byte, char low_byte)\r
 209 {\r
 210         s64 result;\r
 211         struct sensor_private_data *sensor =\r
 212             (struct sensor_private_data *) i2c_get_clientdata(client);  \r
 213         \r
 214         switch (sensor->devid) {        \r
 215                 case LSM303D_DEVID:             \r
 216                         result = ((int)high_byte << 8) | (int)low_byte;\r
 217                         if (result < LSM303D_BOUNDARY)\r
 218                         result = result* LSM303D_GRAVITY_STEP;\r
 219                 else\r
 220                         result = ~( ((~result & (0x7fff>>(16-LSM303D_PRECISION)) ) + 1) \r
 221                                                 * LSM303D_GRAVITY_STEP) + 1;\r
 222                         break;\r
 223 \r
 224                 default:\r
 225                         printk(KERN_ERR "%s: devid wasn't set correctly\n",__func__);\r
 226                         return -EFAULT;\r
 227     }\r
 228 \r
 229     return (int)result;\r
 230 }\r
 231 \r
 232 static int gsensor_report_value(struct i2c_client *client, struct sensor_axis *axis)\r
 233 {\r
 234         struct sensor_private_data *sensor =\r
 235                 (struct sensor_private_data *) i2c_get_clientdata(client);      \r
 236 \r
 237         /* Report acceleration sensor information */\r
 238         input_report_abs(sensor->input_dev, ABS_X, axis->x);\r
 239         input_report_abs(sensor->input_dev, ABS_Y, axis->y);\r
 240         input_report_abs(sensor->input_dev, ABS_Z, axis->z);\r
 241         input_sync(sensor->input_dev);\r
 242         DBG("Gsensor x==%d  y==%d z==%d\n",axis->x,axis->y,axis->z);\r
 243 \r
 244         return 0;\r
 245 }\r
 246 \r
 247 #define GSENSOR_MIN  10\r
 248 static int sensor_report_value(struct i2c_client *client)\r
 249 {\r
 250         struct sensor_private_data *sensor =\r
 251                         (struct sensor_private_data *) i2c_get_clientdata(client);      \r
 252         struct sensor_platform_data *pdata = sensor->pdata;\r
 253         int ret = 0;\r
 254         int x,y,z;\r
 255         struct sensor_axis axis;        \r
 256         char buffer[6] = {0};   \r
 257         char value = 0;\r
 258         \r
 259         if(sensor->ops->read_len < 6)   //sensor->ops->read_len = 6\r
 260         {\r
 261                 printk("%s:lenth is error,len=%d\n",__func__,sensor->ops->read_len);\r
 262                 return -1;\r
 263         }\r
 264         \r
 265         memset(buffer, 0, 6);\r
 266 \r
 267         value = sensor_read_reg(client, LSM303D_STATUS_REG);\r
 268         if((value & 0x0f) == 0)\r
 269         {\r
 270                 printk("%s:line=%d,value=0x%x,data is not ready\n",__func__,__LINE__,value);\r
 271                 return -1;\r
 272         }\r
 273                 \r
 274         \r
 275         /* Data bytes from hardware xL, xH, yL, yH, zL, zH */   \r
 276         do {\r
 277                 *buffer = sensor->ops->read_reg;\r
 278                 ret = sensor_rx_data(client, buffer, sensor->ops->read_len);\r
 279                 if (ret < 0)\r
 280                 return ret;\r
 281         } while (0);\r
 282 \r
 283         //this gsensor need 6 bytes buffer\r
 284         x = sensor_convert_data(sensor->client, buffer[1], buffer[0]);  //buffer[1]:high bit \r
 285         y = sensor_convert_data(sensor->client, buffer[3], buffer[2]);\r
 286         z = sensor_convert_data(sensor->client, buffer[5], buffer[4]);          \r
 287 \r
 288         axis.x = (pdata->orientation[0])*x + (pdata->orientation[1])*y + (pdata->orientation[2])*z;\r
 289         axis.y = (pdata->orientation[3])*x + (pdata->orientation[4])*y + (pdata->orientation[5])*z;     \r
 290         axis.z = (pdata->orientation[6])*x + (pdata->orientation[7])*y + (pdata->orientation[8])*z;\r
 291 \r
 292         DBG( "%s: axis = %d  %d  %d \n", __func__, axis.x, axis.y, axis.z);\r
 293         //printk( "%s: axis = %d  %d  %d \n", __func__, axis.x, axis.y, axis.z);\r
 294 \r
 295         //Report event  only while value is changed to save some power\r
 296         if((abs(sensor->axis.x - axis.x) > GSENSOR_MIN) || (abs(sensor->axis.y - axis.y) > GSENSOR_MIN) || (abs(sensor->axis.z - axis.z) > GSENSOR_MIN))\r
 297         {\r
 298                 gsensor_report_value(client, &axis);\r
 299 \r
 300                 /* »¥³âµØ»º´æÊý¾Ý. */\r
 301                 mutex_lock(&(sensor->data_mutex) );\r
 302                 sensor->axis = axis;\r
 303                 mutex_unlock(&(sensor->data_mutex) );\r
 304         }\r
 305 \r
 306         if((sensor->pdata->irq_enable)&& (sensor->ops->int_status_reg >= 0))    //read sensor intterupt status register\r
 307         {\r
 308                 \r
 309                 value = sensor_read_reg(client, sensor->ops->int_status_reg);\r
 310                 DBG("%s:sensor int status :0x%x\n",__func__,value);\r
 311         }\r
 312         \r
 313         return ret;\r
 314 }\r
 315 \r
 316 struct sensor_operate gsensor_lsm303d_ops = {\r
 317         .name                           = "lsm303d",\r
 318         .type                           = SENSOR_TYPE_ACCEL,            //sensor type and it should be correct\r
 319         .id_i2c                         = ACCEL_ID_LSM303D,             //i2c id number\r
 320         .read_reg                       = (LSM303D_OUT_X_L | 0x80),     //read data\r
 321         .read_len                       = 6,                            //data length\r
 322         .id_reg                         = LSM303D_WHO_AM_I,             //read device id from this register\r
 323         .id_data                        = LSM303D_DEVID,                        //device id\r
 324         .precision                      = LSM303D_PRECISION,            //16 bits\r
 325         .ctrl_reg                       = LSM303D_CTRL_REG1,            //enable or disable \r
 326         .int_status_reg                 = LSM303D_IG_SRC1,              //intterupt status register\r
 327         .range                          = {-LSM303D_RANGE,LSM303D_RANGE},       //range\r
 328         .trig                           = (IRQF_TRIGGER_LOW|IRQF_ONESHOT),              \r
 329         .active                         = sensor_active,        \r
 330         .init                           = sensor_init,\r
 331         .report                         = sensor_report_value,\r
 332 };\r
 333 \r
 334 \r
 335 /****************operate according to sensor chip:end************/\r
 336 \r
 337 //function name should not be changed\r
 338 static struct sensor_operate *gsensor_get_ops(void)\r
 339 {\r
 340         return &gsensor_lsm303d_ops;\r
 341 }\r
 342 \r
 343 \r
 344 static int __init gsensor_lis3dh_init(void)\r
 345 {\r
 346         struct sensor_operate *ops = gsensor_get_ops();\r
 347         int result = 0;\r
 348         int type = ops->type;\r
 349         result = sensor_register_slave(type, NULL, NULL, gsensor_get_ops);\r
 350         return result;\r
 351 }\r
 352 \r
 353 static void __exit gsensor_lis3dh_exit(void)\r
 354 {\r
 355         struct sensor_operate *ops = gsensor_get_ops();\r
 356         int type = ops->type;\r
 357         sensor_unregister_slave(type, NULL, NULL, gsensor_get_ops);\r
 358 }\r
 359 \r
 360 \r
 361 module_init(gsensor_lis3dh_init);\r
 362 module_exit(gsensor_lis3dh_exit);\r
 363 \r
 364 \r
 365 \r
 366 \r