-/* drivers/input/sensors/temperature/tmp_ms5607.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
-#if 0\r
-#define SENSOR_DEBUG_TYPE SENSOR_TYPE_TEMPERATURE\r
-#define DBG(x...) if(sensor->pdata->type == SENSOR_DEBUG_TYPE) printk(x)\r
-#else\r
-#define DBG(x...)\r
-#endif\r
-\r
-#define CMD_RESET 0x1E // ADC reset command \r
-#define CMD_ADC_READ 0x00 // ADC read command \r
-#define CMD_ADC_CONV 0x40 // ADC conversion command \r
-#define CMD_ADC_D1 0x00 // ADC D1 conversion \r
-#define CMD_ADC_D2 0x10 // ADC D2 conversion \r
-#define CMD_ADC_256 0x00 // ADC OSR=256 \r
-#define CMD_ADC_512 0x02 // ADC OSR=512 \r
-#define CMD_ADC_1024 0x04 // ADC OSR=1024 \r
-#define CMD_ADC_2048 0x06 // ADC OSR=2048 \r
-#define CMD_ADC_4096 0x08 // ADC OSR=4096 \r
-#define CMD_PROM_RD 0xA0 // Prom read command \r
-\r
-#if defined(CONFIG_PR_MS5607)\r
-extern int g_ms5607_temp;\r
-extern int g_ms5607_pr_status;\r
-#else\r
-static int g_ms5607_temp = 0;\r
-static int g_ms5607_pr_status = SENSOR_OFF;\r
-#endif\r
-\r
-int g_ms5607_temp_status;\r
-static int C[8] = {0};\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
- int i = 0;\r
- char prom[16];\r
- \r
- if((enable)&&(g_ms5607_pr_status == SENSOR_OFF))\r
- {\r
- result = sensor_write_reg_normal(client, CMD_RESET);\r
- if(result) \r
- printk("%s:line=%d,error\n",__func__,__LINE__);\r
-\r
- //Read PROM (128 bit of calibration words) \r
- memset(prom, 0, 16);\r
- prom[0]= CMD_PROM_RD;//CMD_PROM_RD; \r
- for(i=0; i<8; i++)\r
- {\r
- prom[i*2]= CMD_PROM_RD + i*2;\r
- result = sensor_rx_data(client, &prom[i*2], 2);\r
- if(result)\r
- {\r
- printk("%s:line=%d,error\n",__func__,__LINE__);\r
- return result;\r
- }\r
- }\r
-\r
- for (i=0;i<8;i++) \r
- {\r
- C[i] = prom[2*i] << 8 | prom[2*i + 1];\r
- DBG("prom[%d]=0x%x,prom[%d]=0x%x",2*i,prom[2*i],(2*i + 1),prom[2*i + 1]);\r
- DBG("\nC[%d]=%d,",i+1,C[i]);\r
- } \r
-\r
- }\r
-\r
- g_ms5607_temp_status = enable;\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 = 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
- g_ms5607_temp_status = sensor->status_cur;\r
- //Reset\r
- //result = sensor_write_reg_normal(client, CMD_RESET);\r
- //if(result) \r
- //printk("%s:line=%d,error\n",__func__,__LINE__); \r
- \r
- return result;\r
-}\r
-\r
-\r
-\r
-static int temperature_report_value(struct input_dev *input, int data)\r
-{\r
- //get temperature, high and temperature from register data\r
-\r
- input_report_abs(input, ABS_THROTTLE, data);\r
- input_sync(input);\r
- \r
- return 0;\r
-}\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
- \r
- int result = 0;\r
- char buffer[3]; \r
- char index = 0;\r
- unsigned int D1=0, D2=0;\r
-\r
- int T2 = 0;\r
- long long OFF = 0; // offset at actual temperature \r
- long long SENS = 0; // sensitivity at actual temperature \r
- int dT = 0; // difference between actual and measured temperature\r
- long long OFF2 = 0;\r
- long long SENS2 = 0;\r
- int P = 0; // compensated pressure value \r
-\r
-\r
- memset(buffer, 0, 3);\r
- if(sensor->ops->read_len < 3) //sensor->ops->read_len = 3\r
- {\r
- printk("%s:lenth is error,len=%d\n",__func__,sensor->ops->read_len);\r
- return -1;\r
- }\r
-\r
- if(g_ms5607_pr_status == SENSOR_OFF)\r
- {\r
-\r
- //D1 conversion\r
- sensor_write_reg_normal(client, CMD_ADC_CONV + CMD_ADC_D1 + CMD_ADC_4096);\r
- msleep(10);\r
-\r
- memset(buffer, 0, 3);\r
- buffer[0] = CMD_ADC_READ;\r
- result = sensor_rx_data(client, &buffer[0], 3);\r
- if(result)\r
- {\r
- printk("%s:line=%d,error\n",__func__,__LINE__);\r
- return result;\r
- }\r
-\r
- D1 = (buffer[0] << 16) | (buffer[1] << 8) | buffer[2];\r
- DBG("\nD1=%d :buffer[0]=0x%x,buffer[1]=0x%x,buffer2]=0x%x\n",D1,buffer[0],buffer[1],buffer[2]);\r
-\r
- //D2 conversion\r
- sensor_write_reg_normal(client, CMD_ADC_CONV + CMD_ADC_D2 + CMD_ADC_4096);\r
- msleep(10);\r
-\r
- memset(buffer, 0, 3);\r
- buffer[0] = CMD_ADC_READ;\r
- result = sensor_rx_data(client, &buffer[0], 3);\r
- if(result)\r
- {\r
- printk("%s:line=%d,error\n",__func__,__LINE__);\r
- return result;\r
- }\r
-\r
- D2 = (buffer[0] << 16) | (buffer[1] << 8) | buffer[2];\r
- DBG("D2=%d:buffer[0]=0x%x,buffer[1]=0x%x,buffer2]=0x%x\n",D2,buffer[0],buffer[1],buffer[2]);\r
-\r
- dT = D2 - ((unsigned int)C[5] << 8);\r
-\r
- g_ms5607_temp = (int)(2000 + ((long long)dT * C[6] >> 23));\r
-\r
- OFF = ((unsigned long long)C[2] << 17) + (C[4] * (long long)dT >> 6);\r
-\r
- SENS = ((long long)C[1] << 16) + (C[3] * (long long)dT >> 7);\r
-\r
- /*calcualte 2nd order pressure and temperature (BP5607 2nd order algorithm)*/\r
- if (g_ms5607_temp < -4000 || g_ms5607_temp > 8500)\r
- {\r
- printk("%s:temperature is error\n",__func__);\r
- return -1;\r
- }\r
-\r
- if (g_ms5607_temp < 2000)\r
- {\r
- int tmp;\r
- tmp = (g_ms5607_temp - 2000) * (g_ms5607_temp - 2000);\r
-\r
- T2 = (int)((long long)(dT * dT) >> 31);\r
- OFF2 = (((long long)tmp * 61)*((long long)tmp * 61)) >> 4;\r
- SENS2 = (long long)((tmp*tmp) << 1);\r
-\r
- if (g_ms5607_temp < -1500)\r
- {\r
- tmp = (g_ms5607_temp + 1500) * (g_ms5607_temp + 1500);\r
- OFF2 += 15 * tmp;\r
- SENS2 += 8 * tmp;\r
- }\r
- }\r
- else\r
- {\r
- T2=0;\r
- OFF2 = 0;\r
- SENS2 = 0;\r
- }\r
-\r
- g_ms5607_temp -= T2;\r
- OFF -= OFF2;\r
- SENS -= SENS2; \r
- P = (int)((((D1 * SENS) >> 21) - OFF) >> 15);\r
-\r
- index = temperature_report_value(sensor->input_dev, g_ms5607_temp);\r
- \r
- DBG("%s:pressure=%d,temperature=%d\n",__func__,P,g_ms5607_temp);\r
- \r
- }\r
- else\r
- { \r
- index = temperature_report_value(sensor->input_dev, g_ms5607_temp);\r
- \r
- #if defined(CONFIG_PR_MS5607)\r
- DBG("%s:pressure=%d,temperature=%d\n",__func__,P,g_ms5607_temp);\r
- #else \r
- printk("%s:errror,need pr_ms5607\n",__func__);\r
- #endif\r
- }\r
- \r
- \r
- return result;\r
-}\r
-\r
-\r
-struct sensor_operate temperature_ms5607_ops = {\r
- .name = "tmp_ms5607",\r
- .type = SENSOR_TYPE_TEMPERATURE, //sensor type and it should be correct\r
- .id_i2c = TEMPERATURE_ID_MS5607, //i2c id number\r
- .read_reg = SENSOR_UNKNOW_DATA, //read data\r
- .read_len = 3, //data length\r
- .id_reg = SENSOR_UNKNOW_DATA, //read device id from this register\r
- .id_data = SENSOR_UNKNOW_DATA, //device id\r
- .precision = 24, //8 bits\r
- .ctrl_reg = SENSOR_UNKNOW_DATA, //enable or disable \r
- .int_status_reg = SENSOR_UNKNOW_DATA, //intterupt status register\r
- .range = {100,65535}, //range\r
- .trig = IRQF_TRIGGER_LOW | 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 *temperature_get_ops(void)\r
-{\r
- return &temperature_ms5607_ops;\r
-}\r
-\r
-\r
-static int __init temperature_ms5607_init(void)\r
-{\r
- struct sensor_operate *ops = temperature_get_ops();\r
- int result = 0;\r
- int type = ops->type;\r
- result = sensor_register_slave(type, NULL, NULL, temperature_get_ops);\r
- DBG("%s\n",__func__);\r
- return result;\r
-}\r
-\r
-static void __exit temperature_ms5607_exit(void)\r
-{\r
- struct sensor_operate *ops = temperature_get_ops();\r
- int type = ops->type;\r
- sensor_unregister_slave(type, NULL, NULL, temperature_get_ops);\r
-}\r
-\r
-\r
-module_init(temperature_ms5607_init);\r
-module_exit(temperature_ms5607_exit);\r
-\r
+/* drivers/input/sensors/temperature/tmp_ms5607.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 <linux/of_gpio.h>
+#ifdef CONFIG_HAS_EARLYSUSPEND
+#include <linux/earlysuspend.h>
+#endif
+#include <linux/sensor-dev.h>
+
+
+#define CMD_RESET 0x1E // ADC reset command
+#define CMD_ADC_READ 0x00 // ADC read command
+#define CMD_ADC_CONV 0x40 // ADC conversion command
+#define CMD_ADC_D1 0x00 // ADC D1 conversion
+#define CMD_ADC_D2 0x10 // ADC D2 conversion
+#define CMD_ADC_256 0x00 // ADC OSR=256
+#define CMD_ADC_512 0x02 // ADC OSR=512
+#define CMD_ADC_1024 0x04 // ADC OSR=1024
+#define CMD_ADC_2048 0x06 // ADC OSR=2048
+#define CMD_ADC_4096 0x08 // ADC OSR=4096
+#define CMD_PROM_RD 0xA0 // Prom read command
+
+#if defined(CONFIG_PR_MS5607)
+extern int g_ms5607_temp;
+extern int g_ms5607_pr_status;
+#else
+static int g_ms5607_temp = 0;
+static int g_ms5607_pr_status = SENSOR_OFF;
+#endif
+
+int g_ms5607_temp_status;
+static int C[8] = {0};
+
+/****************operate according to sensor chip:start************/
+
+static int sensor_active(struct i2c_client *client, int enable, int rate)
+{
+ int result = 0;
+ int i = 0;
+ char prom[16];
+
+ if((enable)&&(g_ms5607_pr_status == SENSOR_OFF))
+ {
+ result = sensor_write_reg_normal(client, CMD_RESET);
+ if(result)
+ printk("%s:line=%d,error\n",__func__,__LINE__);
+
+ //Read PROM (128 bit of calibration words)
+ memset(prom, 0, 16);
+ prom[0]= CMD_PROM_RD;//CMD_PROM_RD;
+ for(i=0; i<8; i++)
+ {
+ prom[i*2]= CMD_PROM_RD + i*2;
+ result = sensor_rx_data(client, &prom[i*2], 2);
+ if(result)
+ {
+ printk("%s:line=%d,error\n",__func__,__LINE__);
+ return result;
+ }
+ }
+
+ for (i=0;i<8;i++)
+ {
+ C[i] = prom[2*i] << 8 | prom[2*i + 1];
+ //printk("prom[%d]=0x%x,prom[%d]=0x%x",2*i,prom[2*i],(2*i + 1),prom[2*i + 1]);
+ //printk("\nC[%d]=%d,",i+1,C[i]);
+ }
+
+ }
+
+ g_ms5607_temp_status = enable;
+
+ 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 = sensor->ops->active(client,0,0);
+ if(result)
+ {
+ printk("%s:line=%d,error\n",__func__,__LINE__);
+ return result;
+ }
+
+ sensor->status_cur = SENSOR_OFF;
+ g_ms5607_temp_status = sensor->status_cur;
+ //Reset
+ //result = sensor_write_reg_normal(client, CMD_RESET);
+ //if(result)
+ //printk("%s:line=%d,error\n",__func__,__LINE__);
+
+ return result;
+}
+
+
+
+static int temperature_report_value(struct input_dev *input, int data)
+{
+ //get temperature, high and temperature from register data
+
+ input_report_abs(input, ABS_THROTTLE, data);
+ input_sync(input);
+
+ return 0;
+}
+
+
+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 buffer[3];
+ char index = 0;
+ unsigned int D1=0, D2=0;
+
+ int T2 = 0;
+ long long OFF = 0; // offset at actual temperature
+ long long SENS = 0; // sensitivity at actual temperature
+ int dT = 0; // difference between actual and measured temperature
+ long long OFF2 = 0;
+ long long SENS2 = 0;
+ int P = 0; // compensated pressure value
+
+
+ memset(buffer, 0, 3);
+ if(sensor->ops->read_len < 3) //sensor->ops->read_len = 3
+ {
+ printk("%s:lenth is error,len=%d\n",__func__,sensor->ops->read_len);
+ return -1;
+ }
+
+ if(g_ms5607_pr_status == SENSOR_OFF)
+ {
+
+ //D1 conversion
+ sensor_write_reg_normal(client, CMD_ADC_CONV + CMD_ADC_D1 + CMD_ADC_4096);
+ msleep(10);
+
+ memset(buffer, 0, 3);
+ buffer[0] = CMD_ADC_READ;
+ result = sensor_rx_data(client, &buffer[0], 3);
+ if(result)
+ {
+ printk("%s:line=%d,error\n",__func__,__LINE__);
+ return result;
+ }
+
+ D1 = (buffer[0] << 16) | (buffer[1] << 8) | buffer[2];
+ DBG("\nD1=%d :buffer[0]=0x%x,buffer[1]=0x%x,buffer2]=0x%x\n",D1,buffer[0],buffer[1],buffer[2]);
+
+ //D2 conversion
+ sensor_write_reg_normal(client, CMD_ADC_CONV + CMD_ADC_D2 + CMD_ADC_4096);
+ msleep(10);
+
+ memset(buffer, 0, 3);
+ buffer[0] = CMD_ADC_READ;
+ result = sensor_rx_data(client, &buffer[0], 3);
+ if(result)
+ {
+ printk("%s:line=%d,error\n",__func__,__LINE__);
+ return result;
+ }
+
+ D2 = (buffer[0] << 16) | (buffer[1] << 8) | buffer[2];
+ DBG("D2=%d:buffer[0]=0x%x,buffer[1]=0x%x,buffer2]=0x%x\n",D2,buffer[0],buffer[1],buffer[2]);
+
+ dT = D2 - ((unsigned int)C[5] << 8);
+
+ g_ms5607_temp = (int)(2000 + ((long long)dT * C[6] >> 23));
+
+ OFF = ((unsigned long long)C[2] << 17) + (C[4] * (long long)dT >> 6);
+
+ SENS = ((long long)C[1] << 16) + (C[3] * (long long)dT >> 7);
+
+ /*calcualte 2nd order pressure and temperature (BP5607 2nd order algorithm)*/
+ if (g_ms5607_temp < -4000 || g_ms5607_temp > 8500)
+ {
+ printk("%s:temperature is error\n",__func__);
+ return -1;
+ }
+
+ if (g_ms5607_temp < 2000)
+ {
+ int tmp;
+ tmp = (g_ms5607_temp - 2000) * (g_ms5607_temp - 2000);
+
+ T2 = (int)((long long)(dT * dT) >> 31);
+ OFF2 = (((long long)tmp * 61)*((long long)tmp * 61)) >> 4;
+ SENS2 = (long long)((tmp*tmp) << 1);
+
+ if (g_ms5607_temp < -1500)
+ {
+ tmp = (g_ms5607_temp + 1500) * (g_ms5607_temp + 1500);
+ OFF2 += 15 * tmp;
+ SENS2 += 8 * tmp;
+ }
+ }
+ else
+ {
+ T2=0;
+ OFF2 = 0;
+ SENS2 = 0;
+ }
+
+ g_ms5607_temp -= T2;
+ OFF -= OFF2;
+ SENS -= SENS2;
+ P = (int)((((D1 * SENS) >> 21) - OFF) >> 15);
+
+ index = temperature_report_value(sensor->input_dev, g_ms5607_temp);
+
+ DBG("%s:pressure=%d,temperature=%d\n",__func__,P,g_ms5607_temp);
+
+ }
+ else
+ {
+ index = temperature_report_value(sensor->input_dev, g_ms5607_temp);
+
+ #if defined(CONFIG_PR_MS5607)
+ DBG("%s:pressure=%d,temperature=%d\n",__func__,P,g_ms5607_temp);
+ #else
+ printk("%s:errror,need pr_ms5607\n",__func__);
+ #endif
+ }
+
+
+ return result;
+}
+
+
+struct sensor_operate temperature_ms5607_ops = {
+ .name = "tmp_ms5607",
+ .type = SENSOR_TYPE_TEMPERATURE, //sensor type and it should be correct
+ .id_i2c = TEMPERATURE_ID_MS5607, //i2c id number
+ .read_reg = SENSOR_UNKNOW_DATA, //read data
+ .read_len = 3, //data length
+ .id_reg = SENSOR_UNKNOW_DATA, //read device id from this register
+ .id_data = SENSOR_UNKNOW_DATA, //device id
+ .precision = 24, //8 bits
+ .ctrl_reg = SENSOR_UNKNOW_DATA, //enable or disable
+ .int_status_reg = SENSOR_UNKNOW_DATA, //intterupt status register
+ .range = {100,65535}, //range
+ .trig = IRQF_TRIGGER_LOW | 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 *temperature_get_ops(void)
+{
+ return &temperature_ms5607_ops;
+}
+
+
+static int __init temperature_ms5607_init(void)
+{
+ struct sensor_operate *ops = temperature_get_ops();
+ int result = 0;
+ int type = ops->type;
+ result = sensor_register_slave(type, NULL, NULL, temperature_get_ops);
+ return result;
+}
+
+static void __exit temperature_ms5607_exit(void)
+{
+ struct sensor_operate *ops = temperature_get_ops();
+ int type = ops->type;
+ sensor_unregister_slave(type, NULL, NULL, temperature_get_ops);
+}
+
+
+module_init(temperature_ms5607_init);
+module_exit(temperature_ms5607_exit);
+
projects / firefly-linux-kernel-4.4.55.git / blobdiff