298 lines
7.6 KiB
C
Executable File
298 lines
7.6 KiB
C
Executable File
/* drivers/input/sensors/pressure/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 <linux/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
|
|
|
|
|
|
/****************operate according to sensor chip:start************/
|
|
|
|
static int C[8] = {0};
|
|
int g_ms5607_temp;
|
|
int g_ms5607_pr_status;
|
|
|
|
#if defined(CONFIG_TMP_MS5607)
|
|
extern int g_ms5607_temp_status;
|
|
#else
|
|
static int g_ms5607_temp_status = SENSOR_OFF;
|
|
#endif
|
|
|
|
|
|
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_temp_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_pr_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_pr_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 pressure_report_value(struct input_dev *input, int data)
|
|
{
|
|
//get pressure, high and temperature from register data
|
|
|
|
input_report_abs(input, ABS_PRESSURE, 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;
|
|
}
|
|
|
|
//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 = pressure_report_value(sensor->input_dev, P);
|
|
|
|
DBG("%s:pressure=%d,temperature=%d\n",__func__,P,g_ms5607_temp);
|
|
|
|
return result;
|
|
}
|
|
|
|
static struct sensor_operate pressure_ms5607_ops = {
|
|
.name = "pr_ms5607",
|
|
.type = SENSOR_TYPE_PRESSURE, //sensor type and it should be correct
|
|
.id_i2c = PRESSURE_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
|
|
.brightness = {10,255}, //brightness
|
|
.trig = IRQF_TRIGGER_LOW | IRQF_ONESHOT | IRQF_SHARED,
|
|
.active = sensor_active,
|
|
.init = sensor_init,
|
|
.report = sensor_report_value,
|
|
};
|
|
|
|
/****************operate according to sensor chip:end************/
|
|
static int pressure_ms5607_probe(struct i2c_client *client, const struct i2c_device_id *devid)
|
|
{
|
|
return sensor_register_device(client, NULL, devid, &pressure_ms5607_ops);
|
|
}
|
|
|
|
static int pressure_ms5607_remove(struct i2c_client *client)
|
|
{
|
|
return sensor_unregister_device(client, NULL, &pressure_ms5607_ops);
|
|
}
|
|
|
|
static const struct i2c_device_id pressure_ms5607_id[] = {
|
|
{"pr_ms5607", PRESSURE_ID_MS5607},
|
|
{}
|
|
};
|
|
|
|
static struct i2c_driver pressure_ms5607_driver = {
|
|
.probe = pressure_ms5607_probe,
|
|
.remove = pressure_ms5607_remove,
|
|
.shutdown = sensor_shutdown,
|
|
.id_table = pressure_ms5607_id,
|
|
.driver = {
|
|
.name = "pressure_ms5607",
|
|
#ifdef CONFIG_PM
|
|
.pm = &sensor_pm_ops,
|
|
#endif
|
|
},
|
|
};
|
|
|
|
module_i2c_driver(pressure_ms5607_driver);
|
|
|
|
MODULE_AUTHOR("luowei <lw@rock-chips.com>");
|
|
MODULE_DESCRIPTION("ms5607 pressure driver");
|
|
MODULE_LICENSE("GPL");
|