Piteball
/
android_kernel_samsung_msm8976
mirror of https://github.com/team-infusion-developers/android_kernel_samsung_msm8976.git
1
1
Fork 0
Code Issues Projects Releases Wiki Activity
android_kernel_samsung_msm8976/drivers/sensorhub/stm/adpd143.c

3728 lines
100 KiB
C
Raw Blame History

/**
*\mainpage
* ADPD143 driver
* (c) copyright 2014 Analog Devices Inc.
* Licensed under the GPL version 3 or later.
* \date April 2014
* \version 1.1 Driver
* \version Linux 3.4.0
*/
#include <linux/init.h> /* module initialization api */
#include <linux/module.h> /* module functionality */
#include <linux/i2c.h> /* i2c related functionality */
#include <linux/slab.h>
#include <linux/pm.h> /* device Power Management functionality */
#include <linux/errno.h>
#include <linux/err.h>
#include <linux/delay.h>
#include <linux/input.h>
#include <linux/workqueue.h>
#include <linux/kobject.h>
#include <linux/average.h>
#include <linux/uaccess.h>
#include <linux/gpio.h>
#include <linux/irq.h>
#include <linux/interrupt.h>
#include <linux/gpio.h>
#include <linux/of_gpio.h>
#include <linux/moduleparam.h>
#include <linux/regulator/consumer.h>
#include <linux/fs.h>
#include <linux/pinctrl/consumer.h>
#include "../../pinctrl/core.h"
#include "adpd143.h"
static int dbg_enable;
module_param(dbg_enable, int, S_IRUGO | S_IWUSR);
/* ADPD143 driver version*/
#define ADPD143_VERSION "1.2"
/* ADPD143 release date*/
#define ADPD143_RELEASE_DATE "Tue Apr 22 12:11:42 IST 2014"
#define ADPD_DEV_NAME "adpd143"
/*INPUT DEVICE NAME LIST*/
#define MODULE_NAME_HRM "hrm_sensor"
#define MODULE_NAME_HRMLED "hrmled_sensor"
#define CHIP_NAME "ADPD143RI"
#define VENDOR "ADI"
#define MAX_EOL_RESULT 132
/*I2C RELATED*/
#define I2C_RETRY_DELAY 5
#define I2C_RETRIES 5
/*ADPD143 DRIVER RELATED*/
#define MAX_BUFFER 128
#define GLOBAL_OP_MODE_OFF 0
#define GLOBAL_OP_MODE_IDLE 1
#define GLOBAL_OP_MODE_GO 2
#define SET_GLOBAL_OP_MODE(val, cmd) ((val & 0xFC) | cmd)
#define FRM_FILE 0
#define FRM_ARR 1
#define EN_FIFO_CLK 0x3B5B
#define DS_FIFO_CLK 0x3050
/******************************************************************/
/**************** ADPD143 USER OPERATING MODE ********************/
/*
Operating mode defined to user
*/
#define IDLE_MODE 0x00
#define SAMPLE_XY_A_MODE 0x30
#define SAMPLE_XY_AB_MODE 0x31
#define SAMPLE_XY_B_MODE 0x32
#define GET_USR_MODE(usr_val) ((usr_val & 0xF0) >> 4)
#define GET_USR_SUB_MODE(usr_val) (usr_val & 0xF)
/******************************************************************/
/**************** ADPD143 OPERATING MODE & DATA MODE *************/
#define R_RDATA_FLAG_EN (0x1 << 15)
#define R_PACK_START_EN (0x0 << 14)
#define R_RDOUT_MODE (0x0 << 13)
#define R_FIFO_PREVENT_EN (0x1 << 12)
#define R_SAMP_OUT_MODE (0x0 << 9)
#define DEFAULT_OP_MODE_CFG_VAL(cfg_x) (R_RDATA_FLAG_EN + R_PACK_START_EN +\
R_RDOUT_MODE + R_FIFO_PREVENT_EN+\
R_SAMP_OUT_MODE)
#define SET_R_OP_MODE_A(val) ((val & 0xF000) >> 12)
#define SET_R_DATAMODE_A(val) ((val & 0x0F00) >> 8)
#define SET_R_OP_MODE_B(val) ((val & 0x00F0) >> 4)
#define SET_R_DATAMODE_B(val) ((val & 0x000F))
/**
@brief Used to get the value need to be set for slot-A, B operating mode
and data out mode.
*/
#define SET_MODE_VALUE(val) (SET_R_OP_MODE_A(val) |\
(SET_R_DATAMODE_A(val) << 2) |\
(SET_R_OP_MODE_B(val) << 5) |\
(SET_R_DATAMODE_B(val) << 6))
/******************************************************************/
/**************** ADPD143 INTERRUPT MASK *************************/
#define INTR_MASK_IDLE_USR 0x0000
#define INTR_MASK_SAMPLE_USR 0x0020
#define INTR_MASK_S_SAMP_XY_A_USR 0x0020
#define INTR_MASK_S_SAMP_XY_AB_USR 0x0040
#define INTR_MASK_S_SAMP_XY_B_USR 0x0040
#define SET_INTR_MASK(usr_val) ((~(INTR_MASK_##usr_val)) & 0x1FF)
/******************************************************************/
/***************** ADPD143 PRINT *********************************/
#ifdef ADPD_DBG
#define ADPD143_dbg(format, arg...) \
printk(KERN_DEBUG "ADPD143 : "format, ##arg);
#else
#define ADPD143_dbg(format, arg...) {if (dbg_enable)\
printk(KERN_DEBUG "ADPD143 : "format, ##arg);\
}
#endif
#ifdef ADPD_INFO
#define ADPD143_info(format, arg...) \
printk(KERN_INFO "ADPD143 : "format, ##arg);
#else
#define ADPD143_info(format, arg...) {if (0)\
; }
#endif
/******************************************************************/
/***************** ADPD143 DIFFERENT MODE ************************/
/*
Main mode
*/
#define IDLE_USR 0
#define SAMPLE_USR 3
#define TIA_ADC_USR 5
/*
Sub mode
*/
#define S_SAMP_XY_A 0
#define S_SAMP_XY_AB 1
#define S_SAMP_XY_B 2
/*
OPERATING MODE ==> MAIN_mode[20:16] |
OP_mode_A[15:12] |
DATA_mode_A[11:8]|
OP_mode_B[7:4] |
DATA_mode_B[3:0]
*/
#define IDLE_OFF ((IDLE_USR << 16) | (0x0000))
#define SAMPLE_XY_A ((SAMPLE_USR << 16) | (0x1400))
#define SAMPLE_XY_AB ((SAMPLE_USR << 16) | (0x1414))
#define SAMPLE_XY_B ((SAMPLE_USR << 16) | (0x0014))
#define MAX_MODE 6
#define MAX_IDLE_MODE 1
#define MAX_SAMPLE_MODE 3
#define MODE(val) __arr_mode_##val
#define MODE_SIZE(val) MAX_##val##_MODE
#define MAX_LIB_VER 20
#define OSC_TRIM_ADDR26_REG 0x26
#define OSC_TRIM_ADDR28_REG 0x28
#define OSC_TRIM_ADDR29_REG 0x29
#define OSC_TRIM_32K_REG 0x4B
#define OSC_TRIM_32M_REG 0x4D
#define OSC_DEFAULT_32K_SET 0x2695
#define OSC_DEFAULT_32M_SET 0x4272
#define OSCILLATOR_TRIM_FILE_PATH "/efs/osc_trim"
#define ALC_OFF_MODE 0
#define ALC_TIA_MODE 1
#define ALC_TNF_MODE 2
#define ALC_FLOAT_MODE 3
#define HRM_LDO_ON 1
#define HRM_LDO_OFF 0
#define IRRED_OFF 0
#define IR_MODE 1
#define RED_MODE 2
#define IRRED_MODE 3
#define HRM_IDLE_MODE 0
#define HRM_SAMPLE_MODE 1
#define HRM_TIA_ADC_MODE 2
/**
mode mapping structure used to hold the number mode actually supported by
driver
*/
struct mode_mapping {
char *name;
int *mode_code;
unsigned int size;
};
int __arr_mode_IDLE[MAX_IDLE_MODE] =
{ IDLE_OFF };
int __arr_mode_SAMPLE[MAX_SAMPLE_MODE] =
{ SAMPLE_XY_A, SAMPLE_XY_AB, SAMPLE_XY_B };
int __arr_mode_TIA_ADC_SAMPLE[MAX_SAMPLE_MODE] =
{ SAMPLE_XY_A, SAMPLE_XY_AB, SAMPLE_XY_B };
struct mode_mapping __mode_recv_frm_usr[MAX_MODE] = {
{
.name = "IDLE",
.mode_code = MODE(IDLE),
.size = MODE_SIZE(IDLE)
},
{ .name = "UNSUPPORTED1",
.mode_code = 0,
.size = 0,
},
{ .name = "UNSUPPORTED2",
.mode_code = 0,
.size = 0,
},
{
.name = "SAMPLE",
.mode_code = MODE(SAMPLE),
.size = MODE_SIZE(SAMPLE)
},
{ .name = "UNSUPPORTED3",
.mode_code = 0,
.size = 0,
},
{
.name = "TIA_ADC_SAMPLE",
.mode_code = MODE(TIA_ADC_SAMPLE),
.size = MODE_SIZE(SAMPLE)
}
};
/**
general data buffer that is required to store the recieved buffer
*/
unsigned short data_buffer[MAX_BUFFER] = { 0 };
struct wrk_q_timestamp {
struct timeval interrupt_trigger;
};
struct adpd143_stats {
atomic_t interrupts;
atomic_t fifo_requires_sync;
atomic_t fifo_bytes[4];
atomic_t wq_pending;
atomic_t wq_schedule_time_peak_usec;
atomic_t wq_schedule_time_last_usec;
struct ewma wq_schedule_time_avg_usec;
atomic_t data_process_time_peak_usec;
atomic_t data_process_time_last_usec;
struct ewma data_process_time_avg_usec;
struct wrk_q_timestamp stamp;
};
/**
structure hold adpd143 chip structure, and parameter used
to control the adpd143 software part.
*/
struct adpd143_data {
struct i2c_client *client;
struct mutex mutex;/*for chip structure*/
struct mutex storelock;
struct device *dev;
struct input_dev *hrm_input_dev;
struct input_dev *hrmled_input_dev;
struct adpd_platform_data *ptr_config;
struct work_struct work;
struct workqueue_struct *ptr_adpd143_wq_st;
struct pinctrl *p;
struct pinctrl_state *pins_sleep;
struct pinctrl_state *pins_idle;
int irq;
int hrm_int;
int led_en;
int pre_hrmled_enable;
int sample_cnt;
struct regulator *leda;
unsigned short *ptr_data;
struct adpd143_stats stats;
unsigned short intr_mask_val;
unsigned short intr_status_val;
unsigned short fifo_size;
/*sysfs register read write */
unsigned short sysfs_I2C_regaddr;
unsigned short sysfs_I2C_regval;
unsigned short sysfslastreadval;
atomic_t hrm_enabled;
atomic_t hrmled_enabled;
atomic_t adpd_mode;
int (*read)(struct adpd143_data *, u8 reg_addr, int len, u16 *buf);
int (*write)(struct adpd143_data *, u8 reg_addr, int len, u16 data);
u8 eol_test_is_enable;
u8 eol_test_status;
char *eol_test_result;
char *eol_lib_ver;
char *elf_lib_ver;
const char *led_3p3;
const char *vdd_1p8;
const char *i2c_1p8;
int osc_trim_32K_value;
int osc_trim_32M_value;
int osc_trim_addr26_value;
int osc_trim_addr28_value;
int osc_trim_addr29_value;
u8 osc_trim_open_enable;
};
/**
structure hold adpd143 configuration data to be written during probe.
*/
static struct adpd_platform_data adpd143_config_data = {
.config_size = 54,
.config_data = {
0x00100001,
0x000100ff,
0x00020005,
0x00060000,
0x00111011,
0x0012000A,
0x00130320,
0x00140449,
0x00150333,
0x001C4040,
0x001D4040,
0x00181400,
0x00191400,
0x001a1650,
0x001b1000,
0x001e1ff0,
0x001f1Fc0,
0x00201ad0,
0x00211470,
0x00231032,
0x00241039,
0x002502CC,
0x00340000,
0x00260000,
0x00270800,
0x00280000,
0x00294003,
0x00300330,
0x00310213,
0x00421d37,
0x0043ada5,
0x003924D2,
0x00350330,
0x00360813,
0x00441d37,
0x0045ada5,
0x003b24D2,
0x00590808,
0x00320320,
0x00330113,
0x003a22d4,
0x003c0006,
0x00401010,
0x0041004c,
0x004c0004,
0x004f2090,
0x00500000,
0x00523000,
0x0053e400,
0x00580000,
0x005b1831,
0x005d1b31,
0x005e2808,
0x004e0040,
},
};
static struct adpd_platform_data adpd143_tia_adc_config_data = {
.config_size = 66,
.config_data = {
0x00100001, 0x000100ff, 0x00020005, 0x00060000,
0x00111011, 0x00120020, 0x00130320,
0x00140000, /* No PD connect first for dark calibration */
0x00150000,
0x00233034, 0x0024303A, 0x002502CC,
0x00340100, /* LED off */
0x00260000, 0x00270800, 0x00280000,
0x00300220, 0x00350220, /* Pulse offset */
0x00310440, 0x00360244, /* Pulse count 0x0813/0120 */
0x00294003,
0x003924D2, 0x003b1a70, /* AFE_CTRL */
0x00421d34, 0x00441d26, /* AFE_TRIM */
0x0043b065, 0x0045ae65, /* AFE_MUX_SW */
0x005e0808, 0x00597a08, /* float */
0x00168080, 0x00178080, 0x001C8080, 0x001D8080, /*AFE ch gain */
0x005b0000,
0x00370000, 0x003d0000,
0x00460000, 0x00470080, 0x00480000,
0x00490000, 0x004a0000, 0x005d0000,
0x00320320, 0x00330113, 0x003a22d4,
0x003c3206, /* 32Mhz/PD cathod to VDD - hrm : 0x003c0006 */
0x00401010, 0x0041004c, 0x004c0004,
0x004d4272, 0x004f2090, 0x00500000, 0x00523000,
0x0053e400, 0x004e0040,
0x005a0000,
/* slot B-float:subtract first, add second -hrm:0x00580000 */
0x00580040,
/* ADC offset start */
0x00180000,
0x00190000,
0x001a0000,
0x001b0000,
0x001e0000,
0x001f0000,
0x00200000,
0x00210000,
/* ADC offset end */
},
};
static int adpd143_configuration(struct adpd143_data *pst_adpd, unsigned char config);
static int adpd143_TIA_ADC_configuration(struct adpd143_data *pst_adpd, unsigned char config);
/* for TIA_ADC runtime Dark Calibration */
static unsigned short is_TIA_Dark_Cal = 0;
static unsigned short is_Float_Dark_Cal = 0;
static unsigned rawDarkCh[8];
static unsigned rawDataCh[8];
static unsigned ch1FloatSat = 65535;
static unsigned ch2FloatSat = 65535;
static unsigned ch3FloatSat = 65535;
static unsigned ch4FloatSat = 65535;
/**
This function is used to parse data from the string "0xXXX 1 0xYYY"
@param buf is pointer point constant address
@param cnt store number value need to parse
@param data parse data are stored in it
@return void
*/
static void
cmd_parsing(const char *buf, unsigned short cnt, unsigned short *data)
{
char **bp = (char **)&buf;
char *token, minus, parsing_cnt = 0;
int val;
int pos;
while ((token = strsep(bp, " "))) {
pos = 0;
minus = false;
if ((char)token[pos] == '-') {
minus = true;
pos++;
}
if ((token[pos] == '0') &&
(token[pos + 1] == 'x' || token[pos + 1] == 'X')) {
if (kstrtoul(&token[pos + 2], 16,
(long unsigned int *)&val))
val = 0;
if (minus)
val *= (-1);
} else {
if (kstrtoul(&token[pos], 10,
(long unsigned int *)&val))
val = 0;
if (minus)
val *= (-1);
}
if (parsing_cnt < cnt)
*(data + parsing_cnt) = (unsigned short)val;
else
break;
parsing_cnt++;
}
}
/**
This function is a inline function mapped to i2c read functionality
@param pst_adpd the ADPD143 data structure
@param reg is the address from which the value need to be read out
@return u16 value present in the register.
*/
static inline u16
reg_read(struct adpd143_data *pst_adpd, u16 reg)
{
u16 value;
if (!pst_adpd->read(pst_adpd, reg, 1, &value))
return value;
return 0xFFFF;
}
/**
This function is a inline function mapped to i2c read functionality
@param pst_adpd the ADPD143 data structure
@param reg is the address from which the value need to be read out
@param len number of data need to be readout
@param buf is pointer store the value present in the register.
@return u16 status of i2c read.
*/
static inline u16
multi_reg_read(struct adpd143_data *pst_adpd, u16 reg, u16 len, u16 *buf)
{
return pst_adpd->read(pst_adpd, reg, len, buf);
}
/**
This function is a inline function mapped to i2c write functionality
@param pst_adpd the ADPD143 data structure
@param reg is the address to which the data need to be written
@param value is the data need to be write.
@return u16 status of i2c write.
*/
static inline u16
reg_write(struct adpd143_data *pst_adpd, u16 reg, u16 value)
{
return pst_adpd->write(pst_adpd, reg, 1, value);
}
/**
This function is used for I2C read from the sysfs
file system of the ADPD143 Chip
@param pst_adpd the ADPD143 data structure
@return u16 status of i2c read.
*/
static u16
adpd143_sysfs_I2C_read(struct adpd143_data *pst_adpd)
{
return reg_read(pst_adpd, pst_adpd->sysfs_I2C_regaddr);
}
/**
This function is used for I2C write from the sysfs
file system of the ADPD143 Chip
@param pst_adpd the ADPD143 data structure
@return u16 the bytes of written data.
*/
static u16
adpd143_sysfs_I2C_write(struct adpd143_data *pst_adpd)
{
u16 err;
err = reg_write(pst_adpd, pst_adpd->sysfs_I2C_regaddr,
pst_adpd->sysfs_I2C_regval);
if (err)
return 0xFFFF;
else
return pst_adpd->sysfs_I2C_regval;
}
/**
This function is used to parse string
@param recv_buf pointer point a string
@return int
*/
static int
parse_data(char *recv_buf)
{
char **bp = (char **)&recv_buf;
char *token, parsing_cnt = 0;
long val;
int test_data;
unsigned int data = 0;
int ret = 0;
char test[10] = {'\0'};
while ((token = strsep(bp, " \t"))) {
memset(test, '\0', 10);
memcpy(test, token, strlen(token));
memmove(test+2, test, strlen(test));
test[0] = '0';
test[1] = 'x';
ret = kstrtol(test, 0, &val);
if (ret) {
if (ret == -ERANGE) {
ADPD143_info("out of range\n");
val = 0;
}
if (ret == -EINVAL) {
ADPD143_info("parsing error\n");
sscanf(test, "%x", &test_data);
val = test_data;
}
}
if (parsing_cnt == 0) {
data = (int) (0xFF & val);
if (data == 0)
return -1;
}
if (parsing_cnt == 1) {
data = data << 16;
data |= (0xFFFF & val);
}
parsing_cnt++;
if (parsing_cnt > 2)
break;
}
return data;
}
/**
This function is used for reading configuration file
@param pst_adpd the ADPD143 data structure
@return int status of the configuration file.
*/
static int
adpd143_read_config_file(struct adpd143_data *pst_adpd)
{
mm_segment_t old_fs;
struct file *fpt_adpd = NULL;
struct adpd_platform_data *ptr_config = NULL;
int line_cnt = 0;
int start = 0;
int cnt = 0;
int ret = 0;
int i = 0;
char get_char;
char *recieved_buf = NULL;
loff_t pos = 0;
ptr_config = pst_adpd->ptr_config;
old_fs = get_fs();
set_fs(KERNEL_DS);
fpt_adpd = filp_open("/data/misc/adpd143_config.dcfg", O_RDONLY, 0666);
if (IS_ERR(fpt_adpd)) {
ADPD143_dbg("unable to find de file %ld\n", PTR_ERR(fpt_adpd));
set_fs(old_fs);
ret = /*PTR_ERR(fpt_adpd_filp); */ -1;
ptr_config->config_size = 0;
goto err_filp_open;
}
recieved_buf = kzalloc(sizeof(char) * 15, GFP_KERNEL);
memset(recieved_buf, '\0', sizeof(char) * 15);
while (vfs_read(fpt_adpd, &get_char, sizeof(char), &pos)) {
if (get_char == '\n') {
line_cnt++;
if (cnt > 1) {
ret = parse_data(recieved_buf);
if (ret == -1) {
ADPD143_dbg("Error in reading dcfg\n");
break;
}
ADPD143_info("0x%08x\n", ret);
ptr_config->config_data[i] = ret;
i++;
}
memset(recieved_buf, '\0', sizeof(char) * 15);
start = 0;
cnt = 0;
ret = 0;
} else {
if (get_char != '#') {
if (start != 0xF) {
recieved_buf[cnt] = get_char;
cnt++;
}
} else {
start = 0xF;
}
}
}
filp_close(fpt_adpd, NULL);
set_fs(old_fs);
kfree(recieved_buf);
ptr_config->config_size = i;
return 0;
err_filp_open:
return -1;
}
/**
This function is used for reading interrupt and FIFO status
@param pst_adpd the ADPD143 data structure
@return unsigned short interrupt status value
*/
static unsigned short
adpd143_rd_intr_fifo(struct adpd143_data *pst_adpd)
{
unsigned short regval = 0;
unsigned short fifo_size = 0;
unsigned short usr_mode = 0;
regval = reg_read(pst_adpd, ADPD_INT_STATUS_ADDR);
fifo_size = ((regval & 0xFF00) >> 8);
pst_adpd->fifo_size = ((fifo_size / 2) + (fifo_size & 1));
pst_adpd->intr_status_val = (regval & 0xFF);
ADPD143_info("Intr_status 0x%x, FIFO_SIZE 0x%x\n",
pst_adpd->intr_status_val, pst_adpd->fifo_size);
if (fifo_size <= 16)
atomic_inc(&pst_adpd->stats.fifo_bytes[0]);
else if (fifo_size <= 32)
atomic_inc(&pst_adpd->stats.fifo_bytes[1]);
else if (fifo_size <= 64)
atomic_inc(&pst_adpd->stats.fifo_bytes[2]);
else
atomic_inc(&pst_adpd->stats.fifo_bytes[3]);
usr_mode = atomic_read(&pst_adpd->adpd_mode);
if (0 != usr_mode) {
unsigned int mask = 0;
unsigned int mod = 0;
switch (GET_USR_SUB_MODE(usr_mode)) {
case S_SAMP_XY_AB:
mask = 0x07;
break;
default:
mask = 0x03;
break;
};
mod = pst_adpd->fifo_size & mask;
if (mod) {
ADPD143_info("Keeping %d samples in FIFO from %d\n",
mod, pst_adpd->fifo_size);
pst_adpd->fifo_size &= ~mask;
atomic_inc(&pst_adpd->stats.fifo_requires_sync);
}
}
return pst_adpd->intr_status_val;
}
/**
This function is used for clearing the Interrupt as well as FIFO
@param pst_adpd the ADPD143 data structure
@return void
*/
static void
adpd143_clr_intr_fifo(struct adpd143_data *pst_adpd)
{
/*below code is added for verification */
unsigned short regval;
regval = reg_read(pst_adpd, ADPD_INT_STATUS_ADDR);
ADPD143_info("fifo_size: 0x%04x, Status: 0x%x\n",
((regval & 0xFF00) >> 8), (regval & 0xFF));
reg_write(pst_adpd, ADPD_INT_STATUS_ADDR, 0x80FF);
regval = reg_read(pst_adpd, ADPD_INT_STATUS_ADDR);
ADPD143_info("After clear - fifo_size: 0x%04x, Status: 0x%x\n",
((regval & 0xFF00) >> 8), (regval & 0xFF));
}
/**
This function is used for clearing the Interrupt status
@param pst_adpd the ADPD143 data structure
@param mode operating mode of ADPD143
@return void
*/
static void
adpd143_clr_intr_status(struct adpd143_data *pst_adpd, unsigned short mode)
{
reg_write(pst_adpd, ADPD_INT_STATUS_ADDR,
pst_adpd->intr_status_val);
}
/**
This function is used to read out FIFO data from FIFO
@param pst_adpd the ADPD143 data structure
@return unsigned int FIFO size
*/
static unsigned int
adpd143_rd_fifo_data(struct adpd143_data *pst_adpd)
{
int loop_cnt = 0;
if (!pst_adpd->fifo_size)
goto err_rd_fifo_data;
if (0 != atomic_read(&pst_adpd->adpd_mode) &&
pst_adpd->fifo_size & 0x3) {
pr_err("Unexpected FIFO_SIZE=%d,\
should be multiple of four (channels)!\n",
pst_adpd->fifo_size);
}
/* reg_write(pst_adpd, ADPD_ACCESS_CTRL_ADDR, 0x0001);*/
reg_write(pst_adpd, ADPD_TEST_PD_ADDR, EN_FIFO_CLK);
multi_reg_read(pst_adpd, ADPD_DATA_BUFFER_ADDR,
pst_adpd->fifo_size, pst_adpd->ptr_data);
/* reg_write(pst_adpd, ADPD_ACCESS_CTRL_ADDR, 0x0000);*/
reg_write(pst_adpd, ADPD_TEST_PD_ADDR, DS_FIFO_CLK);
for (; loop_cnt < pst_adpd->fifo_size; loop_cnt++) {
ADPD143_info("[0x%04x] 0x%04x\n", loop_cnt,
pst_adpd->ptr_data[loop_cnt]);
}
return pst_adpd->fifo_size;
err_rd_fifo_data:
return 0;
}
/**
This function is a thing need to configure before changing the register
@param pst_adpd the ADPD143 data structure
@param global_mode OFF, IDLE, GO are the three mode
@return void
*/
static void
adpd143_config_prerequisite(struct adpd143_data *pst_adpd, u32 global_mode)
{
unsigned short regval = 0;
regval = reg_read(pst_adpd, ADPD_OP_MODE_ADDR);
regval = SET_GLOBAL_OP_MODE(regval, global_mode);
ADPD143_info("reg 0x%04x,\tafter set 0x%04x\n",
regval, SET_GLOBAL_OP_MODE(regval, global_mode));
reg_write(pst_adpd, ADPD_OP_MODE_ADDR, regval);
}
void adpd143_pin_control(struct adpd143_data *pst_adpd, bool pin_set)
{
int status = 0;
pst_adpd->p->state = NULL;
if (pin_set) {
if (!IS_ERR(pst_adpd->pins_idle)) {
status = pinctrl_select_state(pst_adpd->p,
pst_adpd->pins_idle);
if (status)
pr_err("%s: can't set pin default state\n",
__func__);
pr_debug("%s idle\n", __func__);
}
} else {
if (!IS_ERR(pst_adpd->pins_sleep)) {
status = pinctrl_select_state(pst_adpd->p,
pst_adpd->pins_sleep);
if (status)
pr_err("%s: can't set pin sleep state\n",
__func__);
pr_debug("%s sleep\n", __func__);
}
}
}
/**
This function is used for switching the adpd143 mode
@param pst_adpd the ADPD143 data structure
@param usr_mode user mode
@return void
*/
static void
adpd143_mode_switching(struct adpd143_data *pst_adpd, u32 usr_mode)
{
unsigned int opmode_val = 0;
unsigned short mode_val = 0;
unsigned short intr_mask_val = 0;
int i;
unsigned short mode = GET_USR_MODE(usr_mode);
unsigned short sub_mode = GET_USR_SUB_MODE(usr_mode);
/*disabling further avoid further interrupt to trigger */
disable_irq(pst_adpd->irq);
/*stop the pending work */
/*this function Gurantee that wrk is not pending or executing on CPU */
cancel_work_sync(&pst_adpd->work);
atomic_set(&pst_adpd->adpd_mode, 0);
mutex_lock(&pst_adpd->mutex);
/*Depending upon the mode get the value need to write Operatin mode*/
opmode_val = *(__mode_recv_frm_usr[mode].mode_code + (sub_mode));
adpd143_config_prerequisite(pst_adpd, GLOBAL_OP_MODE_IDLE);
/*switch to IDLE mode */
mode_val = DEFAULT_OP_MODE_CFG_VAL(pst_adpd);
mode_val += SET_MODE_VALUE(IDLE_OFF);
intr_mask_val = SET_INTR_MASK(IDLE_USR);
reg_write(pst_adpd, ADPD_OP_MODE_CFG_ADDR, mode_val);
reg_write(pst_adpd, ADPD_INT_MASK_ADDR, intr_mask_val);
/*clear FIFO and flush buffer */
adpd143_clr_intr_fifo(pst_adpd);
adpd143_rd_intr_fifo(pst_adpd);
if (pst_adpd->fifo_size != 0) {
adpd143_clr_intr_status(pst_adpd, IDLE_USR);
ADPD143_info("Flushing FIFO\n");
adpd143_rd_fifo_data(pst_adpd);
}
adpd143_config_prerequisite(pst_adpd, GLOBAL_OP_MODE_GO);
msleep(20);
adpd143_config_prerequisite(pst_adpd, GLOBAL_OP_MODE_IDLE);
/*Find Interrupt mask value */
switch (mode) {
case IDLE_USR:
ADPD143_info("IDLE MODE\n");
intr_mask_val = SET_INTR_MASK(IDLE_USR);
atomic_set(&pst_adpd->hrm_enabled, HRM_IDLE_MODE);
break;
case SAMPLE_USR:
ADPD143_info("SAMPLE MODE\n");
/*enable interrupt only when data written to FIFO */
switch (sub_mode) {
case S_SAMP_XY_A:
intr_mask_val = SET_INTR_MASK(S_SAMP_XY_A_USR);
break;
case S_SAMP_XY_AB:
intr_mask_val = SET_INTR_MASK(S_SAMP_XY_AB_USR);
break;
case S_SAMP_XY_B:
intr_mask_val = SET_INTR_MASK(S_SAMP_XY_B_USR);
break;
default:
intr_mask_val = SET_INTR_MASK(SAMPLE_USR);
break;
};
intr_mask_val |= 0xC000;
atomic_set(&pst_adpd->hrm_enabled, HRM_SAMPLE_MODE);
adpd143_configuration(pst_adpd, 1);
break;
case TIA_ADC_USR:
ADPD143_info("TIA_ADC_USR SAMPLE MODE\n");
/* for TIA_ADC runtime Dark Calibration */
ch1FloatSat = ch2FloatSat = ch3FloatSat = ch4FloatSat = 65535;
is_TIA_Dark_Cal = is_Float_Dark_Cal = 0;
for(i = 0; i < 8; i++) rawDarkCh[i] = rawDataCh[i] = 0;
/*enable interrupt only when data written to FIFO */
switch (sub_mode) {
case S_SAMP_XY_A:
intr_mask_val = SET_INTR_MASK(S_SAMP_XY_A_USR);
break;
case S_SAMP_XY_AB:
intr_mask_val = SET_INTR_MASK(S_SAMP_XY_AB_USR);
break;
case S_SAMP_XY_B:
intr_mask_val = SET_INTR_MASK(S_SAMP_XY_B_USR);
break;
default:
intr_mask_val = SET_INTR_MASK(SAMPLE_USR);
break;
};
intr_mask_val |= 0xC000;
atomic_set(&pst_adpd->hrm_enabled, HRM_TIA_ADC_MODE);
adpd143_TIA_ADC_configuration(pst_adpd, 1);
break;
default:
/*This case won't occur */
ADPD143_dbg("invalid mode\n");
break;
};
ADPD143_info("INT_MASK_ADDR[0x%04x] = 0x%04x\n", ADPD_INT_MASK_ADDR,
intr_mask_val);
pst_adpd->intr_mask_val = intr_mask_val;
/*Fetch Default opmode configuration other than OP mode
and DATA_OUT mode */
mode_val = DEFAULT_OP_MODE_CFG_VAL(pst_adpd);
/*Get Mode value from the opmode value,
to hardocde the macro, change SET_MODE_VALUE macro and concern
mode macro
*/
mode_val += SET_MODE_VALUE(opmode_val);
ADPD143_info("OP_MODE_CFG[0x%04x] = 0x%04x\n",
ADPD_OP_MODE_CFG_ADDR, mode_val);
atomic_set(&pst_adpd->adpd_mode, usr_mode);
reg_write(pst_adpd, ADPD_INT_MASK_ADDR, pst_adpd->intr_mask_val);
reg_write(pst_adpd, ADPD_OP_MODE_CFG_ADDR, mode_val);
mutex_unlock(&pst_adpd->mutex);
enable_irq(pst_adpd->irq);
if (mode != IDLE_USR)
adpd143_config_prerequisite(pst_adpd, GLOBAL_OP_MODE_GO);
else
adpd143_config_prerequisite(pst_adpd, GLOBAL_OP_MODE_OFF);
}
/**
This function is used for sending Sample event depend upon
the Sample mode
@param pst_adpd the ADPD143 data structure
@return void
*/
/* for making float mode saturated at the point */
#define FLOAT_STR_CONTROL 7200
/* for TIA_ADC runtime Dark Calibration */
#define TIA_DARK_CAL_CNT 5
#define FLOAT_DARK_CAL_CNT 5
static void
adpd143_sample_event(struct adpd143_data *pst_adpd)
{
unsigned short usr_mode = 0;
unsigned short sub_mode = 0;
unsigned short cnt = 0;
unsigned int ch;
unsigned short uncoated_ch3 = 0;
unsigned short coated_ch4 = 0;
unsigned short k = 0;
ADPD143_info("%s\n", __func__);
usr_mode = atomic_read(&pst_adpd->adpd_mode);
sub_mode = GET_USR_SUB_MODE(usr_mode);
pst_adpd->sample_cnt++;
if ((pst_adpd->sample_cnt % 200) == 1) {
printk("%s: user mode : %d, sub mode : %d\n",
__func__, GET_USR_MODE(usr_mode),GET_USR_SUB_MODE(usr_mode));
pst_adpd->sample_cnt = 0;
}
switch (sub_mode) {
case S_SAMP_XY_A:
if (pst_adpd->fifo_size < 4 || (pst_adpd->fifo_size & 0x3)) {
pr_err("Unexpected FIFO_SIZE=%d\n",
pst_adpd->fifo_size);
break;
}
if(GET_USR_MODE(usr_mode) != TIA_ADC_USR) {
for (cnt = 0; cnt < pst_adpd->fifo_size; cnt += 4) {
if (atomic_read(&pst_adpd->hrmled_enabled)) {
input_event(pst_adpd->hrmled_input_dev,
EV_REL, REL_Z, sub_mode + 1);
input_event(pst_adpd->hrmled_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt] + 1);
input_event(pst_adpd->hrmled_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 1] + 1);
input_event(pst_adpd->hrmled_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 2] + 1);
input_event(pst_adpd->hrmled_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 3] + 1);
input_sync(pst_adpd->hrmled_input_dev);
} else {
input_event(pst_adpd->hrm_input_dev,
EV_REL, REL_Z, sub_mode + 1);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt] + 1);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 1] + 1);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 2] + 1);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 3] + 1);
input_sync(pst_adpd->hrm_input_dev);
}
}
} else {
for (cnt = 0; cnt < pst_adpd->fifo_size; cnt += 4) {
/* for TIA_ADC runtime Dark Calibration */
if (is_TIA_Dark_Cal < TIA_DARK_CAL_CNT
&& is_TIA_Dark_Cal > 1) {
for(k = 0; k < 4; k++) {
if (rawDarkCh[k] < pst_adpd->ptr_data[cnt+k]
|| !rawDarkCh[k])
rawDarkCh[k] = pst_adpd->ptr_data[cnt+k];
}
is_TIA_Dark_Cal++;
continue;
} else if (is_TIA_Dark_Cal >= TIA_DARK_CAL_CNT
&& is_TIA_Dark_Cal < 100) {
rawDarkCh[0] -= 1470;
rawDarkCh[1] -= 205;
rawDarkCh[2] -= 210;
rawDarkCh[3] -= 230;
is_TIA_Dark_Cal = 100;
continue;
} else if (is_TIA_Dark_Cal < TIA_DARK_CAL_CNT) {
is_TIA_Dark_Cal++;
continue;
} else if (is_TIA_Dark_Cal == 100) {
reg_write(pst_adpd, 0x10,0x0001);
reg_write(pst_adpd, 0x14,0x0441);
reg_write(pst_adpd, 0x10,0x0002);
is_TIA_Dark_Cal++;
continue;
}
/* for making float mode saturated at the point */
for(ch = 0; ch < 4; ++ch) {
rawDataCh[ch] =
rawDarkCh[ch] - pst_adpd->ptr_data[cnt+ch];
rawDataCh[ch] =
((int)rawDataCh[ch] < 0)? 0 : rawDataCh[ch];
}
input_event(pst_adpd->hrm_input_dev,
EV_REL, REL_Z, sub_mode + 1);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, rawDataCh[0]);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, rawDataCh[1]);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, rawDataCh[2]);
uncoated_ch3 = rawDataCh[2];
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, rawDataCh[3]);
input_sync(pst_adpd->hrm_input_dev);
coated_ch4 = rawDataCh[3];
pr_err("adpd143 SLOT A(TIA) unch3:%d, ch4=%d\n",
uncoated_ch3, coated_ch4);
}
}
break;
case S_SAMP_XY_AB:
if (pst_adpd->fifo_size < 8 || (pst_adpd->fifo_size & 0x7)) {
pr_err("Unexpected FIFO_SIZE=%d\n",
pst_adpd->fifo_size);
break;
}
if (GET_USR_MODE(usr_mode) != TIA_ADC_USR) {
for (cnt = 0; cnt < pst_adpd->fifo_size; cnt += 8) {
unsigned int sum_slot_a = 0;
unsigned int sum_slot_b = 0;
if (atomic_read(&pst_adpd->hrmled_enabled)) {
input_event(pst_adpd->hrmled_input_dev,
EV_REL, REL_Z, sub_mode + 1);
for (ch = 0; ch < 4; ++ch) {
sum_slot_a +=
pst_adpd->ptr_data[cnt+ch];
input_event(pst_adpd->hrmled_input_dev,
EV_MSC, MSC_RAW,
pst_adpd->ptr_data[cnt+ch] + 1);
}
input_event(pst_adpd->hrmled_input_dev,
EV_REL, REL_X, sum_slot_a + 1);
for (ch = 4; ch < 8; ++ch) {
sum_slot_b +=
pst_adpd->ptr_data[cnt+ch];
input_event(pst_adpd->hrmled_input_dev,
EV_MSC, MSC_RAW,
pst_adpd->ptr_data[cnt+ch] + 1);
}
input_event(pst_adpd->hrmled_input_dev,
EV_REL, REL_Y, sum_slot_b + 1);
input_sync(pst_adpd->hrmled_input_dev);
} else {
input_event(pst_adpd->hrm_input_dev,
EV_REL, REL_Z, sub_mode + 1);
for (ch = 0; ch < 4; ++ch) {
sum_slot_a +=
pst_adpd->ptr_data[cnt+ch];
input_event(pst_adpd->hrm_input_dev,
EV_MSC, MSC_RAW,
pst_adpd->ptr_data[cnt+ch] + 1);
}
input_event(pst_adpd->hrm_input_dev,
EV_REL, REL_X, sum_slot_a + 1);
for (ch = 4; ch < 8; ++ch) {
sum_slot_b +=
pst_adpd->ptr_data[cnt+ch];
input_event(pst_adpd->hrm_input_dev,
EV_MSC, MSC_RAW,
pst_adpd->ptr_data[cnt+ch] + 1);
}
input_event(pst_adpd->hrm_input_dev,
EV_REL, REL_Y, sum_slot_b + 1);
input_sync(pst_adpd->hrm_input_dev);
pr_err("adpd143 sum_slot_a:%d, sum_slot_b:%d\n",
sum_slot_a, sum_slot_b);
}
}
} else {
for (cnt = 0; cnt < pst_adpd->fifo_size; cnt += 8) {
input_event(pst_adpd->hrm_input_dev,
EV_REL, REL_Z, sub_mode + 1);
/* for TIA_ADC runtime Dark Calibration */
if (is_TIA_Dark_Cal < TIA_DARK_CAL_CNT
&& is_TIA_Dark_Cal > 1) {
for(k = 0; k < 4; k++) {
if (rawDarkCh[k] < pst_adpd->ptr_data[cnt+k]
|| !rawDarkCh[k])
rawDarkCh[k] = pst_adpd->ptr_data[cnt+k];
}
is_TIA_Dark_Cal++;
} else if (is_TIA_Dark_Cal >= TIA_DARK_CAL_CNT
&& is_TIA_Dark_Cal < 100) {
rawDarkCh[0] -= 1470;
rawDarkCh[1] -= 205;
rawDarkCh[2] -= 210;
rawDarkCh[3] -= 230;
is_TIA_Dark_Cal = 100;
} else if (is_TIA_Dark_Cal < TIA_DARK_CAL_CNT) {
is_TIA_Dark_Cal++;
}
/* for TIA_ADC runtime Dark Calibration */
if (is_Float_Dark_Cal < TIA_DARK_CAL_CNT &&
is_Float_Dark_Cal > 1) {
for(k = 4; k < 8; k++) {
if (rawDarkCh[k] < pst_adpd->ptr_data[cnt+k]
|| !rawDarkCh[k])
rawDarkCh[k] = pst_adpd->ptr_data[cnt+k];
}
is_Float_Dark_Cal++;
continue;
} else if (is_Float_Dark_Cal >= TIA_DARK_CAL_CNT &&
is_Float_Dark_Cal < 100) {
is_Float_Dark_Cal = 100;
continue;
} else if (is_Float_Dark_Cal < TIA_DARK_CAL_CNT) {
is_Float_Dark_Cal++;
continue;
} else if (is_Float_Dark_Cal == 100) {
reg_write(pst_adpd, 0x10,0x0001);
reg_write(pst_adpd, 0x14,0x0441);
reg_write(pst_adpd, 0x10,0x0002);
is_Float_Dark_Cal++;
continue;
}
/* for making float mode saturated at the point */
for(ch = 0; ch < 4; ++ch) {
rawDataCh[ch]
= rawDarkCh[ch] - pst_adpd->ptr_data[cnt+ch];
rawDataCh[ch]
= ((int)rawDataCh[ch] < 0)? 0 : rawDataCh[ch];
}
for (ch = 0; ch < 4; ++ch) {
if (ch == 2) uncoated_ch3 = rawDataCh[2];
if (ch == 3) {
coated_ch4 = rawDataCh[3];
/* for approximating the code continuity between float and TIA_ADC */
input_event(pst_adpd->hrm_input_dev,
EV_MSC, MSC_RAW, rawDataCh[ch]*2 );
} else {
input_event(pst_adpd->hrm_input_dev,
EV_MSC, MSC_RAW, rawDataCh[ch]);
pr_err("adpd143 SLOT A %d:%d\n",
ch, rawDataCh[ch]);
}
}
if (uncoated_ch3 == 0) {
uncoated_ch3++;
coated_ch4++;
}
input_event(pst_adpd->hrm_input_dev, EV_REL,
REL_X, (((unsigned)coated_ch4) * 100) / uncoated_ch3);
/* for making float mode saturated at the point */
for (ch = 4; ch < 8; ++ch) {
pr_err("adpd142 SLOT B(float mode) : rawDataCh%d : %d, rawDarkCh%d : %d\n",
ch, pst_adpd->ptr_data[cnt+ch], ch, rawDarkCh[ch]);
rawDataCh[ch] =
pst_adpd->ptr_data[cnt+ch] - rawDarkCh[ch];
rawDataCh[ch] =
((int)rawDataCh[ch] < 0)? 0 : rawDataCh[ch];
if ((int)rawDataCh[ch] >=
(FLOAT_STR_CONTROL - rawDarkCh[ch])) {
rawDataCh[ch] =
FLOAT_STR_CONTROL - rawDarkCh[ch];
if (ch == 4 &&
(((rawDataCh[0] < ch1FloatSat)
&& (rawDataCh[0] > ch1FloatSat - 20))
|| (ch1FloatSat == 65535)))
ch1FloatSat = rawDataCh[0];
if (ch == 5 &&
(((rawDataCh[1] < ch2FloatSat)
&& (rawDataCh[1] > ch2FloatSat - 20))
|| (ch2FloatSat == 65535)))
ch2FloatSat = rawDataCh[1];
if (ch == 6 &&
(((rawDataCh[2] < ch3FloatSat)
&& (rawDataCh[2] > ch3FloatSat - 20))
|| (ch3FloatSat == 65535)))
ch3FloatSat = rawDataCh[2];
if (ch == 7 &&
(((rawDataCh[3] < ch4FloatSat)
&& (rawDataCh[3] > ch4FloatSat - 10))
|| (ch4FloatSat == 65535)))
ch4FloatSat = rawDataCh[3];
}
}
if ((int)rawDataCh[0] >= ch1FloatSat)
rawDataCh[4] =
FLOAT_STR_CONTROL - rawDarkCh[4];
if ((int)rawDataCh[1] >= ch2FloatSat)
rawDataCh[5] =
FLOAT_STR_CONTROL - rawDarkCh[5];
if ((int)rawDataCh[2] >= ch3FloatSat)
rawDataCh[6] =
FLOAT_STR_CONTROL - rawDarkCh[6];
if ((int)rawDataCh[3] >= ch4FloatSat)
rawDataCh[7] = FLOAT_STR_CONTROL;
for (ch = 4; ch < 8; ++ch) {
if (GET_USR_MODE(usr_mode) == TIA_ADC_USR) {
if (ch == 6)
uncoated_ch3 = rawDataCh[6];
if (ch == 7)
coated_ch4 = rawDataCh[7];
input_event(pst_adpd->hrm_input_dev,
EV_MSC, MSC_RAW, rawDataCh[ch]);
pr_err("adpd143 SLOT B(After Dark Cal) %d:%d\n",
ch, rawDataCh[ch]);
}
}
if (uncoated_ch3 == 0) {
uncoated_ch3++;
coated_ch4++;
}
input_event(pst_adpd->hrm_input_dev,
EV_REL, REL_Y,
(((unsigned)coated_ch4)*100)/uncoated_ch3);
input_sync(pst_adpd->hrm_input_dev);
}
}
break;
case S_SAMP_XY_B:
if (pst_adpd->fifo_size < 4 || (pst_adpd->fifo_size & 0x3)) {
pr_err("Unexpected FIFO_SIZE=%d\n",
pst_adpd->fifo_size);
break;
}
if( GET_USR_MODE(usr_mode) != TIA_ADC_USR ) {
for (cnt = 0; cnt < pst_adpd->fifo_size; cnt += 4) {
if (atomic_read(&pst_adpd->hrmled_enabled)) {
input_event(pst_adpd->hrmled_input_dev, EV_REL,
REL_Z, sub_mode + 1);
input_event(pst_adpd->hrmled_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt] + 1);
input_event(pst_adpd->hrmled_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 1] + 1);
input_event(pst_adpd->hrmled_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 2] + 1);
input_event(pst_adpd->hrmled_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 3] + 1);
input_sync(pst_adpd->hrmled_input_dev);
} else {
input_event(pst_adpd->hrm_input_dev, EV_REL,
REL_Z, sub_mode + 1);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt] + 1);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 1] + 1);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 2] + 1);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, pst_adpd->ptr_data[cnt + 3] + 1);
input_sync(pst_adpd->hrm_input_dev);
}
}
} else {
for (cnt = 0; cnt < pst_adpd->fifo_size; cnt += 4) {
/* for TIA_ADC runtime Dark Calibration */
if (is_Float_Dark_Cal < FLOAT_DARK_CAL_CNT &&
is_Float_Dark_Cal > 1) {
for(k = 4; k < 8; k++) {
if (rawDarkCh[k] < pst_adpd->ptr_data[cnt+k-4]
|| !rawDarkCh[k])
rawDarkCh[k] = pst_adpd->ptr_data[cnt+k-4];
}
is_Float_Dark_Cal++;
continue;
} else if (is_Float_Dark_Cal >= FLOAT_DARK_CAL_CNT
&& is_Float_Dark_Cal < 100) {
is_Float_Dark_Cal = 100;
continue;
} else if (is_Float_Dark_Cal < FLOAT_DARK_CAL_CNT) {
is_Float_Dark_Cal++;
continue;
} else if (is_Float_Dark_Cal == 100) {
reg_write(pst_adpd, 0x10,0x0001);
reg_write(pst_adpd, 0x14,0x0441);
reg_write(pst_adpd, 0x10,0x0002);
is_Float_Dark_Cal++;
}
/* for making float mode saturated at the point */
for(ch = 4; ch < 8; ++ch) {
rawDataCh[ch] =
pst_adpd->ptr_data[cnt+ch] - rawDarkCh[ch];
rawDataCh[ch] =
((int)rawDataCh[ch] < 0) ? 0 : rawDataCh[ch];
if ((int)rawDataCh[ch] >=
(FLOAT_STR_CONTROL - rawDarkCh[ch]))
rawDataCh[ch] =
FLOAT_STR_CONTROL - rawDarkCh[ch];
}
input_event(pst_adpd->hrm_input_dev, EV_REL,
REL_Z, sub_mode + 1);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, rawDataCh[4]);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, rawDataCh[5]);
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, rawDataCh[6]);
uncoated_ch3 = rawDataCh[6];
input_event(pst_adpd->hrm_input_dev, EV_MSC,
MSC_RAW, rawDataCh[7]);
input_sync(pst_adpd->hrm_input_dev);
coated_ch4 = rawDataCh[7];
}
}
break;
default:
break;
};
}
/**
This function is used for handling FIFO when interrupt occured
@param pst_adpd the ADPD143 data structure
@return void
*/
static void
adpd143_data_handler(struct adpd143_data *pst_adpd)
{
unsigned short usr_mode = 0;
unsigned short mode = 0;
unsigned short sub_mode = 0;
mutex_lock(&pst_adpd->mutex);
usr_mode = atomic_read(&pst_adpd->adpd_mode);
mode = GET_USR_MODE(usr_mode);
sub_mode = GET_USR_SUB_MODE(usr_mode);
ADPD143_info("mode - 0x%x,\t sub_mode - 0x%x\n", mode, sub_mode);
adpd143_rd_intr_fifo(pst_adpd);
if (pst_adpd->intr_status_val == 0) {
mutex_unlock(&pst_adpd->mutex);
return;
}
adpd143_clr_intr_status(pst_adpd, mode);
switch (mode) {
case IDLE_USR:
ADPD143_dbg("IDLE_MODE\n");
adpd143_rd_fifo_data(pst_adpd);
break;
case SAMPLE_USR:
ADPD143_info("SAMPLE MODE\n");
adpd143_rd_fifo_data(pst_adpd);
adpd143_sample_event(pst_adpd);
break;
/* for supporting TIA_ADC mode */
case TIA_ADC_USR:
ADPD143_info("SAMPLE TIA ADC MODE\n");
adpd143_rd_fifo_data(pst_adpd);
adpd143_sample_event(pst_adpd);
break;
default:
ADPD143_info("DEFAULT MODE\n");
adpd143_rd_fifo_data(pst_adpd);
break;
};
mutex_unlock(&pst_adpd->mutex);
}
/**
This function is a handler for WorkQueue
@param ptr_work linux work structure
@return void
*/
static void
adpd143_wq_handler(struct work_struct *ptr_work)
{
struct adpd143_data *pst_adpd = container_of(ptr_work,
struct adpd143_data, work);
struct timeval wkq_start;
struct timeval wkq_comp;
int diff_usec = 0;
do_gettimeofday(&wkq_start);
diff_usec = timeval_compare(&wkq_start,
&pst_adpd->stats.stamp.interrupt_trigger);
if (diff_usec > 1) {
if (diff_usec >
atomic_read(&pst_adpd->stats.wq_schedule_time_peak_usec))
atomic_set(&pst_adpd->stats.wq_schedule_time_peak_usec,
diff_usec);
atomic_set(&pst_adpd->stats.wq_schedule_time_last_usec,
diff_usec);
ewma_add(&pst_adpd->stats.wq_schedule_time_avg_usec, diff_usec);
}
adpd143_data_handler(pst_adpd);
do_gettimeofday(&wkq_comp);
diff_usec = timeval_compare(&wkq_comp, &wkq_start);
if (diff_usec > 1) {
if (diff_usec >
atomic_read(&pst_adpd->stats.data_process_time_peak_usec))
atomic_set(
&pst_adpd->stats.data_process_time_peak_usec,
diff_usec);
atomic_set(&pst_adpd->stats.data_process_time_last_usec,
diff_usec);
ewma_add(&pst_adpd->stats.data_process_time_avg_usec,
diff_usec);
}
}
/**
This function is used for handling Interrupt from ADPD143
@param irq is Interrupt number
@param dev_id is pointer point to ADPD143 data structure
@return irqreturn_t is a Interrupt flag
*/
static irqreturn_t
adpd143_isr_handler(int irq, void *dev_id)
{
struct adpd143_data *pst_adpd = dev_id;
atomic_inc(&pst_adpd->stats.interrupts);
if (!work_pending(&pst_adpd->work)) {
do_gettimeofday(&pst_adpd->stats.stamp.interrupt_trigger);
ADPD143_info("%s\n", __func__);
if (!queue_work(pst_adpd->ptr_adpd143_wq_st, &pst_adpd->work))
atomic_inc(&pst_adpd->stats.wq_pending);
} else {
atomic_inc(&pst_adpd->stats.wq_pending);
ADPD143_info("work_pending !!\n");
}
return IRQ_HANDLED;
}
/**
This function is used for updating the ADPD143 structure after configuration
@param pst_adpd the ADPD143 data structure
@return void
*/
static void
adpd143_update_config(struct adpd143_data *pst_adpd)
{
return;
}
/**
This function is used for loading the configuration data to ADPD143 chip
0 - From file "/data/misc/adpd143_configuration.dcfg"
1 - From Static defined Array
@param pst_adpd the ADPD143 data structure
@param config configuration command
@return int status
*/
static int
adpd143_configuration(struct adpd143_data *pst_adpd, unsigned char config)
{
struct adpd_platform_data *ptr_config;
unsigned short addr;
unsigned short data;
unsigned short cnt = 0;
int ret = 0;
/* must be removed in TIA mode */
/* adpd143_mode_switching(pst_adpd, 0); */
if (config == FRM_FILE) {
ret = adpd143_read_config_file(pst_adpd);
/* ADPD143_info("ARRAY_SIZE - %d\n", size);*/
} else {
ret = FRM_ARR;
}
if (ret == 0)
ptr_config = pst_adpd->ptr_config;
else
ptr_config = &adpd143_config_data;
for (cnt = 0; cnt < ptr_config->config_size; cnt++) {
addr = (unsigned short) ((0xFFFF0000 &
ptr_config->config_data[cnt]) >> 16);
data = (unsigned short) (0x0000FFFF &
ptr_config->config_data[cnt]);
ADPD143_dbg("addr[0x%04x] = 0x%04x\n", addr, data);
reg_write(pst_adpd, addr, data);
}
adpd143_update_config(pst_adpd);
return 0;
}
static int
adpd143_TIA_ADC_configuration(struct adpd143_data *pst_adpd, unsigned char config)
{
struct adpd_platform_data *ptr_config;
unsigned short addr;
unsigned short data;
unsigned short cnt = 0;
int ret = 0;
pr_info("%s start", __func__);
if (config == FRM_FILE) {
ret = adpd143_read_config_file(pst_adpd);
/* ADPD143_info("ARRAY_SIZE - %d\n", size);*/
} else {
ret = FRM_ARR;
}
if (ret == 0)
ptr_config = pst_adpd->ptr_config;
else
ptr_config = &adpd143_tia_adc_config_data;
for (cnt = 0; cnt < ptr_config->config_size; cnt++) {
addr = (unsigned short) ((0xFFFF0000 &
ptr_config->config_data[cnt]) >> 16);
data = (unsigned short) (0x0000FFFF &
ptr_config->config_data[cnt]);
ADPD143_dbg("addr[0x%04x] = 0x%04x\n", addr, data);
reg_write(pst_adpd, addr, data);
}
adpd143_update_config(pst_adpd);
return 0;
}
/* read & write efs for hrm sensor */
static int osc_trim_efs_register_open(struct adpd143_data *pst_adpd)
{
struct file *osc_filp = NULL;
char buffer[60] = {0, };
int err = 0;
int osc_trim_32k, osc_trim_32m;
int osc_trim_addr26, osc_trim_addr28, osc_trim_addr29;
mm_segment_t old_fs;
old_fs = get_fs();
set_fs(KERNEL_DS);
osc_filp = filp_open(OSCILLATOR_TRIM_FILE_PATH, O_RDONLY, 0666);
if (IS_ERR(osc_filp)) {
err = PTR_ERR(osc_filp);
if (err != -ENOENT)
pr_err("%s: Can't open oscillator trim file\n",
__func__);
set_fs(old_fs);
return err;
}
err = osc_filp->f_op->read(osc_filp,
(char *)buffer,
60 * sizeof(char), &osc_filp->f_pos);
if (err != (60 * sizeof(char))) {
pr_err("%s: Can't read the oscillator trim data from file\n",
__func__);
err = -EIO;
}
sscanf(buffer, "%d,%d,%d,%d,%d", &osc_trim_32k, &osc_trim_32m,
&osc_trim_addr26, &osc_trim_addr28, &osc_trim_addr29);
pr_info("%s: (%d,%d,%d,%d,%d)\n", __func__, osc_trim_32k,
osc_trim_32m, osc_trim_addr26, osc_trim_addr28, osc_trim_addr29);
pst_adpd->osc_trim_32K_value = osc_trim_32k;
pst_adpd->osc_trim_32M_value = osc_trim_32m;
pst_adpd->osc_trim_addr26_value = osc_trim_addr26;
pst_adpd->osc_trim_addr28_value = osc_trim_addr28;
pst_adpd->osc_trim_addr29_value = osc_trim_addr29;
filp_close(osc_filp, current->files);
set_fs(old_fs);
return err;
}
static int osc_trim_efs_register_save(struct adpd143_data *pst_adpd)
{
struct file *osc_filp = NULL;
mm_segment_t old_fs;
char buffer[60] = {0, };
int osc_trim_32k, osc_trim_32m;
int osc_trim_addr26, osc_trim_addr28, osc_trim_addr29;
int err = 0;
old_fs = get_fs();
set_fs(KERNEL_DS);
osc_filp = filp_open(OSCILLATOR_TRIM_FILE_PATH,
O_CREAT | O_TRUNC | O_WRONLY, 0666);
if (IS_ERR(osc_filp)) {
pr_err("%s: Can't open oscillator trim file\n",
__func__);
set_fs(old_fs);
err = PTR_ERR(osc_filp);
return err;
}
osc_trim_32k = reg_read(pst_adpd, OSC_TRIM_32K_REG);
osc_trim_32m = reg_read(pst_adpd, OSC_TRIM_32M_REG);
osc_trim_addr26 = reg_read(pst_adpd, OSC_TRIM_ADDR26_REG);
osc_trim_addr28 = reg_read(pst_adpd, OSC_TRIM_ADDR28_REG);
osc_trim_addr29 = reg_read(pst_adpd, OSC_TRIM_ADDR29_REG);
sprintf(buffer, "%d,%d,%d,%d,%d", osc_trim_32k, osc_trim_32m,
osc_trim_addr26, osc_trim_addr28, osc_trim_addr29);
pr_info("%s: (%d,%d,%d,%d,%d)\n", __func__, osc_trim_32k, osc_trim_32m,
osc_trim_addr26, osc_trim_addr28, osc_trim_addr29);
err = osc_filp->f_op->write(osc_filp,
(char *)&buffer,
60 * sizeof(char), &osc_filp->f_pos);
if (err != (60 * sizeof(char))) {
pr_err("%s: Can't write the oscillator trim data to file\n",
__func__);
err = -EIO;
}
pst_adpd->osc_trim_32K_value = osc_trim_32k;
pst_adpd->osc_trim_32M_value = osc_trim_32m;
pst_adpd->osc_trim_addr26_value = osc_trim_addr26;
pst_adpd->osc_trim_addr28_value = osc_trim_addr28;
pst_adpd->osc_trim_addr29_value = osc_trim_addr29;
filp_close(osc_filp, current->files);
set_fs(old_fs);
return err;
}
/**
This function clears all the statistic counters.
@param pst_adpd the ADPD143 data structure
@return void
*/
static void
adpd_stat_reset(struct adpd143_data *pst_adpd)
{
atomic_set(&pst_adpd->stats.interrupts, 0);
atomic_set(&pst_adpd->stats.wq_pending, 0);
atomic_set(&pst_adpd->stats.wq_schedule_time_peak_usec, 0);
atomic_set(&pst_adpd->stats.wq_schedule_time_last_usec, 0);
atomic_set(&pst_adpd->stats.data_process_time_peak_usec, 0);
atomic_set(&pst_adpd->stats.data_process_time_last_usec, 0);
atomic_set(&pst_adpd->stats.fifo_requires_sync, 0);
atomic_set(&pst_adpd->stats.fifo_bytes[0], 0);
atomic_set(&pst_adpd->stats.fifo_bytes[1], 0);
atomic_set(&pst_adpd->stats.fifo_bytes[2], 0);
atomic_set(&pst_adpd->stats.fifo_bytes[3], 0);
ewma_init(&pst_adpd->stats.wq_schedule_time_avg_usec, 2048, 128);
ewma_init(&pst_adpd->stats.data_process_time_avg_usec, 2048, 128);
}
/* SAMPLE - SYSFS ATTRIBUTE*/
/**
This function is used for getting the status of the sample enable bit
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@return ssize_t size of data presnt in the buffer
*/
static ssize_t
hrm_attr_get_enable(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
int val = atomic_read(&pst_adpd->hrm_enabled);
return sprintf(buf, "%d\n", val);
}
/**
This function is used for enabling the Sample mode
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@param size buffer size
@return ssize_t size of data written to the buffer
*/
static ssize_t
hrm_attr_set_enable(struct device *dev, struct device_attribute *attr,
const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned short parse_data[2];
unsigned short mode = 0;
unsigned short osc_trim_32k, osc_trim_32m;
unsigned short osc_trim_addr26 = 0, osc_trim_addr28 = 0, osc_trim_addr29 = 0;
int err;
int rc = 0;
int val;
int n = sscanf(buf, "%d", &val);
(void)n;
memset(parse_data, 0, sizeof(parse_data));
if (pst_adpd->osc_trim_open_enable == 1) {
err = osc_trim_efs_register_open(pst_adpd);
if (err < 0) {
pr_err("%s: osc_trim_efs_register() empty(%d)\n",
__func__, err);
osc_trim_32k = OSC_DEFAULT_32K_SET;
osc_trim_32m = OSC_DEFAULT_32M_SET;
} else {
osc_trim_32k = (unsigned short)pst_adpd->osc_trim_32K_value;
osc_trim_32m = (unsigned short)pst_adpd->osc_trim_32M_value;
osc_trim_addr26 = (unsigned short)pst_adpd->osc_trim_addr26_value;
osc_trim_addr28 = (unsigned short)pst_adpd->osc_trim_addr28_value;
osc_trim_addr29 = (unsigned short)pst_adpd->osc_trim_addr29_value;
reg_write(pst_adpd, OSC_TRIM_ADDR26_REG, osc_trim_addr26);
reg_write(pst_adpd, OSC_TRIM_ADDR28_REG, osc_trim_addr28);
reg_write(pst_adpd, OSC_TRIM_ADDR29_REG, osc_trim_addr29);
}
pr_info("%s: 32K[%02x], 32M[%02x], addr26[%02x], addr28[%02x], addr29[%02x]\n",
__func__, osc_trim_32k, osc_trim_32m, osc_trim_addr26,
osc_trim_addr28, osc_trim_addr29);
reg_write(pst_adpd, OSC_TRIM_32K_REG, osc_trim_32k);
reg_write(pst_adpd, OSC_TRIM_32M_REG, osc_trim_32m);
pst_adpd->osc_trim_open_enable = 0;
}
if (val == 1) {
pr_info("%s: enable HRM.\n", __func__);
if (pst_adpd->led_en != -1)
gpio_set_value(pst_adpd->led_en, 1);
else if (!IS_ERR(pst_adpd->leda)) {
rc = regulator_enable(pst_adpd->leda);
if (rc)
pr_info(KERN_ERR "%s: adpd enable failed(%d)\n",
__func__, rc);
}
cmd_parsing("0x31", 1, parse_data);
atomic_set(&pst_adpd->hrm_enabled, HRM_SAMPLE_MODE);
} else if (val == 2) {
pr_info("%s: enable Ambient Light Measurement.\n",
__func__);
if (pst_adpd->led_en != -1)
gpio_set_value(pst_adpd->led_en, 1);
else if (!IS_ERR(pst_adpd->leda))
rc = regulator_enable(pst_adpd->leda);
if (rc)
pr_info(KERN_ERR "%s: adpd enable ALM failed(%d)\n",
__func__, rc);
cmd_parsing("0x51", 1, parse_data);
atomic_set(&pst_adpd->hrm_enabled, HRM_TIA_ADC_MODE);
} else {
pr_info("%s: disable.\n", __func__);
if (pst_adpd->led_en != -1)
gpio_set_value(pst_adpd->led_en, 0);
else if (!IS_ERR(pst_adpd->leda)) {
rc = regulator_disable(pst_adpd->leda);
if (rc)
pr_info(KERN_ERR "%s: adpd disable failed(%d)\n",
__func__, rc);
}
cmd_parsing("0x0", 1, parse_data);
atomic_set(&pst_adpd->hrm_enabled, HRM_IDLE_MODE);
}
mode = GET_USR_MODE(parse_data[0]);
if (GET_USR_MODE(parse_data[0]) < MAX_MODE) {
if ((GET_USR_SUB_MODE(parse_data[0])) <
__mode_recv_frm_usr[mode].size) {
adpd143_mode_switching(pst_adpd, parse_data[0]);
} else {
ADPD143_dbg("Sub mode Out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
} else {
ADPD143_dbg("Mode out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
return size;
}
/* GENERAL - SYSFS ATTRIBUTE*/
/**
This function is used for getting the status of the adpd_mode
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@return ssize_t size of data presnt in the buffer
*/
static ssize_t
attr_get_mode(struct device *dev, struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
int val = atomic_read(&pst_adpd->adpd_mode);
return sprintf(buf, "%d\n", val);
}
/**
This function is used for switching ADPD143 mode
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@param size buffer size
@return ssize_t size of data written to the buffer
*/
static ssize_t
attr_set_mode(struct device *dev, struct device_attribute *attr,
const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned short parse_data[2];
unsigned short mode = 0;
memset(parse_data, 0, sizeof(parse_data));
cmd_parsing(buf, 1, parse_data);
ADPD143_info("Mode requested 0x%02x\n", parse_data[0]);
pr_info("%s: data0[%02x], data1[%02x]\n",
__func__, parse_data[0], parse_data[1]);
mode = GET_USR_MODE(parse_data[0]);
if (GET_USR_MODE(parse_data[0]) < MAX_MODE) {
if ((GET_USR_SUB_MODE(parse_data[0])) <
__mode_recv_frm_usr[mode].size) {
adpd143_mode_switching(pst_adpd, parse_data[0]);
} else {
ADPD143_dbg("Sub mode Out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
} else {
ADPD143_dbg("Mode out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
return size;
}
/**
This function is used for reading the register value
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@return ssize_t size of data presnt in the buffer
*/
static ssize_t
attr_reg_read_get(struct device *dev, struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
ADPD143_dbg("Regval: 0x%4x\n", pst_adpd->sysfslastreadval);
return sprintf(buf, "0x%04x\n", pst_adpd->sysfslastreadval);
}
/**
This function is used for writing the register for reading back
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@param size buffer size
@return ssize_t size of data written to the buffer
*/
static ssize_t
attr_reg_read_set(struct device *dev, struct device_attribute *attr,
const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned short addr, cnt;
unsigned short parse_data[4];
unsigned short ret;
memset(parse_data, 0, sizeof(unsigned short) * 4);
cmd_parsing(buf, 2, parse_data);
addr = parse_data[0];
cnt = parse_data[1];
mutex_lock(&pst_adpd->mutex);
pst_adpd->sysfs_I2C_regaddr = addr;
ret = adpd143_sysfs_I2C_read(pst_adpd);
if (ret != 0xFFFF) {
ADPD143_dbg("RegRead_Store: addr = 0x%04X,value = 0x%04X\n",
addr, ret);
pst_adpd->sysfslastreadval = ret;
} else {
ADPD143_dbg("%s: Error\n", __func__);
pst_adpd->sysfslastreadval = (unsigned short) -1;
}
mutex_unlock(&pst_adpd->mutex);
return size;
}
static int adpd_power_enable(struct adpd143_data *data, int en)
{
int rc = 0;
struct regulator *regulator_led_3p3;
struct regulator *regulator_vdd_1p8;
regulator_vdd_1p8 = regulator_get(NULL, data->vdd_1p8);
if (IS_ERR(regulator_vdd_1p8) || regulator_vdd_1p8 == NULL) {
pr_err("%s: vdd_1p8 regulator_get fail\n", __func__);
return -ENODEV;
}
regulator_led_3p3 = regulator_get(NULL, data->led_3p3);
if (IS_ERR(regulator_led_3p3) || regulator_led_3p3 == NULL) {
pr_err("%s: vdd_3p3 regulator_get fail\n", __func__);
regulator_put(regulator_vdd_1p8);
return -ENODEV;
}
pr_info("%s: onoff = %d\n", __func__, en);
if (en == HRM_LDO_ON) {
rc = regulator_set_voltage(regulator_vdd_1p8, 1800000, 1800000);
if (rc < 0) {
pr_err("%s: set vdd_1p8 failed, rc=%d\n",
__func__, rc);
goto done;
}
rc = regulator_enable(regulator_vdd_1p8);
if (rc) {
pr_err("%s: enable vdd_1p8 failed, rc=%d\n",
__func__, rc);
goto done;
}
rc = regulator_set_voltage(regulator_led_3p3, 3300000, 3300000);
if (rc < 0) {
pr_err("%s: set led_3p3 failed, rc=%d\n",
__func__, rc);
goto done;
}
rc = regulator_enable(regulator_led_3p3);
if (rc) {
pr_err("%s: enable led_3p3 failed, rc=%d\n",
__func__, rc);
goto done;
}
} else {
rc = regulator_disable(regulator_vdd_1p8);
if (rc) {
pr_err("%s: disable vdd_1p8 failed, rc=%d\n",
__func__, rc);
goto done;
}
rc = regulator_disable(regulator_led_3p3);
if (rc) {
pr_err("%s: disable led_3p3 failed, rc=%d\n",
__func__, rc);
goto done;
}
}
done:
regulator_put(regulator_led_3p3);
regulator_put(regulator_vdd_1p8);
return rc;
}
static int adpd_parse_dt(struct adpd143_data *data, struct device *dev)
{
struct device_node *this_node= dev->of_node;
enum of_gpio_flags flags;
int rc;
if (this_node == NULL)
return -ENODEV;
data->hrm_int = of_get_named_gpio_flags(this_node,"adpd143,irq_gpio", 0, &flags);
pr_err("%s: get hrm_int(data->hrm_int)(%d) \n", __func__, data->hrm_int);
if (data->hrm_int < 0) {
pr_err("%s: get hrm_int(%d) error\n", __func__, data->hrm_int);
return -ENODEV;
}
rc = gpio_request(data->hrm_int, "hrm_int");
if (rc) {
pr_err("%s: failed to request hrm_int\n", __func__);
goto err_int_gpio_req;
}
rc = gpio_direction_input(data->hrm_int);
if (rc) {
pr_err("%s: failed to set hrm_int as input\n", __func__);
goto err_int_gpio_direction_input;
}
if (of_property_read_string(this_node, "adpd143,i2c_1p8",
&data->i2c_1p8) < 0)
pr_err("%s - get i2c_1p8 error\n", __func__);
if (of_property_read_string(this_node, "adpd143,vdd_1p8",
&data->vdd_1p8) < 0)
pr_err("%s: get vdd_1p8 error\n", __func__);
if (of_property_read_string(this_node, "adpd143,led_3p3",
&data->led_3p3) < 0)
pr_err("%s: get led_3p3 error\n", __func__);
data->led_en =of_get_named_gpio_flags(this_node,"adpd143,led_en", 0, &flags);
pr_err("%s: get led_en(data->led_en)(%d) \n", __func__, data->led_en);
if (data->led_en < 0) {
pr_err("%s: get led_en(%d) error\n", __func__, data->led_en);
data->led_en = -1;
data->leda = devm_regulator_get(dev, "reg_vled");
if (IS_ERR(data->leda)) {
pr_err("%s: regulator HRM_VLED fail \n",__func__);
}
} else {
rc = gpio_request(data->led_en,"led_en");
if (unlikely(rc < 0)) {
pr_err("%s: gpio %d request failed (%d)\n",
__func__, data->led_en, rc);
goto err_int_gpio_direction_input;
}
rc = gpio_direction_output(data->led_en, 0);
if (unlikely(rc < 0)) {
pr_err("%s: failed to set gpio %d as input (%d)\n",
__func__, data->led_en, rc);
goto err_gpio_direction_output;
}
}
data->p = pinctrl_get_select_default(dev);
if (IS_ERR(data->p)) {
pr_err("%s: failed pinctrl_get\n", __func__);
return -EINVAL;
}
data->pins_sleep = pinctrl_lookup_state(data->p, PINCTRL_STATE_SLEEP);
if(IS_ERR(data->pins_sleep)) {
pr_err("%s : could not get pins sleep_state (%li)\n",
__func__, PTR_ERR(data->pins_sleep));
pinctrl_put(data->p);
return -EINVAL;
}
data->pins_idle = pinctrl_lookup_state(data->p, PINCTRL_STATE_IDLE);
if(IS_ERR(data->pins_idle)) {
pr_err("%s : could not get pins idle_state (%li)\n",
__func__, PTR_ERR(data->pins_idle));
pinctrl_put(data->p);
return -EINVAL;
}
return 0;
err_gpio_direction_output:
gpio_free(data->led_en);
err_int_gpio_direction_input:
gpio_free(data->hrm_int);
err_int_gpio_req:
return rc;
}
/**
This function is used for writing a particular data to the register
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@param size buffer size
@return ssize_t size of data written to the buffer
*/
static ssize_t
attr_reg_write_set(struct device *dev, struct device_attribute *attr,
const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned short cnt;
unsigned short parse_data[4];
unsigned short ret;
memset(parse_data, 0, sizeof(unsigned short) * 4);
cmd_parsing(buf, 3, parse_data);
if (parse_data[1] != 1) {
ADPD143_dbg("few many argument!!\n");
goto err_reg_write_argument;
}
pst_adpd->sysfs_I2C_regaddr = parse_data[0];
cnt = parse_data[1];
pst_adpd->sysfs_I2C_regval = parse_data[2];
mutex_lock(&pst_adpd->mutex);
ret = adpd143_sysfs_I2C_write(pst_adpd);
if (ret == pst_adpd->sysfs_I2C_regval) {
ADPD143_dbg("Reg[0x%04x] = 0x%04x\n",
pst_adpd->sysfs_I2C_regaddr,
pst_adpd->sysfs_I2C_regval);
} else {
ADPD143_dbg("Reg write error!!\n");
}
adpd143_update_config(pst_adpd);
mutex_unlock(&pst_adpd->mutex);
err_reg_write_argument:
return size;
}
/**
This function is used for getting the status of configuration
TBD
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@return ssize_t size of data presnt in the buffer
*/
static ssize_t
attr_config_get(struct device *dev, struct device_attribute *attr, char *buf)
{
return sprintf(buf, "status of config thread\n");
}
/**
This function is used for wrting the configuration value to the register
0 - write the configuration data present in file to ADPD143
1 - write the configuration data present in Array to ADPD143
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@param size buffer size
@return ssize_t size of data written to the buffer
*/
static ssize_t
attr_config_set(struct device *dev, struct device_attribute *attr,
const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned short parse_data[1];
memset(parse_data, 0, sizeof(unsigned short) * 1);
cmd_parsing(buf, 1, parse_data);
if (parse_data[0] == FRM_ARR)
adpd143_configuration(pst_adpd, FRM_ARR);
else if (parse_data[0] == FRM_FILE)
adpd143_configuration(pst_adpd, FRM_FILE);
else
ADPD143_dbg("set 1 to config\n");
return size;
}
/**
This function is used for getting the status of adpd143 and driver
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@return ssize_t size of data presnt in the buffer
*/
static ssize_t
attr_stat_get(struct device *dev, struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned int interrupts = atomic_read(&pst_adpd->stats.interrupts);
unsigned int wq_pending = atomic_read(&pst_adpd->stats.wq_pending);
unsigned int wq_schedule_time_peak_usec =
atomic_read(&pst_adpd->stats.wq_schedule_time_peak_usec);
unsigned int wq_schedule_time_last_usec =
atomic_read(&pst_adpd->stats.wq_schedule_time_last_usec);
unsigned int data_process_time_peak_usec =
atomic_read(&pst_adpd->stats.data_process_time_peak_usec);
unsigned int data_process_time_last_usec =
atomic_read(&pst_adpd->stats.data_process_time_last_usec);
return sprintf(buf, "\
interrupts : %u\n\
wq_pending : %u\n\
wq_schedule_time_peak_usec : %u\n\
wq_schedule_time_avg_usec : %d\n\
wq_schedule_time_last_usec : %u\n\
data_process_time_peak_usec : %u\n\
data_process_time_avg_usec : %d\n\
data_process_time_last_usec : %u\n\
fifo_requires_sync : %d\n\
fifo bytes history : [%d %d %d %d]\n\
ADPD143 driver version : %s\n\
ADPD143 Release date : %s\n",
interrupts, wq_pending,
wq_schedule_time_peak_usec,
(int)ewma_read(&pst_adpd->stats.wq_schedule_time_avg_usec),
wq_schedule_time_last_usec,
data_process_time_peak_usec,
(int)ewma_read(&pst_adpd->stats.data_process_time_avg_usec),
data_process_time_last_usec,
atomic_read(&pst_adpd->stats.fifo_requires_sync),
atomic_read(&pst_adpd->stats.fifo_bytes[0]),
atomic_read(&pst_adpd->stats.fifo_bytes[1]),
atomic_read(&pst_adpd->stats.fifo_bytes[2]),
atomic_read(&pst_adpd->stats.fifo_bytes[3]),
ADPD143_VERSION,
ADPD143_RELEASE_DATE);
}
#define ADPD143_STAT_RESET 1
/**
This function is used for wrting the adpd stat value to zero
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@param size buffer size
@return ssize_t size of data written to the buffer
*/
static ssize_t
attr_stat_set(struct device *dev, struct device_attribute *attr,
const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned short parse_data[1];
memset(parse_data, 0, sizeof(unsigned short) * 1);
cmd_parsing(buf, 1, parse_data);
if (parse_data[0] == ADPD143_STAT_RESET) {
ADPD143_dbg("Resetting statistics\n");
adpd_stat_reset(pst_adpd);
}
return size;
}
/**
array of hrm attributes
*/
static struct device_attribute hrm_attributes[] = {
__ATTR(enable, 0664, hrm_attr_get_enable, hrm_attr_set_enable),
};
/**
This function is used for creating sysfs attribute for hrm
@param dev linux device structure
@return int status of attribute creation
*/
static int
create_sysfs_interfaces_hrm(struct device *dev)
{
int i;
for (i = 0; i < ARRAY_SIZE(hrm_attributes); i++)
if (device_create_file(dev, hrm_attributes + i))
goto err_sysfs_interface_hrm;
return 0;
err_sysfs_interface_hrm:
for (; i >= 0; i--)
device_remove_file(dev, hrm_attributes + i);
dev_err(dev, "%s: Unable to create interface\n", __func__);
return -1;
}
/* SAMPLE - SYSFS ATTRIBUTE*/
/**
This function is used for getting the status of the sample enable bit
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@return ssize_t size of data presnt in the buffer
*/
static ssize_t
hrmled_attr_get_enable(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
int val = atomic_read(&pst_adpd->hrmled_enabled);
return sprintf(buf, "%d\n", val);
}
/**
This function is used for enabling the Sample mode
@param dev linux device structure
@param attr pointer point linux device_attribute structure
@param buf pointer point the buffer
@param size buffer size
@return ssize_t size of data written to the buffer
*/
static ssize_t
hrmled_attr_set_enable(struct device *dev, struct device_attribute *attr,
const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned short parse_data[2];
unsigned short mode = 0;
int val;
int n = sscanf(buf, "%d", &val);
(void)n;
memset(parse_data, 0, sizeof(parse_data));
pr_err("%s: pst_adpd->pre_hrmled_enable:%d, val:%d\n",
__func__, pst_adpd->pre_hrmled_enable, val);
if (pst_adpd->pre_hrmled_enable != val) {
switch(val) {
case IRRED_OFF:
pr_info("%s: IRRED_OFF.\n", __func__);
cmd_parsing("0x0", 1, parse_data);
atomic_set(&pst_adpd->hrmled_enabled, IRRED_OFF);
break;
case IR_MODE:
pr_info("%s: IR_MODE.\n", __func__);
cmd_parsing("0x32", 1, parse_data);
atomic_set(&pst_adpd->hrmled_enabled, IR_MODE);
break;
case RED_MODE:
pr_info("%s: RED_MODE.\n", __func__);
cmd_parsing("0x30", 1, parse_data);
atomic_set(&pst_adpd->hrmled_enabled, RED_MODE);
break;
case IRRED_MODE:
pr_info("%s: IRRED_MODE.\n", __func__);
cmd_parsing("0x31", 1, parse_data);
atomic_set(&pst_adpd->hrmled_enabled, IRRED_MODE);
break;
default:
pr_err("%s: invalid value\n", __func__);
return -EINVAL;
}
}
mode = GET_USR_MODE(parse_data[0]);
if (GET_USR_MODE(parse_data[0]) < MAX_MODE) {
if ((GET_USR_SUB_MODE(parse_data[0])) <
__mode_recv_frm_usr[mode].size) {
adpd143_mode_switching(pst_adpd, parse_data[0]);
} else {
ADPD143_dbg("Sub mode Out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
} else {
ADPD143_dbg("Mode out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
pst_adpd->pre_hrmled_enable = val;
return size;
}
/**
array of hrmled attributes
*/
static struct device_attribute hrmled_attributes[] = {
__ATTR(enable, 0664, hrmled_attr_get_enable, hrmled_attr_set_enable),
};
/**
This function is used for creating sysfs attribute for hrmled
@param dev linux device structure
@return int status of attribute creation
*/
static int
create_sysfs_interfaces_hrmled(struct device *dev)
{
int i;
for (i = 0; i < ARRAY_SIZE(hrmled_attributes); i++)
if (device_create_file(dev, hrmled_attributes + i))
goto err_sysfs_interface_hrmled;
return 0;
err_sysfs_interface_hrmled:
for (; i >= 0; i--)
device_remove_file(dev, hrmled_attributes + i);
dev_err(dev, "%s: Unable to create interface\n", __func__);
return -1;
}
/**
This function is used for removing sysfs attribute for sample
@param dev linux device structure
@return void
*/
static void
remove_sysfs_interfaces_hrm(struct device *dev)
{
int i;
for (i = 0; i < ARRAY_SIZE(hrm_attributes); i++)
device_remove_file(dev, hrm_attributes + i);
}
/**
This function is used for removing sysfs attribute for sample
@param dev linux device structure
@return void
*/
static void
remove_sysfs_interfaces_hrmled(struct device *dev)
{
int i;
for (i = 0; i < ARRAY_SIZE(hrmled_attributes); i++)
device_remove_file(dev, hrmled_attributes + i);
}
/**
This function is used for creating sysfs attribute
@param dev linux device structure
@return int status of attribute creation
*/
static int
create_sysfs_interfaces(struct device *dev)
{
return 0;
}
/**
This function is used for removing sysfs attribute
@param dev linux device structure
@return void
*/
static void
remove_sysfs_interfaces(struct device *dev)
{
}
/**
This function is used for registering input event for Sample
@param pst_adpd pointer point ADPD143 data structure
@return s32 status of this function
*/
static s32
adpd143_input_init_sample(struct adpd143_data *pst_adpd)
{
int err;
/* for hrm sensor */
pst_adpd->hrm_input_dev = input_allocate_device();
if (!pst_adpd->hrm_input_dev) {
err = -ENOMEM;
dev_err(&pst_adpd->client->dev,
"hrm input dev allocation fail\n");
goto err_hrm_allocate;
}
pst_adpd->hrm_input_dev->name = MODULE_NAME_HRM;
input_set_drvdata(pst_adpd->hrm_input_dev, pst_adpd);
__set_bit(EV_MSC, pst_adpd->hrm_input_dev->evbit);
__set_bit(EV_REL, pst_adpd->hrm_input_dev->evbit);
__set_bit(MSC_RAW, pst_adpd->hrm_input_dev->mscbit);
__set_bit(REL_X, pst_adpd->hrm_input_dev->relbit);
__set_bit(REL_Y, pst_adpd->hrm_input_dev->relbit);
__set_bit(REL_Z, pst_adpd->hrm_input_dev->relbit);
__set_bit(REL_MISC, pst_adpd->hrm_input_dev->relbit);
err = input_register_device(pst_adpd->hrm_input_dev);
if (err) {
dev_err(&pst_adpd->client->dev,
"unable to register input dev %s\n",
pst_adpd->hrm_input_dev->name);
goto err_hrm_register_failed;
}
err = sensors_create_symlink(pst_adpd->hrm_input_dev);
if (err < 0) {
pr_err("%s: create_symlink error\n", __func__);
goto err_hrm_register_failed;
}
/* for hrmled sensor */
pst_adpd->hrmled_input_dev = input_allocate_device();
if (!pst_adpd->hrmled_input_dev) {
err = -ENOMEM;
dev_err(&pst_adpd->client->dev,
"hrmled input dev allocation fail\n");
goto err_hrmled_allocate;
}
pst_adpd->hrmled_input_dev->name = MODULE_NAME_HRMLED;
input_set_drvdata(pst_adpd->hrmled_input_dev, pst_adpd);
__set_bit(EV_MSC, pst_adpd->hrmled_input_dev->evbit);
__set_bit(EV_REL, pst_adpd->hrmled_input_dev->evbit);
__set_bit(MSC_RAW, pst_adpd->hrmled_input_dev->mscbit);
__set_bit(REL_X, pst_adpd->hrmled_input_dev->relbit);
__set_bit(REL_Y, pst_adpd->hrmled_input_dev->relbit);
__set_bit(REL_Z, pst_adpd->hrmled_input_dev->relbit);
__set_bit(REL_MISC, pst_adpd->hrmled_input_dev->relbit);
err = input_register_device(pst_adpd->hrmled_input_dev);
if (err) {
dev_err(&pst_adpd->client->dev,
"unable to register input dev %s\n",
pst_adpd->hrmled_input_dev->name);
goto err_hrmled_register_failed;
}
err = sensors_create_symlink(pst_adpd->hrmled_input_dev);
if (err < 0) {
pr_err("%s: create_symlink error\n", __func__);
goto err_hrmled_register_failed;
}
return 0;
err_hrmled_register_failed:
input_free_device(pst_adpd->hrmled_input_dev);
err_hrmled_allocate:
err_hrm_register_failed:
input_free_device(pst_adpd->hrm_input_dev);
err_hrm_allocate:
return err;
}
/**
This function is used for unregistering input event for Sample
@param pst_adpd pointer point ADPD143 data structure
@return void
*/
static void
adpd143_input_cleanup_sample(struct adpd143_data *pst_adpd)
{
input_set_drvdata(pst_adpd->hrm_input_dev, NULL);
input_unregister_device(pst_adpd->hrm_input_dev);
input_free_device(pst_adpd->hrm_input_dev);
input_set_drvdata(pst_adpd->hrmled_input_dev, NULL);
input_unregister_device(pst_adpd->hrmled_input_dev);
input_free_device(pst_adpd->hrmled_input_dev);
}
/**
This function is used for registering input event for ADPD143
@param pst_adpd pointer point ADPD143 data structure
@return s32 status of the function
*/
static s32
adpd143_input_init(struct adpd143_data *pst_adpd)
{
return adpd143_input_init_sample(pst_adpd);
}
/**
This function is used for unregistering input event done for ADPD143
@param pst_adpd pointer point ADPD143 data structure
@return void
*/
static void
adpd143_input_cleanup(struct adpd143_data *pst_adpd)
{
adpd143_input_cleanup_sample(pst_adpd);
}
/**
This function is used for registering sysfs attribute for ADPD143
@param pst_adpd pointer point ADPD143 data structure
@return s32 status of the called function
*/
static s32
adpd143_sysfs_init(struct adpd143_data *pst_adpd)
{
if (create_sysfs_interfaces(&pst_adpd->client->dev))
goto err_sysfs_create_gen;
if (create_sysfs_interfaces_hrm(&pst_adpd->hrm_input_dev->dev))
goto err_sysfs_create_sample;
if (create_sysfs_interfaces_hrmled(&pst_adpd->hrmled_input_dev->dev))
goto err_sysfs_create_sample;
return 0;
err_sysfs_create_sample:
remove_sysfs_interfaces(&pst_adpd->client->dev);
err_sysfs_create_gen:
return -1;
}
/**
This function is used for unregistering sysfs attribute for ADPD143
@param pst_adpd pointer point ADPD143 data structure
@return void
*/
static void
adpd143_sysfs_cleanup(struct adpd143_data *pst_adpd)
{
remove_sysfs_interfaces(&pst_adpd->client->dev);
remove_sysfs_interfaces_hrm(&pst_adpd->hrm_input_dev->dev);
remove_sysfs_interfaces_hrmled(&pst_adpd->hrmled_input_dev->dev);
}
/**
This function is used for assigning initial assignment value to
ADPD143 data structure
@param pst_adpd pointer point ADPD143 data structure
@return void
*/
static void
adpd143_struct_assign(struct adpd143_data *pst_adpd)
{
pst_adpd->ptr_data = data_buffer;
}
/**
This function is used for initializing ADPD143
@param pst_adpd pointer point ADPD143 data structure
@param id pointer point i2c device id
@return s32 status of the called function
*/
static s32
adpd143_initialization(struct adpd143_data *pst_adpd,
const struct i2c_device_id *id)
{
int err = 0;
if (adpd143_input_init(pst_adpd)) {
err = -1;
pr_err("%s: err line %d\n", __func__, __LINE__);
goto err_input_init;
}
if (adpd143_sysfs_init(pst_adpd)) {
pr_err("%s: err line %d\n", __func__, __LINE__);
err = -1;
goto err_sysfs_init;
}
adpd143_struct_assign(pst_adpd);
memset(&pst_adpd->stats, 0, sizeof(pst_adpd->stats));
adpd_stat_reset(pst_adpd);
INIT_WORK(&pst_adpd->work, adpd143_wq_handler);
pst_adpd->ptr_adpd143_wq_st =
create_workqueue("adpd143_wq");
if (!pst_adpd->ptr_adpd143_wq_st) {
err = -ENOMEM;
pr_err("%s %d\n", __func__, __LINE__);
goto err_wq_creation_init;
}
if (!pst_adpd->client->irq) {
pr_err("%s %d\n", __func__, __LINE__);
goto err_work_queue_init;
}
pst_adpd->hrm_int = pst_adpd->client->irq;
pst_adpd->irq = pst_adpd->hrm_int;
irq_set_irq_type(pst_adpd->irq, IRQ_TYPE_EDGE_FALLING);
err = request_irq(pst_adpd->irq, adpd143_isr_handler,
IRQF_TRIGGER_FALLING, dev_name(&pst_adpd->client->dev),
pst_adpd);
if (err) {
ADPD143_dbg("irq %d busy?\n", pst_adpd->irq);
goto err_work_queue_init;
}
disable_irq_nosync(pst_adpd->irq);
pst_adpd->ptr_config = kzalloc(sizeof(struct adpd_platform_data),
GFP_KERNEL);
if (pst_adpd->ptr_config == NULL) {
err = -ENOMEM;
pr_err("%s %d\n", __func__, __LINE__);
goto err_work_queue_init;
}
enable_irq(pst_adpd->irq);
adpd143_configuration(pst_adpd, 1);
adpd143_mode_switching(pst_adpd, 0); /* turn off : idle mode, temp*/
pst_adpd->osc_trim_open_enable = 1;
pst_adpd->pre_hrmled_enable = 0;
pst_adpd->sample_cnt = 0;
return 0;
//err_gpio_direction_input:
//gpio_free(pst_adpd->hrm_int);
err_work_queue_init:
destroy_workqueue(pst_adpd->ptr_adpd143_wq_st);
err_wq_creation_init:
err_sysfs_init:
adpd143_input_cleanup(pst_adpd);
err_input_init:
return err;
}
/**
This function is used for cleanup ADPD143
@param pst_adpd pointer point ADPD143 data structure
@return void
*/
static void
adpd143_initialization_cleanup(struct adpd143_data *pst_adpd)
{
adpd143_mode_switching(pst_adpd, 0);
free_irq(pst_adpd->irq, pst_adpd);
destroy_workqueue(pst_adpd->ptr_adpd143_wq_st);
adpd143_sysfs_cleanup(pst_adpd);
adpd143_input_cleanup(pst_adpd);
kobject_uevent(&pst_adpd->client->dev.kobj, KOBJ_OFFLINE);
}
#ifdef CONFIG_PM
static s32
adpd143_i2c_suspend(struct device *dev)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned short parse_data[2];
unsigned short mode = 0;
pr_info("%s \n", __func__);
adpd143_pin_control(pst_adpd, false);
memset(parse_data, 0, sizeof(parse_data));
if (atomic_read(&pst_adpd->hrmled_enabled) ||
atomic_read(&pst_adpd->hrm_enabled)) {
cmd_parsing("0x0", 1, parse_data);
mode = GET_USR_MODE(parse_data[0]);
if (GET_USR_MODE(parse_data[0]) < MAX_MODE) {
if ((GET_USR_SUB_MODE(parse_data[0])) <
__mode_recv_frm_usr[mode].size) {
adpd143_mode_switching(pst_adpd, parse_data[0]);
} else {
ADPD143_dbg("Sub mode Out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
} else {
ADPD143_dbg("Mode out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
}
return 0;
}
static s32
adpd143_i2c_resume(struct device *dev)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned short parse_data[2];
unsigned short mode = 0;
pr_info("%s \n", __func__);
adpd143_pin_control(pst_adpd, true);
memset(parse_data, 0, sizeof(parse_data));
if (atomic_read(&pst_adpd->hrm_enabled)) {
switch (atomic_read(&pst_adpd->hrm_enabled)) {
case HRM_SAMPLE_MODE:
cmd_parsing("0x31", 1, parse_data);
break;
case HRM_TIA_ADC_MODE:
cmd_parsing("0x51", 1, parse_data);
break;
default:
pr_err("%s: invalid value\n", __func__);
return -EINVAL;
}
goto mode_switching;
}
if (atomic_read(&pst_adpd->hrmled_enabled)) {
switch (atomic_read(&pst_adpd->hrmled_enabled)) {
case IR_MODE:
pr_info("%s: IR_MODE.\n", __func__);
cmd_parsing("0x32", 1, parse_data);
break;
case RED_MODE:
pr_info("%s: RED_MODE.\n", __func__);
cmd_parsing("0x30", 1, parse_data);
break;
case IRRED_MODE:
pr_info("%s: IRRED_MODE.\n", __func__);
cmd_parsing("0x31", 1, parse_data);
break;
default:
pr_err("%s: invalid value\n", __func__);
return -EINVAL;
}
goto mode_switching;
}
ADPD143_dbg("No active hrm sensor\n");
return 0;
mode_switching:
mode = GET_USR_MODE(parse_data[0]);
if (GET_USR_MODE(parse_data[0]) < MAX_MODE) {
if ((GET_USR_SUB_MODE(parse_data[0])) <
__mode_recv_frm_usr[mode].size) {
adpd143_mode_switching(pst_adpd, parse_data[0]);
} else {
ADPD143_dbg("Sub mode Out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
} else {
ADPD143_dbg("Mode out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
return 0;
}
#else
#define adpd143_i2c_resume NULL
#define adpd143_i2c_suspend NULL
#endif /* CONFIG_PM */
/**
This function is used for i2c read communication between ADPD143 and AP
@param pst_adpd pointer point ADPD143 data structure
@param reg_addr address need to be fetch
@param len number byte to be read
@param buf pointer point the read out data.
@return s32 status of the called function
*/
static int
adpd143_i2c_read(struct adpd143_data *pst_adpd, u8 reg_addr, int len,
u16 *buf)
{
int err;
int tries = 0;
int icnt = 0;
struct i2c_msg msgs[] = {
{
.addr = pst_adpd->client->addr,
.flags = pst_adpd->client->flags & I2C_M_TEN,
.len = 1,
.buf = (s8 *)&reg_addr,
},
{
.addr = pst_adpd->client->addr,
.flags = (pst_adpd->client->flags & I2C_M_TEN) |
I2C_M_RD,
.len = len * sizeof(unsigned short),
.buf = (s8 *)buf,
},
};
do {
err = i2c_transfer(pst_adpd->client->adapter, msgs, 2);
if (err != 2)
msleep_interruptible(I2C_RETRY_DELAY);
} while ((err != 2) && (++tries < I2C_RETRIES));
if (err != 2) {
dev_err(&pst_adpd->client->dev, "read transfer error\n");
err = -EIO;
} else {
err = 0;
}
for (icnt = 0; icnt < len; icnt++) {
/*convert big endian to CPU format*/
buf[icnt] = be16_to_cpu(buf[icnt]);
}
return err;
}
/**
This function is used for i2c write communication between ADPD143 and AP
@param pst_adpd pointer point ADPD143 data structure
@param reg_addr address need to be fetch
@param len number byte to be read
@param data value to be written on the register.
@return s32 status of the called function
*/
static int
adpd143_i2c_write(struct adpd143_data *pst_adpd, u8 reg_addr, int len,
u16 data)
{
struct i2c_msg msgs[1];
int err;
int tries = 0;
unsigned short data_to_write = cpu_to_be16(data);
char buf[4];
buf[0] = (s8) reg_addr;
memcpy(buf + 1, &data_to_write, sizeof(unsigned short));
msgs[0].addr = pst_adpd->client->addr;
msgs[0].flags = pst_adpd->client->flags & I2C_M_TEN;
msgs[0].len = 1 + (1 * sizeof(unsigned short));
msgs[0].buf = buf;
do {
err = i2c_transfer(pst_adpd->client->adapter, msgs, 1);
if (err != 1)
msleep_interruptible(I2C_RETRY_DELAY);
} while ((err != 1) && (++tries < I2C_RETRIES));
if (err != 1) {
dev_err(&pst_adpd->client->dev, "write transfer error\n");
err = -EIO;
} else {
err = 0;
}
return err;
}
/* set sysfs for hrm sensor */
static ssize_t adpd143_name_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
pr_info("%s: %s \n", __func__, CHIP_NAME);
return snprintf(buf, PAGE_SIZE, "%s\n", CHIP_NAME);
}
static ssize_t adpd143_vendor_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
pr_info("%s: %s \n", __func__, VENDOR);
return snprintf(buf, PAGE_SIZE, "%s\n", VENDOR);
}
static ssize_t eol_test_result_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size);
static ssize_t eol_test_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
if (sysfs_streq(buf, "1")) /* eol_test start */
pst_adpd->eol_test_is_enable = 1;
else if (sysfs_streq(buf, "0")) /* eol_test stop */
pst_adpd->eol_test_is_enable = 0;
else {
pr_debug("%s: invalid value %d\n", __func__, *buf);
return -EINVAL;
}
pst_adpd->eol_test_status = 0;
pr_info("%s: (%c), value(%u) \n",
__func__, *buf, pst_adpd->eol_test_is_enable);
return size;
}
static ssize_t eol_test_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
return snprintf(buf, PAGE_SIZE, "%u\n", pst_adpd->eol_test_is_enable);
}
static ssize_t eol_test_result_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
int err;
unsigned int buf_len;
buf_len = strlen(buf) + 1;
if (buf_len > MAX_EOL_RESULT)
buf_len = MAX_EOL_RESULT;
mutex_lock(&pst_adpd->storelock);
if (pst_adpd->eol_test_result != NULL)
kfree(pst_adpd->eol_test_result);
pst_adpd->eol_test_result = kzalloc(sizeof(char) * buf_len, GFP_KERNEL);
if (pst_adpd->eol_test_result == NULL) {
pr_err("%s: couldn't allocate memory\n", __func__);
mutex_unlock(&pst_adpd->storelock);
return -ENOMEM;
}
strncpy(pst_adpd->eol_test_result, buf, buf_len);
mutex_unlock(&pst_adpd->storelock);
pr_info("%s: result = %s, buf_len(%u)\n",
__func__, pst_adpd->eol_test_result, buf_len);
pst_adpd->eol_test_status = 1;
err = osc_trim_efs_register_save(pst_adpd);
if (err < 0) {
pr_err("%s: osc_trim_efs_register_save() empty(%d)\n",
__func__, err);
}
return size;
}
static ssize_t eol_test_result_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
if (pst_adpd->eol_test_result == NULL) {
pr_info("%s: data->eol_test_result is NULL\n",
__func__);
pst_adpd->eol_test_status = 0;
return snprintf(buf, PAGE_SIZE, "%s\n", "NO_EOL_TEST");
}
pr_info("%s: result = %s\n",
__func__, pst_adpd->eol_test_result);
pst_adpd->eol_test_status = 0;
return snprintf(buf, PAGE_SIZE, "%s\n", pst_adpd->eol_test_result);
}
static ssize_t eol_test_status_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
return snprintf(buf, PAGE_SIZE, "%u\n", pst_adpd->eol_test_status);
}
static ssize_t adpd143_eol_lib_ver_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned int buf_len;
buf_len = strlen(buf) + 1;
if (buf_len > MAX_LIB_VER)
buf_len = MAX_LIB_VER;
mutex_lock(&pst_adpd->storelock);
if (pst_adpd->eol_lib_ver != NULL)
kfree(pst_adpd->eol_lib_ver);
pst_adpd->eol_lib_ver = kzalloc(sizeof(char) * buf_len, GFP_KERNEL);
if (pst_adpd->eol_lib_ver == NULL) {
pr_err("%s: couldn't allocate memory\n", __func__);
mutex_unlock(&pst_adpd->storelock);
return -ENOMEM;
}
strncpy(pst_adpd->eol_lib_ver, buf, buf_len);
mutex_unlock(&pst_adpd->storelock);
pr_info("%s: eol_lib_ver = %s\n", __func__, pst_adpd->eol_lib_ver);
return size;
}
static ssize_t adpd143_eol_lib_ver_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
if (pst_adpd->eol_lib_ver == NULL) {
pr_info("%s: data->eol_lib_ver is NULL\n", __func__);
return snprintf(buf, PAGE_SIZE, "%s\n", "NULL");
}
pr_info("%s: eol_lib_ver = %s\n", __func__, pst_adpd->eol_lib_ver);
return snprintf(buf, PAGE_SIZE, "%s\n", pst_adpd->eol_lib_ver);
}
static ssize_t adpd143_elf_lib_ver_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
unsigned int buf_len;
buf_len = strlen(buf) + 1;
if (buf_len > MAX_LIB_VER)
buf_len = MAX_LIB_VER;
mutex_lock(&pst_adpd->storelock);
if (pst_adpd->elf_lib_ver != NULL)
kfree(pst_adpd->elf_lib_ver);
pst_adpd->elf_lib_ver = kzalloc(sizeof(char) * buf_len, GFP_KERNEL);
if (pst_adpd->elf_lib_ver == NULL) {
pr_err("%s: couldn't allocate memory\n", __func__);
mutex_unlock(&pst_adpd->storelock);
return -ENOMEM;
}
strncpy(pst_adpd->elf_lib_ver, buf, buf_len);
mutex_unlock(&pst_adpd->storelock);
return size;
}
static ssize_t adpd143_elf_lib_ver_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
if (pst_adpd->elf_lib_ver == NULL) {
pr_info("%s: data->elf_lib_ver is NULL\n", __func__);
return snprintf(buf, PAGE_SIZE, "%s\n", "NULL");
}
pr_info("%s: elf_lib_ver = %s\n", __func__, pst_adpd->elf_lib_ver);
return snprintf(buf, PAGE_SIZE, "%s\n", pst_adpd->elf_lib_ver);
}
static ssize_t adpd143_hrm_flush_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
int ret = 0;
u8 handle = 0;
ret = kstrtou8(buf, 10, &handle);
if (ret < 0) {
pr_err("%s: kstrtou8 failed.(%d)\n", __func__, ret);
return ret;
}
pr_info("%s: handle = %d\n", __func__, handle);
input_report_rel(pst_adpd->hrm_input_dev, REL_MISC, handle);
return size;
}
static ssize_t adpd143_alc_enable_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
u8 val;
unsigned short mode = 0;
unsigned short parse_data[2];
int rc = 0;
rc = kstrtou8(buf, 10, &val);
pr_info("%s: enable Ambient Light Measurement val:%d.\n",
__func__, val);
if (val >= ALC_TIA_MODE && val <= ALC_FLOAT_MODE) {
if (pst_adpd->led_en != -1)
gpio_set_value(pst_adpd->led_en, 1);
else if (!IS_ERR(pst_adpd->leda))
rc = regulator_enable(pst_adpd->leda);
if (rc) {
pr_info(KERN_ERR "%s: enable ALC fail(%d)\n",
__func__, rc);
}
switch(val) {
case ALC_TIA_MODE:
pr_info("%s: mode:%d\n", __func__, ALC_TIA_MODE);
cmd_parsing("0x50", 1, parse_data);
break;
case ALC_TNF_MODE:
pr_info("%s: mode:%d\n", __func__, ALC_TNF_MODE);
cmd_parsing("0x51", 1, parse_data);
break;
case ALC_FLOAT_MODE:
pr_info("%s: mode:%d\n", __func__, ALC_FLOAT_MODE);
cmd_parsing("0x52", 1, parse_data);
break;
default:
pr_info("%s: invalid mode\n", __func__);
cmd_parsing("0x0", 1, parse_data);
break;
}
atomic_set(&pst_adpd->hrm_enabled, 0);
} else {
pr_info("%s: disable.\n", __func__);
if (pst_adpd->led_en != -1)
gpio_set_value(pst_adpd->led_en, 0);
else if (!IS_ERR(pst_adpd->leda))
rc = regulator_disable(pst_adpd->leda);
if (rc) {
pr_info(KERN_ERR "%s: disable failed (%d)\n",
__func__, rc);
}
cmd_parsing("0x0", 1, parse_data);
atomic_set(&pst_adpd->hrm_enabled, 0);
}
mode = GET_USR_MODE(parse_data[0]);
if (GET_USR_MODE(parse_data[0]) < MAX_MODE) {
if ((GET_USR_SUB_MODE(parse_data[0])) <
__mode_recv_frm_usr[mode].size) {
adpd143_mode_switching(pst_adpd, parse_data[0]);
} else {
ADPD143_dbg("Sub mode Out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
} else {
ADPD143_dbg("Mode out of bound\n");
adpd143_mode_switching(pst_adpd, 0);
}
return size;
}
static ssize_t adpd143_alc_enable_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
if (pst_adpd->elf_lib_ver == NULL) {
pr_info("%s: data->elf_lib_ver is NULL\n", __func__);
return snprintf(buf, PAGE_SIZE, "%s\n", "NULL");
}
pr_info("%s: elf_lib_ver = %s\n", __func__, pst_adpd->elf_lib_ver);
return snprintf(buf, PAGE_SIZE, "%s\n", pst_adpd->elf_lib_ver);
}
static DEVICE_ATTR(name, S_IRUGO, adpd143_name_show, NULL);
static DEVICE_ATTR(vendor, S_IRUGO, adpd143_vendor_show, NULL);
static DEVICE_ATTR(eol_test, S_IRUGO | S_IWUSR | S_IWGRP,
eol_test_show, eol_test_store);
static DEVICE_ATTR(eol_test_result, S_IRUGO | S_IWUSR | S_IWGRP,
eol_test_result_show, eol_test_result_store);
static DEVICE_ATTR(eol_test_status, S_IRUGO, eol_test_status_show, NULL);
static DEVICE_ATTR(eol_lib_ver, S_IRUGO | S_IWUSR | S_IWGRP,
adpd143_eol_lib_ver_show, adpd143_eol_lib_ver_store);
static DEVICE_ATTR(elf_lib_ver, S_IRUGO | S_IWUSR | S_IWGRP,
adpd143_elf_lib_ver_show, adpd143_elf_lib_ver_store);
static DEVICE_ATTR(adpd_mode, S_IRUGO | S_IWUSR | S_IWGRP,
attr_get_mode, attr_set_mode);
static DEVICE_ATTR(adpd_reg_read, S_IRUGO | S_IWUSR | S_IWGRP,
attr_reg_read_get, attr_reg_read_set);
static DEVICE_ATTR(adpd_reg_write, S_IRUGO | S_IWUSR | S_IWGRP,
NULL, attr_reg_write_set);
static DEVICE_ATTR(adpd_configuration, S_IRUGO | S_IWUSR | S_IWGRP,
attr_config_get, attr_config_set);
static DEVICE_ATTR(adpd_stat, S_IRUGO | S_IWUSR | S_IWGRP,
attr_stat_get, attr_stat_set);
static DEVICE_ATTR(hrm_flush, S_IWUSR | S_IWGRP,
NULL, adpd143_hrm_flush_store);
static DEVICE_ATTR(alc_enable, S_IRUGO | S_IWUSR | S_IWGRP,
adpd143_alc_enable_show, adpd143_alc_enable_store);
static struct device_attribute *hrm_sensor_attrs[] = {
&dev_attr_name,
&dev_attr_vendor,
&dev_attr_eol_test,
&dev_attr_eol_test_result,
&dev_attr_eol_test_status,
&dev_attr_eol_lib_ver,
&dev_attr_elf_lib_ver,
&dev_attr_adpd_mode,
&dev_attr_adpd_reg_read,
&dev_attr_adpd_reg_write,
&dev_attr_adpd_configuration,
&dev_attr_adpd_stat,
&dev_attr_hrm_flush,
&dev_attr_alc_enable,
NULL,
};
static ssize_t adpd143_hrmled_name_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
return snprintf(buf, PAGE_SIZE, "%s\n", CHIP_NAME);
}
static ssize_t adpd143_hrmled_vendor_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
return snprintf(buf, PAGE_SIZE, "%s\n", VENDOR);
}
static ssize_t adpd143_hrmled_flush_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size)
{
struct adpd143_data *pst_adpd = dev_get_drvdata(dev);
int ret = 0;
u8 handle = 0;
ret = kstrtou8(buf, 10, &handle);
if (ret < 0) {
pr_err("%s: kstrtou8 failed.(%d)\n", __func__, ret);
return ret;
}
pr_info("%s: handle = %d\n", __func__, handle);
input_report_rel(pst_adpd->hrmled_input_dev, REL_MISC, handle);
return size;
}
static struct device_attribute dev_attr_hrmled_name =
__ATTR(name, S_IRUGO, adpd143_hrmled_name_show, NULL);
static struct device_attribute dev_attr_hrmled_vendor =
__ATTR(vendor, S_IRUGO, adpd143_hrmled_vendor_show, NULL);
static DEVICE_ATTR(hrmled_flush, S_IWUSR | S_IWGRP,
NULL, adpd143_hrmled_flush_store);
static struct device_attribute *hrmled_sensor_attrs[] = {
&dev_attr_hrmled_name,
&dev_attr_hrmled_vendor,
&dev_attr_hrmled_flush,
NULL,
};
/**
This function is used for ADPD143 probe function
@param client pointer point to the linux i2c client structure
@param id pointer point to the linux i2c device id
@return s32 status of the probe function
*/
static s32
adpd_i2c_probe(struct i2c_client *client, const struct i2c_device_id *id)
{
struct adpd143_data *pst_adpd = NULL;
struct adpd_platform_data *pdata = NULL;
int err = 0, i = 0;
unsigned short u16_regval = 0;
struct regulator *regulator_i2c_1p8;
pr_err("%s: is called Success\n", __func__);
if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
dev_err(&client->dev, "client not i2c capable\n");
err = -ENODEV;
pr_err("[SENSOR] %s: exit_check_functionality.\n", __func__);
goto exit_check_functionality_failed;
}
pst_adpd = kzalloc(sizeof(struct adpd143_data), GFP_KERNEL);
if (pst_adpd == NULL) {
err = -ENOMEM;
pr_err("[SENSOR] %s: exit_mem_allocate.\n", __func__);
goto exit_mem_allocate_failed;
}
if (client->dev.of_node) {
pdata = devm_kzalloc (&client->dev ,
sizeof(struct adpd_platform_data), GFP_KERNEL);
if (!pdata) {
dev_err(&client->dev, "Failed to allocate memory\n");
if (pst_adpd)
kfree(pst_adpd);
return -ENOMEM;
}
} else
pdata = client->dev.platform_data;
if (!pdata) {
pr_err("%s: missing pdata!\n", __func__);
if (pst_adpd)
kfree(pst_adpd);
return err;
}
err = adpd_parse_dt(pst_adpd, &client->dev);
if (err) {
pr_err("%s: parse dt fail\n", __func__);
goto adpd_parse_dt_err;
}
if (pst_adpd->i2c_1p8 != NULL) {
regulator_i2c_1p8 = regulator_get(NULL, pst_adpd->i2c_1p8);
if (IS_ERR(regulator_i2c_1p8) || regulator_i2c_1p8 == NULL) {
pr_err("%s - i2c_1p8 regulator_get fail\n", __func__);
goto err_regulator_enable;
}
if (!regulator_is_enabled(regulator_i2c_1p8)) {
err = regulator_enable(regulator_i2c_1p8);
if (err) {
pr_err("enable i2c_1p8 failed, err=%d\n", err);
goto err_regulator_enable;
}
}
}
adpd_power_enable(pst_adpd, 1);
err = adpd_power_enable(pst_adpd, 1);
if (err < 0)
pr_err("%s: adpd_power_enable fail err = %d\n", __func__, err);
msleep(100);
mutex_init(&pst_adpd->mutex);
mutex_init(&pst_adpd->storelock);
pst_adpd->client = client;
pst_adpd->ptr_config = pdata;
pst_adpd->read = adpd143_i2c_read;
pst_adpd->write = adpd143_i2c_write;
/*Need to allocate and assign data then use the below function */
i2c_set_clientdata(client, (struct adpd143_data *)pst_adpd);
/*chip ID verification */
u16_regval = reg_read(pst_adpd, ADPD_CHIPID_ADDR);
switch (u16_regval) {
case ADPD_CHIPID(3):
case ADPD_CHIPID(4):
for(i=0; i<8; i++) rawDarkCh[i] = rawDataCh[i] = 0;
err = 0;
ADPD143_dbg("chipID value = 0x%x\n", u16_regval);
break;
default:
err = 1;
break;
};
if (err) {
ADPD143_dbg("chipID value = 0x%x\n", u16_regval);
pr_err("[SENSOR] %s: exit_chipid_verification.\n", __func__);
goto exit_chipid_verification;
}
ADPD143_info("chipID value = 0x%x\n", u16_regval);
//pst_adpd->dev = &client->dev;
pr_info("%s: start \n", __func__);
if (adpd143_initialization(pst_adpd, id)) {
pr_err("[SENSOR] %s: exit_adpd143_init_exit.\n", __func__);
goto exit_adpd143_init;
}
/* set sysfs for hrm sensor */
err = sensors_register(&pst_adpd->dev, pst_adpd, hrm_sensor_attrs,
"hrm_sensor");
if (err) {
pr_err("[SENSOR] %s: cound not register hrm_sensor(%d).\n",
__func__, err);
goto hrm_sensor_register_failed;
}
/* set sysfs for hrm sensor */
err = sensors_register(&pst_adpd->dev, pst_adpd, hrmled_sensor_attrs,
"hrmled_sensor");
if (err) {
pr_err("[SENSOR] %s: cound not register hrmled_sensor(%d).\n",
__func__, err);
goto hrmled_sensor_register_failed;
}
pr_info("%s: success\n", __func__);
goto done;
hrmled_sensor_register_failed:
sensors_unregister(pst_adpd->dev, hrm_sensor_attrs);
hrm_sensor_register_failed:
exit_adpd143_init:
exit_chipid_verification:
mutex_destroy(&pst_adpd->mutex);
adpd_power_enable(pst_adpd, 0);
err_regulator_enable:
adpd_parse_dt_err:
exit_mem_allocate_failed:
kfree(pst_adpd);
exit_check_functionality_failed:
dev_err(&client->dev, "%s: Driver Init failed\n", ADPD_DEV_NAME);
pr_err("%s: failed\n", __func__);
done:
return err;
}
/**
This function is used for ADPD143 remove function
@param client pointer point to the linux i2c client structure
@return s32 status of the remove function
*/
static s32
adpd_i2c_remove(struct i2c_client *client)
{
struct adpd143_data *pst_adpd = i2c_get_clientdata(client);
ADPD143_dbg("%s\n", __func__);
adpd143_initialization_cleanup(pst_adpd);
gpio_free(pst_adpd->hrm_int);
kfree(pst_adpd->ptr_config);
kfree(pst_adpd);
pst_adpd = NULL;
i2c_set_clientdata(client, NULL);
return 0;
}
#ifdef CONFIG_PM
/**
device power management operation structure
*/
static const struct dev_pm_ops adpd_pm_ops = {
.resume = adpd143_i2c_resume,
.suspend = adpd143_i2c_suspend,
};
#endif
/**
This table tell which framework it supported
@brief the name has to get matched to the board configuration file setup
*/
/*static struct i2c_device_id adpd_id[] = { {ADPD_DEV_NAME, 0}, {} };
MODULE_DEVICE_TABLE(i2c, adpd_id);*/
static struct of_device_id adpd_match_table[] = {
{ .compatible = "adpd143",},
{},
};
MODULE_DEVICE_TABLE(i2c, adpd_match_table);
static const struct i2c_device_id adpd143_device_id[] = {
{ "adpd143", 0 },
{ }
};
/**
i2c operation structure
*/
struct i2c_driver adpd143_i2c_driver = {
.driver = {
.name = ADPD_DEV_NAME,
.owner = THIS_MODULE,
#ifdef CONFIG_PM
.pm = &adpd_pm_ops,
#endif
.of_match_table = adpd_match_table,
},
.probe = adpd_i2c_probe,
.remove = adpd_i2c_remove,
.id_table = adpd143_device_id,
};
static struct i2c_client *i2c_client;
#ifdef ADPD_AUTO_PROBE
static int
i2c_check_dev_attach(char *slave_name, unsigned short *slave_addrs,
unsigned short cnt)
{
struct i2c_board_info info;
struct i2c_adapter *i2c_adapter = NULL;
int ret = 0;
unsigned short *scan_device = NULL;
unsigned short count = 0;
/*need to check whether we need to free the memory */
scan_device = kzalloc(sizeof(unsigned short) * (cnt + 2), GFP_KERNEL);
if (IS_ERR(scan_device)) {
ret = -ENOMEM; /* out of memory */
goto i2c_check_attach_mem_fail;
}
memset(scan_device, '\0', sizeof(unsigned short) * (cnt + 2));
for (count = 0; count < cnt; count++) {
*(scan_device + count) = *(slave_addrs + count);
ADPD143_info("list of slave addr = 0x%x\n",
*(scan_device + count));
}
*(scan_device + count) = I2C_CLIENT_END;
count = 0;
do {
i2c_adapter = i2c_get_adapter(count);
if (i2c_adapter != NULL) {
memset(&info, 0, sizeof(struct i2c_board_info));
strlcpy(info.type, slave_name /*"adpd143" */ ,
I2C_NAME_SIZE);
/*need to check i2c_new_device instead of
i2c_new_probed_device*/
i2c_client =
i2c_new_probed_device(i2c_adapter, &info,
(const unsigned short *)
scan_device, NULL);
if (i2c_client != NULL) {
ADPD143_dbg("I2C busnum - %d\n", count);
ADPD143_dbg(
"device is attached to the bus i2c-%d\n",
count);
} else {
}
i2c_put_adapter(i2c_adapter);
} else {
ADPD143_info("Not valid adapter\n");
}
count++;
} while (i2c_client == NULL && count < 20);
kfree(scan_device);
if (i2c_client == NULL) {
/*No such device or address */
return -ENXIO;
} else {
return 0;
}
i2c_check_attach_mem_fail:
return ret;
}
#endif
/**
This function is get called when the module is inserted
@return inti status of the adpd143_multisensor_init
*/
static int __init
adpd143_multisensor_init(void)
{
#ifdef ADPD_AUTO_PROBE
ADPD143_dbg("%s\n", __func__);
unsigned short addr[] = { ADPD143_SLAVE_ADDR };
if (!i2c_check_dev_attach(ADPD_DEV_NAME, addr, 1)) {
return i2c_add_driver(&adpd143_i2c_driver);
} else {
pr_err("i2c bus connect error\n");
return -1;
}
#else
ADPD143_dbg("%s\n", __func__);
return i2c_add_driver(&adpd143_i2c_driver);
#endif
}
/**
This function is get called when the module is removed
@return void
*/
static void __exit
adpd143_multisensor_exit(void)
{
ADPD143_dbg("%s\n", __func__);
i2c_del_driver(&adpd143_i2c_driver);
if (i2c_client)
i2c_unregister_device(i2c_client);
}
module_init(adpd143_multisensor_init);
module_exit(adpd143_multisensor_exit);
MODULE_DESCRIPTION();
MODULE_LICENSE("GPL");
MODULE_AUTHOR("");
Reference in New Issue View Git Blame Copy Permalink