goodix_ts_proc.c

#include "goodix_ts_core.h"
#include <linux/fs.h>
#include <linux/proc_fs.h>
#include <linux/seq_file.h>
#include <linux/version.h>

#define CMD_FW_UPDATE "fw_update"
#define CMD_AUTO_TEST "auto_test"
#define CMD_OPEN_TEST "open_test"
#define CMD_SELF_OPEN_TEST "self_open_test"
#define CMD_NOISE_TEST "noise_test"
#define CMD_AUTO_NOISE_TEST "auto_noise_test"
#define CMD_SHORT_TEST "short_test"
#define CMD_GET_PACKAGE_ID "get_package_id"
#define CMD_GET_MCU_ID "get_mcu_id"
#define CMD_GET_VERSION "get_version"
#define CMD_GET_RAWDATA "get_raw"
#define CMD_GET_DIFFDATA "get_diff"
#define CMD_GET_BASEDATA "get_base"
#define CMD_GET_SELF_RAWDATA "get_self_raw"
#define CMD_GET_SELF_DIFFDATA "get_self_diff"
#define CMD_GET_SELF_BASEDATA "get_self_base"
#define CMD_SET_DOUBLE_TAP "set_double_tap"
#define CMD_SET_SINGLE_TAP "set_single_tap"
#define CMD_SET_LONG_PRESS "set_long_press"
#define CMD_SET_ST_PARAM "set_st_param"
#define CMD_SET_LP_PARAM "set_lp_param"
#define CMD_SET_CHARGE_MODE "set_charge_mode"
#define CMD_SET_IRQ_ENABLE "set_irq_enable"
#define CMD_SET_ESD_ENABLE "set_esd_enable"
#define CMD_SET_DEBUG_LOG "set_debug_log"
#define CMD_SET_SCAN_MODE "set_scan_mode"
#define CMD_GET_SCAN_MODE "get_scan_mode"
#define CMD_SET_CONTINUE_MODE "set_continue_mode"
#define CMD_GET_CHANNEL_NUM "get_channel_num"
#define CMD_GET_TX_FREQ "get_tx_freq"
#define CMD_RESET "reset"
#define CMD_SET_SENSE_MODE "set_sense_mode"
#define CMD_GET_CONFIG "get_config"
#define CMD_GET_FW_STATUS "get_fw_status"
#define CMD_SET_HIGHSENSE_MODE "set_highsense_mode"
#define CMD_SET_GRIP_DATA "set_grip_data"
#define CMD_SET_GRIP_MODE "set_grip_mode"
#define CMD_SET_PALM_MODE "set_palm_mode"
#define CMD_SET_NOISE_MODE "set_noise_mode"
#define CMD_SET_WATER_MODE "set_water_mode"
#define CMD_SET_HEATMAP "set_heatmap"
#define CMD_GET_SELF_COMPEN "get_self_compensation"
#define CMD_SET_REPORT_RATE "set_report_rate"
#define CMD_GET_DUMP_LOG "get_dump_log"
#define CMD_GET_STYLUS_DATA "get_stylus_data"
#define CMD_SET_FREQ_INDEX "set_freq_index"
#define CMD_DISABLE_FILTER "disable_filter"

char *cmd_list[] = { CMD_FW_UPDATE, CMD_AUTO_TEST, CMD_OPEN_TEST,
	CMD_SELF_OPEN_TEST, CMD_NOISE_TEST, CMD_AUTO_NOISE_TEST, CMD_SHORT_TEST,
	CMD_GET_PACKAGE_ID, CMD_GET_MCU_ID, CMD_GET_VERSION, CMD_GET_RAWDATA,
	CMD_GET_DIFFDATA, CMD_GET_BASEDATA, CMD_GET_SELF_RAWDATA,
	CMD_GET_SELF_DIFFDATA, CMD_GET_SELF_BASEDATA, CMD_SET_DOUBLE_TAP,
	CMD_SET_SINGLE_TAP, CMD_SET_LONG_PRESS, CMD_SET_ST_PARAM,
	CMD_SET_LP_PARAM, CMD_SET_CHARGE_MODE, CMD_SET_IRQ_ENABLE,
	CMD_SET_ESD_ENABLE, CMD_SET_DEBUG_LOG, CMD_SET_SCAN_MODE,
	CMD_GET_SCAN_MODE, CMD_SET_CONTINUE_MODE, CMD_GET_CHANNEL_NUM,
	CMD_GET_TX_FREQ, CMD_RESET, CMD_SET_SENSE_MODE, CMD_GET_CONFIG,
	CMD_GET_FW_STATUS, CMD_SET_HIGHSENSE_MODE, CMD_SET_GRIP_DATA,
	CMD_SET_GRIP_MODE, CMD_SET_PALM_MODE, CMD_SET_NOISE_MODE,
	CMD_SET_WATER_MODE, CMD_SET_HEATMAP, CMD_GET_SELF_COMPEN,
	CMD_SET_REPORT_RATE, CMD_GET_DUMP_LOG, CMD_GET_STYLUS_DATA,
	CMD_SET_FREQ_INDEX, CMD_DISABLE_FILTER, NULL };

/* test limits keyword */
#define CSV_TP_SPECIAL_RAW_MIN "special_raw_min"
#define CSV_TP_SPECIAL_RAW_MAX "special_raw_max"
#define CSV_TP_SPECIAL_FREQ_RAW_MIN "special_freq_raw_min"
#define CSV_IP_SPECIAL_FREQ_RAW_MAX "special_freq_raw_max"
#define CSV_TP_SPECIAL_RAW_DELTA "special_raw_delta"
#define CSV_TP_SHORT_THRESHOLD "shortciurt_threshold"
#define CSV_TP_SPECIAL_SELFRAW_MAX "special_selfraw_max"
#define CSV_TP_SPECIAL_SELFRAW_MIN "special_selfraw_min"
#define CSV_TP_NOISE_LIMIT "noise_data_limit"
#define CSV_TP_SELFNOISE_LIMIT "noise_selfdata_limit"
#define CSV_TP_TEST_CONFIG "test_config"

#define PALM_FUNC 0
#define NOISE_FUNC 1
#define WATER_FUNC 2
#define GRIP_FUNC 3

#define SHORT_SIZE 150
#define LARGE_SIZE 5 * 1024
#define MAX_FRAME_CNT 50
#define HUGE_SIZE MAX_FRAME_CNT * 20 * 1024
static struct goodix_ts_core *cd;
static char wbuf[SHORT_SIZE];
static char *rbuf;
static uint32_t index;

/* factory test */
#define ABS(x) (((x) >= 0) ? (x) : -(x))
#define MAX(a, b) ((a > b) ? a : b)

#define GTP_CAP_TEST 1
#define GTP_DELTA_TEST 2
#define GTP_NOISE_TEST 3
#define GTP_SHORT_TEST 5
#define GTP_SELFCAP_TEST 6
#define GTP_SELFNOISE_TEST 7
#define MAX_TEST_ITEMS 10 /* 0P-1P-2P-3P-5P total test items */

#define TEST_OK 1
#define TEST_NG 0

#define MAX_LINE_LEN (1024 * 10)
#define MAX_DRV_NUM 52
#define MAX_SEN_NUM 75
#define MAX_SHORT_NUM 15

/* berlin B */
#define MAX_DRV_NUM_BRB 52
#define MAX_SEN_NUM_BRB 75
#define SHORT_TEST_TIME_REG_BRB 0x26AE0
#define DFT_ADC_DUMP_NUM_BRB 762
#define DFT_SHORT_THRESHOLD_BRB 100
#define DFT_DIFFCODE_SHORT_THRESHOLD_BRB 32
#define SHORT_TEST_STATUS_REG_BRB 0x20400
#define SHORT_TEST_RESULT_REG_BRB 0x20410
#define DRV_DRV_SELFCODE_REG_BRB 0x2049A
#define SEN_SEN_SELFCODE_REG_BRB 0x21AF2
#define DRV_SEN_SELFCODE_REG_BRB 0x248A6
#define DIFF_CODE_DATA_REG_BRB 0x269E0

/* berlinD */
#define MAX_DRV_NUM_BRD 20
#define MAX_SEN_NUM_BRD 40
#define SHORT_TEST_TIME_REG_BRD 0x14D7A
#define DFT_ADC_DUMP_NUM_BRD 762
#define DFT_SHORT_THRESHOLD_BRD 100
#define DFT_DIFFCODE_SHORT_THRESHOLD_BRD 32
#define SHORT_TEST_STATUS_REG_BRD 0x13400
#define SHORT_TEST_RESULT_REG_BRD 0x13408
#define DRV_DRV_SELFCODE_REG_BRD 0x1344E
#define SEN_SEN_SELFCODE_REG_BRD 0x137E6
#define DRV_SEN_SELFCODE_REG_BRD 0x14556
#define DIFF_CODE_DATA_REG_BRD 0x14D00

/* nottingham */
#define MAX_DRV_NUM_NOT 17
#define MAX_SEN_NUM_NOT 35
#define SHORT_TEST_TIME_REG_NOT 0x1479E
#define SHORT_TEST_STATUS_REG_NOT 0x13400
#define SHORT_TEST_RESULT_REG_NOT 0x13408
#define DRV_DRV_SELFCODE_REG_NOT 0x13446
#define SEN_SEN_SELFCODE_REG_NOT 0x136EE
#define DRV_SEN_SELFCODE_REG_NOT 0x14152
#define DIFF_CODE_DATA_REG_NOT 0x14734

#define GESTURE_STTW 0
#define GESTURE_LPTW 1
typedef union __attribute__((packed)) {
	struct {
		u8 length;
		u8 type;
		u16 st_min_x;
		u16 st_max_x;
		u16 st_min_y;
		u16 st_max_y;
		u16 st_min_count;
		u16 st_max_count;
		u16 st_motion_tolerance;
		u16 st_max_size;
		u16 checksum;
	};
	u8 buf[20];
} gesture_param_st_t;
static gesture_param_st_t gesture_param_st;

typedef union __attribute__((packed)) {
	struct {
		u8 length;
		u8 type;
		u16 lp_min_x;
		u16 lp_max_x;
		u16 lp_min_y;
		u16 lp_max_y;
		u16 lp_min_count;
		u16 lp_max_size;
		u16 lp_marginal_min_x;
		u16 lp_marginal_max_x;
		u16 lp_marginal_min_y;
		u16 lp_marginal_max_y;
		u8 lp_monitor_chan_min_tx;
		u8 lp_monitor_chan_max_tx;
		u8 lp_monitor_chan_min_rx;
		u8 lp_monitor_chan_max_rx;
		u16 lp_min_node_count;
		u16 lp_motion_tolerance_inner;
		u16 lp_motion_tolerance_outer;
		u16 checksum;
	};
	u8 buf[34];
} gesture_param_lp_t;
static gesture_param_lp_t gesture_param_lp;

typedef struct __attribute__((packed)) {
	u8 result;
	u8 drv_drv_num;
	u8 sen_sen_num;
	u8 drv_sen_num;
	u8 drv_gnd_avdd_num;
	u8 sen_gnd_avdd_num;
	u16 checksum;
} test_result_t;

/* berlin B drv-sen map */
static u8 brl_b_drv_map[] = { 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86,
	87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102, 103,
	104, 105, 106, 107, 108, 109, 110, 111, 112, 113, 114, 115, 116, 117,
	118, 119, 120, 121, 122, 123, 124, 125, 126 };

static u8 brl_b_sen_map[] = { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
	15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32,
	33, 34, 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47, 48, 49, 50,
	51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67, 68,
	69, 70, 71, 72, 73, 74 };

/* berlin D drv-sen map */
static u8 brl_d_drv_map[] = {
	40,
	41,
	42,
	43,
	44,
	45,
	46,
	47,
	48,
	49,
	50,
	51,
	52,
	53,
	54,
	55,
	56,
	57,
	58,
	59,
};

static u8 brl_d_sen_map[] = {
	0,
	1,
	2,
	3,
	4,
	5,
	6,
	7,
	8,
	9,
	10,
	11,
	12,
	13,
	14,
	15,
	16,
	17,
	18,
	19,
	20,
	21,
	22,
	23,
	24,
	25,
	26,
	27,
	28,
	29,
	30,
	31,
	32,
	33,
	34,
	35,
	36,
	37,
	38,
	39,
};

/* nottingham drv-sen map */
static u8 not_drv_map[] = { 35, 36, 37, 38, 39, 40, 41, 42, 43, 44, 45, 46, 47,
	48, 49, 50, 51 };

static u8 not_sen_map[] = { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14,
	15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32,
	33, 34 };

struct ts_short_test_info {
	u32 max_drv_num;
	u32 max_sen_num;
	u8 *drv_map;
	u8 *sen_map;
	u32 short_test_time_reg;
	u32 short_test_status_reg;
	u32 short_test_result_reg;
	u32 drv_drv_selfcode_reg;
	u32 sen_sen_selfcode_reg;
	u32 drv_sen_selfcode_reg;
	u32 diffcode_data_reg;
	u16 short_test_dump_num;
	u16 dft_short_threshold;
	u16 short_diffcode_threshold;
};

static struct ts_short_test_info params_brb = {
	MAX_DRV_NUM_BRB,
	MAX_SEN_NUM_BRB,
	brl_b_drv_map,
	brl_b_sen_map,
	SHORT_TEST_TIME_REG_BRB,
	SHORT_TEST_STATUS_REG_BRB,
	SHORT_TEST_RESULT_REG_BRB,
	DRV_DRV_SELFCODE_REG_BRB,
	SEN_SEN_SELFCODE_REG_BRB,
	DRV_SEN_SELFCODE_REG_BRB,
	DIFF_CODE_DATA_REG_BRB,
	DFT_ADC_DUMP_NUM_BRB,
	DFT_SHORT_THRESHOLD_BRB,
	DFT_DIFFCODE_SHORT_THRESHOLD_BRB,
};

static struct ts_short_test_info params_brd = {
	MAX_DRV_NUM_BRD,
	MAX_SEN_NUM_BRD,
	brl_d_drv_map,
	brl_d_sen_map,
	SHORT_TEST_TIME_REG_BRD,
	SHORT_TEST_STATUS_REG_BRD,
	SHORT_TEST_RESULT_REG_BRD,
	DRV_DRV_SELFCODE_REG_BRD,
	SEN_SEN_SELFCODE_REG_BRD,
	DRV_SEN_SELFCODE_REG_BRD,
	DIFF_CODE_DATA_REG_BRD,
	DFT_ADC_DUMP_NUM_BRD,
	DFT_SHORT_THRESHOLD_BRD,
	DFT_DIFFCODE_SHORT_THRESHOLD_BRD,
};

static struct ts_short_test_info params_not = {
	MAX_DRV_NUM_NOT,
	MAX_SEN_NUM_NOT,
	not_drv_map,
	not_sen_map,
	SHORT_TEST_TIME_REG_NOT,
	SHORT_TEST_STATUS_REG_NOT,
	SHORT_TEST_RESULT_REG_NOT,
	DRV_DRV_SELFCODE_REG_NOT,
	SEN_SEN_SELFCODE_REG_NOT,
	DRV_SEN_SELFCODE_REG_NOT,
	DIFF_CODE_DATA_REG_NOT,
	0,
	0,
	0,
};

struct ts_short_res {
	u8 short_num;
	s16 short_msg[4 * MAX_SHORT_NUM];
};

struct ts_test_rawdata {
	s16 data[MAX_DRV_NUM * MAX_SEN_NUM];
	u32 size;
};

struct ts_test_self_rawdata {
	s16 data[MAX_DRV_NUM + MAX_SEN_NUM];
	u32 size;
};

static int raw_data_cnt;
static int noise_data_cnt;

struct goodix_ts_test {
	bool item[MAX_TEST_ITEMS];
	char result[MAX_TEST_ITEMS];
	s16 min_limits[MAX_DRV_NUM * MAX_SEN_NUM];
	s16 max_limits[MAX_DRV_NUM * MAX_SEN_NUM];
	s16 deviation_limits[MAX_DRV_NUM * MAX_SEN_NUM];
	s16 self_max_limits[MAX_DRV_NUM + MAX_SEN_NUM];
	s16 self_min_limits[MAX_DRV_NUM + MAX_SEN_NUM];
	s16 noise_threshold;
	s16 short_threshold;
	s16 r_drv_drv_threshold;
	s16 r_drv_sen_threshold;
	s16 r_sen_sen_threshold;
	s16 r_drv_gnd_threshold;
	s16 r_sen_gnd_threshold;
	s16 avdd_value;

	int freq;
	struct ts_test_rawdata *rawdata;
	struct ts_test_rawdata *deltadata;
	struct ts_test_rawdata *noisedata;
	struct ts_test_self_rawdata selfrawdata;
	struct ts_short_test_info *params_info;
	struct ts_short_res short_res;
};
static struct goodix_ts_test *ts_test;

static int cal_cha_to_cha_res(int v1, int v2)
{
	if (cd->bus->ic_type == IC_TYPE_BERLIN_A)
		return (v1 - v2) * 63 / v2;
	else if (cd->bus->ic_type == IC_TYPE_BERLIN_B)
		return (v1 - v2) * 74 / v2 + 20;
	else if (cd->bus->ic_type == IC_TYPE_BERLIN_D)
		return (v1 / v2 - 1) * 70 + 59;
	else
		return (v1 / v2 - 1) * 55 + 45;
}

static int cal_cha_to_avdd_res(int v1, int v2)
{
	if (cd->bus->ic_type == IC_TYPE_BERLIN_A)
		return 64 * (2 * v2 - 25) * 40 / v1 - 40;
	else if (cd->bus->ic_type == IC_TYPE_BERLIN_B)
		return 64 * (2 * v2 - 25) * 99 / v1 - 60;
	else if (cd->bus->ic_type == IC_TYPE_BERLIN_D)
		return 64 * (2 * v2 - 25) * 93 / v1 - 20;
	else
		return 64 * (2 * v2 - 25) * 76 / v1 - 15;
}

static int cal_cha_to_gnd_res(int v)
{
	if (cd->bus->ic_type == IC_TYPE_BERLIN_A)
		return 64148 / v - 40;
	else if (cd->bus->ic_type == IC_TYPE_BERLIN_B)
		return 150500 / v - 60;
	else if (cd->bus->ic_type == IC_TYPE_BERLIN_D)
		return 145000 / v - 15;
	else
		return 120000 / v - 16;
}

static int malloc_test_resource(void)
{
	ts_test = vzalloc(sizeof(*ts_test));
	if (!ts_test)
		return -ENOMEM;
	if (raw_data_cnt > 0) {
		ts_test->rawdata =
			vzalloc(raw_data_cnt * sizeof(struct ts_test_rawdata));
		if (ts_test->rawdata == NULL)
			return -ENOMEM;

		ts_test->deltadata =
			vzalloc(raw_data_cnt * sizeof(struct ts_test_rawdata));
		if (ts_test->deltadata == NULL)
			return -ENOMEM;
	}
	if (noise_data_cnt > 0) {
		ts_test->noisedata = vzalloc(
			noise_data_cnt * sizeof(struct ts_test_rawdata));
		if (ts_test->noisedata == NULL)
			return -ENOMEM;
	}

	return 0;
}

static void release_test_resource(void)
{
	if (ts_test) {
		vfree(ts_test->rawdata);
		vfree(ts_test->deltadata);
		vfree(ts_test->noisedata);
		vfree(ts_test);
		ts_test = NULL;
	}
	raw_data_cnt = 0;
	noise_data_cnt = 0;
}

#define CHN_VDD 0xFF
#define CHN_GND 0x7F
#define DRV_CHANNEL_FLAG 0x80
static u32 map_die2pin(u32 chn_num)
{
	int i = 0;
	u32 res = 255;

	if (chn_num & DRV_CHANNEL_FLAG)
		chn_num = (chn_num & ~DRV_CHANNEL_FLAG) +
			  ts_test->params_info->max_sen_num;

	for (i = 0; i < ts_test->params_info->max_sen_num; i++) {
		if (ts_test->params_info->sen_map[i] == chn_num) {
			res = i;
			break;
		}
	}
	/* res != 255 mean found the corresponding channel num */
	if (res != 255)
		return res;
	/* if cannot find in SenMap try find in DrvMap */
	for (i = 0; i < ts_test->params_info->max_drv_num; i++) {
		if (ts_test->params_info->drv_map[i] == chn_num) {
			res = i;
			break;
		}
	}
	if (i >= ts_test->params_info->max_drv_num)
		ts_err("Faild found corrresponding channel num:%d", chn_num);
	else
		res |= DRV_CHANNEL_FLAG;

	return res;
}

static void goodix_save_short_res(u16 chn1, u16 chn2, int r)
{
	int i;
	u8 repeat_cnt = 0;
	u8 repeat = 0;
	struct ts_short_res *short_res = &ts_test->short_res;

	if (chn1 == chn2 || short_res->short_num >= MAX_SHORT_NUM)
		return;

	for (i = 0; i < short_res->short_num; i++) {
		repeat_cnt = 0;
		if (short_res->short_msg[4 * i] == chn1)
			repeat_cnt++;
		if (short_res->short_msg[4 * i] == chn2)
			repeat_cnt++;
		if (short_res->short_msg[4 * i + 1] == chn1)
			repeat_cnt++;
		if (short_res->short_msg[4 * i + 1] == chn2)
			repeat_cnt++;
		if (repeat_cnt >= 2) {
			repeat = 1;
			break;
		}
	}
	if (repeat == 0) {
		short_res->short_msg[4 * short_res->short_num + 0] = chn1;
		short_res->short_msg[4 * short_res->short_num + 1] = chn2;
		short_res->short_msg[4 * short_res->short_num + 2] =
			(r >> 8) & 0xFF;
		short_res->short_msg[4 * short_res->short_num + 3] = r & 0xFF;
		if (short_res->short_num < MAX_SHORT_NUM)
			short_res->short_num++;
	}
}

static int gdix_check_tx_tx_shortcircut(u8 short_ch_num)
{
	int ret = 0, err = 0;
	u32 r_threshold = 0, short_r = 0;
	int size = 0, i = 0, j = 0;
	u16 adc_signal = 0;
	u8 master_pin_num, slave_pin_num;
	u8 *data_buf;
	u32 data_reg = ts_test->params_info->drv_drv_selfcode_reg;
	int max_drv_num = ts_test->params_info->max_drv_num;
	int max_sen_num = ts_test->params_info->max_sen_num;
	u16 self_capdata, short_die_num = 0;

	size = 4 + max_drv_num * 2 + 2;
	data_buf = kzalloc(size, GFP_KERNEL);
	if (!data_buf) {
		ts_err("Failed to alloc memory");
		return -ENOMEM;
	}
	/* drv&drv shortcircut check */
	for (i = 0; i < short_ch_num; i++) {
		ret = cd->hw_ops->read(cd, data_reg, data_buf, size);
		if (ret < 0) {
			ts_err("Failed read Drv-to-Drv short rawdata");
			err = -EINVAL;
			break;
		}

		if (checksum_cmp(data_buf, size, CHECKSUM_MODE_U8_LE)) {
			ts_err("Drv-to-Drv adc data checksum error");
			err = -EINVAL;
			break;
		}

		r_threshold = ts_test->r_drv_drv_threshold;
		short_die_num = le16_to_cpup((__le16 *)&data_buf[0]);
		short_die_num -= max_sen_num;
		if (short_die_num >= max_drv_num) {
			ts_info("invalid short pad num:%d",
				short_die_num + max_sen_num);
			continue;
		}

		/* TODO: j start position need recheck */
		self_capdata = le16_to_cpup((__le16 *)&data_buf[2]);
		if (self_capdata == 0xffff || self_capdata == 0) {
			ts_info("invalid self_capdata:0x%x", self_capdata);
			continue;
		}

		for (j = short_die_num + 1; j < max_drv_num; j++) {
			adc_signal =
				le16_to_cpup((__le16 *)&data_buf[4 + j * 2]);

			if (adc_signal < ts_test->short_threshold)
				continue;

			short_r = (u32)cal_cha_to_cha_res(
				self_capdata, adc_signal);
			if (short_r < r_threshold) {
				master_pin_num = map_die2pin(
					short_die_num + max_sen_num);
				slave_pin_num = map_die2pin(j + max_sen_num);
				if (master_pin_num == 0xFF ||
					slave_pin_num == 0xFF) {
					ts_info("WARNNING invalid pin");
					continue;
				}
				goodix_save_short_res(
					master_pin_num, slave_pin_num, short_r);
				ts_err("short circut:R=%dK,R_Threshold=%dK",
					short_r, r_threshold);
				ts_err("%s%d--%s%d shortcircut",
					(master_pin_num & DRV_CHANNEL_FLAG)
						? "DRV"
						: "SEN",
					(master_pin_num & ~DRV_CHANNEL_FLAG),
					(slave_pin_num & DRV_CHANNEL_FLAG)
						? "DRV"
						: "SEN",
					(slave_pin_num & ~DRV_CHANNEL_FLAG));
				err = -EINVAL;
			}
		}
		data_reg += size;
	}

	kfree(data_buf);
	return err;
}

static int gdix_check_rx_rx_shortcircut(u8 short_ch_num)
{
	int ret = 0, err = 0;
	u32 r_threshold = 0, short_r = 0;
	int size = 0, i = 0, j = 0;
	u16 adc_signal = 0;
	u8 master_pin_num, slave_pin_num;
	u8 *data_buf;
	u32 data_reg = ts_test->params_info->sen_sen_selfcode_reg;
	int max_sen_num = ts_test->params_info->max_sen_num;
	u16 self_capdata, short_die_num = 0;

	size = 4 + max_sen_num * 2 + 2;
	data_buf = kzalloc(size, GFP_KERNEL);
	if (!data_buf) {
		ts_err("Failed to alloc memory");
		return -ENOMEM;
	}
	/* drv&drv shortcircut check */
	for (i = 0; i < short_ch_num; i++) {
		ret = cd->hw_ops->read(cd, data_reg, data_buf, size);
		if (ret) {
			ts_err("Failed read Sen-to-Sen short rawdata");
			err = -EINVAL;
			break;
		}

		if (checksum_cmp(data_buf, size, CHECKSUM_MODE_U8_LE)) {
			ts_err("Sen-to-Sen adc data checksum error");
			err = -EINVAL;
			break;
		}

		r_threshold = ts_test->r_sen_sen_threshold;
		short_die_num = le16_to_cpup((__le16 *)&data_buf[0]);
		if (short_die_num >= max_sen_num) {
			ts_info("invalid short pad num:%d", short_die_num);
			continue;
		}

		/* TODO: j start position need recheck */
		self_capdata = le16_to_cpup((__le16 *)&data_buf[2]);
		if (self_capdata == 0xffff || self_capdata == 0) {
			ts_info("invalid self_capdata:0x%x", self_capdata);
			continue;
		}

		for (j = short_die_num + 1; j < max_sen_num; j++) {
			adc_signal =
				le16_to_cpup((__le16 *)&data_buf[4 + j * 2]);

			if (adc_signal < ts_test->short_threshold)
				continue;

			short_r = (u32)cal_cha_to_cha_res(
				self_capdata, adc_signal);
			if (short_r < r_threshold) {
				master_pin_num = map_die2pin(short_die_num);
				slave_pin_num = map_die2pin(j);
				if (master_pin_num == 0xFF ||
					slave_pin_num == 0xFF) {
					ts_info("WARNNING invalid pin");
					continue;
				}
				goodix_save_short_res(
					master_pin_num, slave_pin_num, short_r);
				ts_err("short circut:R=%dK,R_Threshold=%dK",
					short_r, r_threshold);
				ts_err("%s%d--%s%d shortcircut",
					(master_pin_num & DRV_CHANNEL_FLAG)
						? "DRV"
						: "SEN",
					(master_pin_num & ~DRV_CHANNEL_FLAG),
					(slave_pin_num & DRV_CHANNEL_FLAG)
						? "DRV"
						: "SEN",
					(slave_pin_num & ~DRV_CHANNEL_FLAG));
				err = -EINVAL;
			}
		}
		data_reg += size;
	}

	kfree(data_buf);
	return err;
}

static int gdix_check_tx_rx_shortcircut(u8 short_ch_num)
{
	int ret = 0, err = 0;
	u32 r_threshold = 0, short_r = 0;
	int size = 0, i = 0, j = 0;
	u16 adc_signal = 0;
	u8 master_pin_num, slave_pin_num;
	u8 *data_buf = NULL;
	u32 data_reg = ts_test->params_info->drv_sen_selfcode_reg;
	int max_drv_num = ts_test->params_info->max_drv_num;
	int max_sen_num = ts_test->params_info->max_sen_num;
	u16 self_capdata, short_die_num = 0;

	size = 4 + max_drv_num * 2 + 2;
	data_buf = kzalloc(size, GFP_KERNEL);
	if (!data_buf) {
		ts_err("Failed to alloc memory");
		return -ENOMEM;
	}
	/* drv&sen shortcircut check */
	for (i = 0; i < short_ch_num; i++) {
		ret = cd->hw_ops->read(cd, data_reg, data_buf, size);
		if (ret) {
			ts_err("Failed read Drv-to-Sen short rawdata");
			err = -EINVAL;
			break;
		}

		if (checksum_cmp(data_buf, size, CHECKSUM_MODE_U8_LE)) {
			ts_err("Drv-to-Sen adc data checksum error");
			err = -EINVAL;
			break;
		}

		r_threshold = ts_test->r_drv_sen_threshold;
		short_die_num = le16_to_cpup((__le16 *)&data_buf[0]);
		if (short_die_num >= max_sen_num) {
			ts_info("invalid short pad num:%d", short_die_num);
			continue;
		}

		/* TODO: j start position need recheck */
		self_capdata = le16_to_cpup((__le16 *)&data_buf[2]);
		if (self_capdata == 0xffff || self_capdata == 0) {
			ts_info("invalid self_capdata:0x%x", self_capdata);
			continue;
		}

		for (j = 0; j < max_drv_num; j++) {
			adc_signal =
				le16_to_cpup((__le16 *)&data_buf[4 + j * 2]);

			if (adc_signal < ts_test->short_threshold)
				continue;

			short_r = (u32)cal_cha_to_cha_res(
				self_capdata, adc_signal);
			if (short_r < r_threshold) {
				master_pin_num = map_die2pin(short_die_num);
				slave_pin_num = map_die2pin(j + max_sen_num);
				if (master_pin_num == 0xFF ||
					slave_pin_num == 0xFF) {
					ts_info("WARNNING invalid pin");
					continue;
				}
				goodix_save_short_res(
					master_pin_num, slave_pin_num, short_r);
				ts_err("short circut:R=%dK,R_Threshold=%dK",
					short_r, r_threshold);
				ts_err("%s%d--%s%d shortcircut",
					(master_pin_num & DRV_CHANNEL_FLAG)
						? "DRV"
						: "SEN",
					(master_pin_num & ~DRV_CHANNEL_FLAG),
					(slave_pin_num & DRV_CHANNEL_FLAG)
						? "DRV"
						: "SEN",
					(slave_pin_num & ~DRV_CHANNEL_FLAG));
				err = -EINVAL;
			}
		}
		data_reg += size;
	}

	kfree(data_buf);
	return err;
}

static int gdix_check_resistance_to_gnd(u16 adc_signal, u32 pos)
{
	long r = 0;
	u16 r_th = 0, avdd_value = 0;
	u16 chn_id_tmp = 0;
	u8 pin_num = 0;
	unsigned short short_type;
	int max_drv_num = ts_test->params_info->max_drv_num;
	int max_sen_num = ts_test->params_info->max_sen_num;

	avdd_value = ts_test->avdd_value;
	short_type = adc_signal & 0x8000;
	adc_signal &= ~0x8000;
	if (adc_signal == 0)
		adc_signal = 1;

	if (short_type == 0) {
		/* short to GND */
		r = cal_cha_to_gnd_res(adc_signal);
	} else {
		/* short to VDD */
		r = cal_cha_to_avdd_res(adc_signal, avdd_value);
	}

	if (pos < max_drv_num)
		r_th = ts_test->r_drv_gnd_threshold;
	else
		r_th = ts_test->r_sen_gnd_threshold;

	chn_id_tmp = pos;
	if (chn_id_tmp < max_drv_num)
		chn_id_tmp += max_sen_num;
	else
		chn_id_tmp -= max_drv_num;

	if (r < r_th) {
		pin_num = map_die2pin(chn_id_tmp);
		goodix_save_short_res(
			pin_num, short_type ? CHN_VDD : CHN_GND, r);
		ts_err("%s%d shortcircut to %s,R=%ldK,R_Threshold=%dK",
			(pin_num & DRV_CHANNEL_FLAG) ? "DRV" : "SEN",
			(pin_num & ~DRV_CHANNEL_FLAG),
			short_type ? "VDD" : "GND", r, r_th);

		return -EINVAL;
	}

	return 0;
}

static int gdix_check_gndvdd_shortcircut(void)
{
	int ret = 0, err = 0;
	int size = 0, i = 0;
	u16 adc_signal = 0;
	u32 data_reg = ts_test->params_info->diffcode_data_reg;
	u8 *data_buf = NULL;
	int max_drv_num = ts_test->params_info->max_drv_num;
	int max_sen_num = ts_test->params_info->max_sen_num;

	size = (max_drv_num + max_sen_num) * 2 + 2;
	data_buf = kzalloc(size, GFP_KERNEL);
	if (!data_buf) {
		ts_err("Failed to alloc memory");
		return -ENOMEM;
	}
	/* read diff code, diff code will be used to calculate
	 * resistance between channel and GND */
	ret = cd->hw_ops->read(cd, data_reg, data_buf, size);
	if (ret < 0) {
		ts_err("Failed read to-gnd rawdata");
		err = -EINVAL;
		goto err_out;
	}

	if (checksum_cmp(data_buf, size, CHECKSUM_MODE_U8_LE)) {
		ts_err("diff code checksum error");
		err = -EINVAL;
		goto err_out;
	}

	for (i = 0; i < max_drv_num + max_sen_num; i++) {
		adc_signal = le16_to_cpup((__le16 *)&data_buf[i * 2]);
		ret = gdix_check_resistance_to_gnd(adc_signal, i);
		if (ret != 0) {
			ts_err("Resistance to-gnd/vdd short");
			err = ret;
		}
	}

err_out:
	kfree(data_buf);
	return err;
}

#define NOTT_CHECKSUM_LEN 54
#define BRLD_CHECKSUM_LEN 62
#define BRLB_CHECKSUM_LEN 129
static int goodix_shortcircut_analysis(void)
{
	int ret;
	int err = 0;
	u8 temp_buf[140];
	test_result_t test_result;
	int checksum_len = 0;

	ret = cd->hw_ops->read(cd, ts_test->params_info->short_test_result_reg,
		temp_buf, sizeof(temp_buf));
	if (ret < 0) {
		ts_err("Read TEST_RESULT_REG failed");
		return ret;
	}

	if (cd->bus->ic_type == IC_TYPE_BERLIN_B) {
		checksum_len = BRLB_CHECKSUM_LEN;
	} else if (cd->bus->ic_type == IC_TYPE_BERLIN_D) {
		checksum_len = BRLD_CHECKSUM_LEN;
	} else if (cd->bus->ic_type == IC_TYPE_NOTTINGHAM) {
		checksum_len = NOTT_CHECKSUM_LEN;
	}

	if (checksum_cmp(&temp_buf[sizeof(test_result)], checksum_len,
		    CHECKSUM_MODE_U8_LE)) {
		ts_err("short result checksum err");
		return -EINVAL;
	}

	memcpy((u8 *)&test_result, temp_buf, sizeof(test_result));

	if (!(test_result.result & 0x0F)) {
		ts_info(">>>>> No shortcircut");
		return 0;
	}
	ts_info("short flag 0x%02x, drv&drv:%d, sen&sen:%d, drv&sen:%d, drv/GNDVDD:%d, sen/GNDVDD:%d",
		test_result.result, test_result.drv_drv_num,
		test_result.sen_sen_num, test_result.drv_sen_num,
		test_result.drv_gnd_avdd_num, test_result.sen_gnd_avdd_num);

	if (test_result.drv_drv_num)
		err |= gdix_check_tx_tx_shortcircut(test_result.drv_drv_num);
	if (test_result.sen_sen_num)
		err |= gdix_check_rx_rx_shortcircut(test_result.sen_sen_num);
	if (test_result.drv_sen_num)
		err |= gdix_check_tx_rx_shortcircut(test_result.drv_sen_num);
	if (test_result.drv_gnd_avdd_num || test_result.sen_gnd_avdd_num)
		err |= gdix_check_gndvdd_shortcircut();

	ts_info(">>>>> short check return 0x%x", err);

	return err;
}

#define INSPECT_FW_SWITCH_CMD 0x85
#define SHORT_TEST_RUN_FLAG 0xAA
#define SHORT_TEST_RUN_REG 0x10400
static int goodix_short_test_prepare(void)
{
	struct goodix_ts_cmd tmp_cmd;
	int ret;
	int retry;
	int resend = 3;
	u8 status;

	ts_info("short test prepare IN");
	tmp_cmd.len = 4;
	tmp_cmd.cmd = INSPECT_FW_SWITCH_CMD;

resend_cmd:
	ret = cd->hw_ops->send_cmd(cd, &tmp_cmd);
	if (ret < 0) {
		ts_err("send test mode failed");
		return ret;
	}

	retry = 3;
	while (retry--) {
		msleep(40);
		ret = cd->hw_ops->read(cd, SHORT_TEST_RUN_REG, &status, 1);
		if (!ret && status == SHORT_TEST_RUN_FLAG)
			return 0;
		ts_info("short_mode_status=0x%02x ret=%d", status, ret);
	}

	if (resend--) {
		cd->hw_ops->reset(cd, 100);
		goto resend_cmd;
	}

	return -EINVAL;
}

#define MAX_TEST_TIME_MS 15000
#define DEFAULT_TEST_TIME_MS 7000
#define SHORT_TEST_FINISH_FLAG 0x88
static int goodix_shortcircut_test(void)
{
	int ret = 0;
	int res;
	int retry;
	u16 test_time;
	u8 status;

	ts_info("---------------------- short_test begin ----------------------");
	ret = goodix_short_test_prepare();
	if (ret < 0) {
		ts_err("Failed enter short test mode");
		return ret;
	}

	/* get short test time */
	ret = cd->hw_ops->read(cd, ts_test->params_info->short_test_time_reg,
		(u8 *)&test_time, 2);
	if (ret < 0) {
		ts_err("Failed to get test_time, default %dms",
			DEFAULT_TEST_TIME_MS);
		test_time = DEFAULT_TEST_TIME_MS;
	} else {
		if (test_time > MAX_TEST_TIME_MS) {
			ts_info("test time too long %d > %d", test_time,
				MAX_TEST_TIME_MS);
			test_time = MAX_TEST_TIME_MS;
		}
		ts_info("get test time %dms", test_time);
	}

	/* start short test */
	status = 0;
	cd->hw_ops->write(cd, SHORT_TEST_RUN_REG, &status, 1);

	/* wait short test finish */
	msleep(test_time);
	retry = 50;
	while (retry--) {
		ret = cd->hw_ops->read(cd,
			ts_test->params_info->short_test_status_reg, &status,
			1);
		if (!ret && status == SHORT_TEST_FINISH_FLAG)
			break;
		msleep(50);
	}
	if (retry < 0) {
		ts_err("short test failed, status:0x%02x", status);
		return -EINVAL;
	}

	/* start analysis short result */
	ts_info("short_test finished, start analysis");
	res = goodix_shortcircut_analysis();
	if (res == 0) {
		ts_test->result[GTP_SHORT_TEST] = TEST_OK;
		ret = 0;
	}

	return ret;
}

typedef struct __attribute__((packed)) {
	uint32_t checksum;
	uint32_t address;
	uint32_t length;
} flash_head_info_t;

#define FLASH_CMD_R_START 0x09
#define FLASH_CMD_W_START 0x0A
#define FLASH_CMD_RW_FINISH 0x0B
#define FLASH_CMD_STATE_READY 0x04
#define FLASH_CMD_STATE_CHECKERR 0x05
#define FLASH_CMD_STATE_DENY 0x06
#define FLASH_CMD_STATE_OKAY 0x07
static int goodix_flash_cmd(uint8_t cmd, uint8_t status, int retry_count)
{
	u8 cmd_buf[] = { 0x00, 0x00, 0x04, 0x00, 0x00, 0x00 };
	int ret;
	int i;
	u8 r_sta;

	cmd_buf[3] = cmd;
	goodix_append_checksum(&cmd_buf[2], 2, CHECKSUM_MODE_U8_LE);
	ret = cd->hw_ops->write(
		cd, cd->ic_info.misc.cmd_addr, cmd_buf, sizeof(cmd_buf));
	if (ret < 0)
		return ret;

	if (retry_count == 0)
		return 0;

	for (i = 0; i < retry_count; i++) {
		usleep_range(2000, 2100);
		ret = cd->hw_ops->read(
			cd, cd->ic_info.misc.cmd_addr, &r_sta, 1);
		if (ret == 0 && r_sta == status)
			return 0;
	}

	ts_err("r_sta[0x%x] != status[0x%x]", r_sta, status);
	return -EINVAL;
}

static int goodix_flash_read(u32 addr, u8 *buf, int len)
{
	int i;
	int ret;
	u8 *tmp_buf;
	u32 buffer_addr = cd->ic_info.misc.fw_buffer_addr;
	uint32_t checksum = 0;
	flash_head_info_t head_info;
	u8 *p = (u8 *)&head_info.address;

	tmp_buf = kzalloc(len + sizeof(flash_head_info_t), GFP_KERNEL);
	if (!tmp_buf)
		return -ENOMEM;

	head_info.address = cpu_to_le32(addr);
	head_info.length = cpu_to_le32(len);
	for (i = 0; i < 8; i += 2)
		checksum += p[i] | (p[i + 1] << 8);
	head_info.checksum = checksum;

	ret = goodix_flash_cmd(FLASH_CMD_R_START, FLASH_CMD_STATE_READY, 15);
	if (ret < 0) {
		ts_err("failed enter flash read state");
		goto read_end;
	}

	ret = cd->hw_ops->write(
		cd, buffer_addr, (u8 *)&head_info, sizeof(head_info));
	if (ret < 0) {
		ts_err("failed write flash head info");
		goto read_end;
	}

	ret = goodix_flash_cmd(FLASH_CMD_RW_FINISH, FLASH_CMD_STATE_OKAY, 50);
	if (ret) {
		ts_err("faild read flash ready state");
		goto read_end;
	}

	ret = cd->hw_ops->read(
		cd, buffer_addr, tmp_buf, len + sizeof(flash_head_info_t));
	if (ret < 0) {
		ts_err("failed read data len %lu",
			len + sizeof(flash_head_info_t));
		goto read_end;
	}

	checksum = len % 2 ? tmp_buf[len + sizeof(flash_head_info_t) - 1] : 0;
	for (i = 0; i < len + sizeof(flash_head_info_t) - 6; i += 2)
		checksum += tmp_buf[4 + i] | (tmp_buf[5 + i] << 8);

	if (checksum != le32_to_cpup((__le32 *)tmp_buf)) {
		ts_err("read back data checksum error");
		ret = -EINVAL;
		goto read_end;
	}

	memcpy(buf, tmp_buf + sizeof(flash_head_info_t), len);
	ret = 0;
read_end:
	goodix_flash_cmd(0x0C, 0, 0);
	return ret;
}

static void *seq_start(struct seq_file *s, loff_t *pos)
{
	if (*pos >= index)
		return NULL;

	return rbuf + *pos;
}

static int seq_show(struct seq_file *s, void *v)
{
	seq_printf(s, (u8 *)v);
	return 0;
}

static void *seq_next(struct seq_file *s, void *v, loff_t *pos)
{
	*pos += index;
	return NULL;
}

static void seq_stop(struct seq_file *s, void *v)
{
	if (s->read_pos >= index) {
		// ts_info("read_pos:%d", (int)s->read_pos);
		vfree(rbuf);
		rbuf = NULL;
		index = 0;
		release_test_resource();
	}
}

static const struct seq_operations seq_ops = {
	.start = seq_start, .next = seq_next, .stop = seq_stop, .show = seq_show
};

static int driver_test_open(struct inode *inode, struct file *file)
{
	return seq_open(file, &seq_ops);
}

static int driver_test_release(struct inode *inode, struct file *file)
{
	return seq_release(inode, file);
}

static void goodix_save_header(void)
{
	int i;
	bool total_result = true;

	index = sprintf(
		&rbuf[index], "<?xml version=\"1.0\" encoding=\"utf-8\"?>\n");
	index += sprintf(&rbuf[index], "<TESTLOG>\n");
	index += sprintf(&rbuf[index], "<Header>\n");
	/* sava test result */
	for (i = 0; i < MAX_TEST_ITEMS; i++) {
		if (ts_test->item[i] && ts_test->result[i] == TEST_NG)
			total_result = false;
	}
	if (total_result == false) {
		index += sprintf(&rbuf[index], "<Result>NG</Result>\n");
	} else {
		index += sprintf(&rbuf[index], "<Result>OK</Result>\n");
	}

	index += sprintf(&rbuf[index], "<DeviceType>GT%s</DeviceType>\n",
		cd->fw_version.patch_pid);
	index += sprintf(&rbuf[index], "<SensorId>%d</SensorId>\n",
		cd->fw_version.sensor_id);
	index += sprintf(&rbuf[index], "</Header>\n");

	index += sprintf(&rbuf[index], "<ItemList>\n");
	if (ts_test->item[GTP_CAP_TEST]) {
		if (ts_test->result[GTP_CAP_TEST] == TEST_NG) {
			index += sprintf(&rbuf[index],
				"<Item name=\"Rawdata MAX/MIN Test\" result=\"NG\"/>\n");
		} else {
			index += sprintf(&rbuf[index],
				"<Item name=\"Rawdata MAX/MIN Test\" result=\"OK\"/>\n");
		}
		if (ts_test->result[GTP_DELTA_TEST] == TEST_NG) {
			index += sprintf(&rbuf[index],
				"<Item name=\"Rawdata Adjcent Deviation Test\" result=\"NG\"/>\n");
		} else {
			index += sprintf(&rbuf[index],
				"<Item name=\"Rawdata Adjcent Deviation Test\" result=\"OK\"/>\n");
		}
	}

	if (ts_test->item[GTP_NOISE_TEST]) {
		if (ts_test->result[GTP_NOISE_TEST] == TEST_NG) {
			index += sprintf(&rbuf[index],
				"<Item name=\"Diffdata Jitter Test\" result=\"NG\"/>\n");
		} else {
			index += sprintf(&rbuf[index],
				"<Item name=\"Diffdata Jitter Test\" result=\"OK\"/>\n");
		}
	}

	if (ts_test->item[GTP_SELFCAP_TEST]) {
		if (ts_test->result[GTP_SELFCAP_TEST] == TEST_NG) {
			index += sprintf(&rbuf[index],
				"<Item name=\"Self Rawdata Upper Limit Test\" result=\"NG\"/>\n");
		} else {
			index += sprintf(&rbuf[index],
				"<Item name=\"Self Rawdata Upper Limit Test\" result=\"OK\"/>\n");
		}
	}

	if (ts_test->item[GTP_SHORT_TEST]) {
		if (ts_test->result[GTP_SHORT_TEST] == TEST_NG) {
			index += sprintf(&rbuf[index],
				"<Item name=\"Short Test\" result=\"NG\"/>\n");
		} else {
			index += sprintf(&rbuf[index],
				"<Item name=\"Short Test\" result=\"OK\"/>\n");
		}
	}
	index += sprintf(&rbuf[index], "</ItemList>\n");
}

//static void goodix_save_limits(void)
//{
//	int tx = cd->ic_info.parm.drv_num;
//	int rx = cd->ic_info.parm.sen_num;
//	int i;
//	int chn1;
//	int chn2;
//	int r;
//
//	index += sprintf(&rbuf[index], "<TestItems>\n");
//
//	/* save short result */
//	if (ts_test->item[GTP_SHORT_TEST]) {
//		index += sprintf(&rbuf[index], "<Item name=\"Short Test\">\n");
//		index += sprintf(&rbuf[index], "<ShortNum>%d</ShortNum>\n",
//			ts_test->short_res.short_num);
//		for (i = 0; i < ts_test->short_res.short_num; i++) {
//			chn1 = ts_test->short_res.short_msg[4 * i];
//			chn2 = ts_test->short_res.short_msg[4 * i + 1];
//			r = (ts_test->short_res.short_msg[4 * i + 2] << 8) +
//			    ts_test->short_res.short_msg[4 * i + 3];
//			if (chn1 == CHN_VDD)
//				index += sprintf(&rbuf[index],
//					"<ShortMess Chn1=\"VDD\" ");
//			else if (chn1 == CHN_GND)
//				index += sprintf(&rbuf[index],
//					"<ShortMess Chn1=\"GND\" ");
//			else if (chn1 & DRV_CHANNEL_FLAG)
//				index += sprintf(&rbuf[index],
//					"<ShortMess Chn1=\"Tx%d\" ",
//					chn1 & 0x7f);
//			else
//				index += sprintf(&rbuf[index],
//					"<ShortMess Chn1=\"Rx%d\" ",
//					chn1 & 0x7f);
//			if (chn2 == CHN_VDD)
//				index += sprintf(&rbuf[index],
//					"Chn2=\"VDD\" ShortResistor= \"%dKom\"/>\n",
//					r);
//			else if (chn2 == CHN_GND)
//				index += sprintf(&rbuf[index],
//					"Chn2=\"GND\" ShortResistor= \"%dKom\"/>\n",
//					r);
//			else if (chn2 & DRV_CHANNEL_FLAG)
//				index += sprintf(&rbuf[index],
//					"Chn2=\"Tx%d\" ShortResistor= \"%dKom\"/>\n",
//					chn2 & 0x7f, r);
//			else
//				index += sprintf(&rbuf[index],
//					"Chn2=\"Rx%d\" ShortResistor= \"%dKom\"/>\n",
//					chn2 & 0x7f, r);
//		}
//		index += sprintf(&rbuf[index], "</Item>\n");
//	}
//
//	/* save open limits */
//	if (ts_test->item[GTP_CAP_TEST]) {
//		index += sprintf(
//			&rbuf[index], "<Item name=\"Rawdata Test Sets\">\n");
//		index += sprintf(&rbuf[index],
//			"<TotalFrameCnt>%d</TotalFrameCnt>\n", raw_data_cnt);
//		/* rawdata max limit */
//		index += sprintf(&rbuf[index], "<MaxRawLimit>\n");
//		for (i = 0; i < tx * rx; i++) {
//			index += sprintf(
//				&rbuf[index], "%d,", ts_test->max_limits[i]);
//			if ((i + 1) % tx == 0)
//				index += sprintf(&rbuf[index], "\n");
//		}
//		index += sprintf(&rbuf[index], "</MaxRawLimit>\n");
//		/* rawdata min limit */
//		index += sprintf(&rbuf[index], "<MinRawLimit>\n");
//		for (i = 0; i < tx * rx; i++) {
//			index += sprintf(
//				&rbuf[index], "%d,", ts_test->min_limits[i]);
//			if ((i + 1) % tx == 0)
//				index += sprintf(&rbuf[index], "\n");
//		}
//		index += sprintf(&rbuf[index], "</MinRawLimit>\n");
//		/* Max Accord limit */
//		index += sprintf(&rbuf[index], "<MaxAccordLimit>\n");
//		for (i = 0; i < tx * rx; i++) {
//			index += sprintf(&rbuf[index], "%d,",
//				ts_test->deviation_limits[i]);
//			if ((i + 1) % tx == 0)
//				index += sprintf(&rbuf[index], "\n");
//		}
//		index += sprintf(&rbuf[index], "</MaxAccordLimit>\n");
//		index += sprintf(&rbuf[index], "</Item>\n");
//	}
//
//	/* save noise limit */
//	if (ts_test->item[GTP_NOISE_TEST]) {
//		index += sprintf(
//			&rbuf[index], "<Item name=\"Diffdata Test Sets\">\n");
//		index += sprintf(&rbuf[index],
//			"<TotalFrameCnt>%d</TotalFrameCnt>\n", noise_data_cnt);
//		index += sprintf(&rbuf[index],
//			"<MaxJitterLimit>%d</MaxJitterLimit>\n",
//			ts_test->noise_threshold);
//		index += sprintf(&rbuf[index], "</Item>\n");
//	}
//
//	/* save self rawdata limit */
//	if (ts_test->item[GTP_SELFCAP_TEST]) {
//		index += sprintf(&rbuf[index],
//			"<Item name=\"Self Rawdata Test Sets\">\n");
//		index += sprintf(
//			&rbuf[index], "<TotalFrameCnt>1</TotalFrameCnt>\n");
//		index += sprintf(&rbuf[index], "<MaxRawLimit>\n");
//		for (i = 0; i < tx + rx; i++) {
//			index += sprintf(&rbuf[index], "%d,",
//				ts_test->self_max_limits[i]);
//			if ((i + 1) % tx == 0)
//				index += sprintf(&rbuf[index], "\n");
//		}
//		if ((tx + rx) % tx != 0)
//			index += sprintf(&rbuf[index], "\n");
//		index += sprintf(&rbuf[index], "</MaxRawLimit>\n");
//		index += sprintf(&rbuf[index], "<MinRawLimit>\n");
//		for (i = 0; i < tx + rx; i++) {
//			index += sprintf(&rbuf[index], "%d,",
//				ts_test->self_min_limits[i]);
//			if ((i + 1) % tx == 0)
//				index += sprintf(&rbuf[index], "\n");
//		}
//		if ((tx + rx) % tx != 0)
//			index += sprintf(&rbuf[index], "\n");
//		index += sprintf(&rbuf[index], "</MinRawLimit>\n");
//		index += sprintf(&rbuf[index], "</Item>\n");
//	}
//
//	index += sprintf(&rbuf[index], "</TestItems>\n");
//}

static void goodix_data_cal(s16 *data, size_t data_size, s16 *stat_result)
{
	int i = 0;
	s16 avg = 0;
	s16 min = 0;
	s16 max = 0;
	long long sum = 0;

	min = data[0];
	max = data[0];
	for (i = 0; i < data_size; i++) {
		sum += data[i];
		if (max < data[i])
			max = data[i];
		if (min > data[i])
			min = data[i];
	}
	avg = div_s64(sum, data_size);
	stat_result[0] = avg;
	stat_result[1] = max;
	stat_result[2] = min;
}

static void goodix_save_data(void)
{
	int tx = cd->ic_info.parm.drv_num;
	int rx = cd->ic_info.parm.sen_num;
	s16 stat_result[3];
	int i, j;

	index += sprintf(&rbuf[index], "<DataRecord>\n");

	/* save rawdata */
	if (ts_test->item[GTP_CAP_TEST]) {
		index += sprintf(&rbuf[index], "<RawDataRecord>\n");
		for (i = 0; i < raw_data_cnt; i++) {
			goodix_data_cal(
				ts_test->rawdata[i].data, tx * rx, stat_result);
			index += sprintf(&rbuf[index],
				"<DataContent No.=\"%d\" DataCount=\"%d\" Maximum=\"%d\" Minimum=\"%d\" Average=\"%d\">\n",
				i, tx * rx, stat_result[1], stat_result[2],
				stat_result[0]);
			for (j = 0; j < tx * rx; j++) {
				index += sprintf(&rbuf[index], "%d,",
					ts_test->rawdata[i].data[j]);
				if ((j + 1) % tx == 0)
					index += sprintf(&rbuf[index], "\n");
			}
			index += sprintf(&rbuf[index], "</DataContent>\n");
			goodix_data_cal(ts_test->deltadata[i].data, tx * rx,
				stat_result);
			index += sprintf(&rbuf[index],
				"<RawAccord No.=\"%d\" DataCount=\"%d\" Maximum=\"%d\" Minimum=\"%d\" Average=\"%d\">\n",
				i, tx * rx, stat_result[1], stat_result[2],
				stat_result[0]);
			for (j = 0; j < tx * rx; j++) {
				index += sprintf(&rbuf[index], "%d,",
					ts_test->deltadata[i].data[j]);
				if ((j + 1) % tx == 0)
					index += sprintf(&rbuf[index], "\n");
			}
			index += sprintf(&rbuf[index], "</RawAccord>\n");
		}
		index += sprintf(&rbuf[index], "</RawDataRecord>\n");
	}

	/* save noisedata */
	if (ts_test->item[GTP_NOISE_TEST]) {
		index += sprintf(&rbuf[index], "<DiffDataRecord>\n");
		for (i = 0; i < noise_data_cnt; i++) {
			goodix_data_cal(ts_test->noisedata[i].data, tx * rx,
				stat_result);
			index += sprintf(&rbuf[index],
				"<DataContent No.=\"%d\" DataCount=\"%d\" Maximum=\"%d\" Minimum=\"%d\" Average=\"%d\">\n",
				i, tx * rx, stat_result[1], stat_result[2],
				stat_result[0]);
			for (j = 0; j < tx * rx; j++) {
				index += sprintf(&rbuf[index], "%d,",
					ts_test->noisedata[i].data[j]);
				if ((j + 1) % tx == 0)
					index += sprintf(&rbuf[index], "\n");
			}
			index += sprintf(&rbuf[index], "</DataContent>\n");
		}
		index += sprintf(&rbuf[index], "</DiffDataRecord>\n");
	}

	/* save self rawdata */
	if (ts_test->item[GTP_SELFCAP_TEST]) {
		index += sprintf(&rbuf[index], "<selfDataRecord>\n");
		goodix_data_cal(
			ts_test->selfrawdata.data, tx + rx, stat_result);
		index += sprintf(&rbuf[index],
			"<DataContent No.=\"0\" DataCount=\"%d\" Maximum=\"%d\" Minimum=\"%d\" Average=\"%d\">\n",
			tx + rx, stat_result[1], stat_result[2],
			stat_result[0]);
		for (i = 0; i < tx + rx; i++) {
			index += sprintf(&rbuf[index], "%d,",
				ts_test->selfrawdata.data[i]);
			if ((i + 1) % tx == 0)
				index += sprintf(&rbuf[index], "\n");
		}
		if ((tx + rx) % tx != 0)
			index += sprintf(&rbuf[index], "\n");
		index += sprintf(&rbuf[index], "</DataContent>\n");
		index += sprintf(&rbuf[index], "</selfDataRecord>\n");
	}

	index += sprintf(&rbuf[index], "</DataRecord>\n");
}

static void goodix_save_tail(void)
{
	index += sprintf(&rbuf[index], "</TESTLOG>\n");
}

static void goodix_save_test_result(bool is_brief)
{
	if (is_brief) {
		if (ts_test->item[GTP_CAP_TEST]) {
			index += sprintf(&rbuf[index], "Open test:\n");
			index += sprintf(&rbuf[index], "%s\n",
				ts_test->result[GTP_CAP_TEST] ? "PASS"
							      : "FAIL");
		}
		if (ts_test->item[GTP_DELTA_TEST]) {
			index += sprintf(&rbuf[index], "Delta test:\n");
			index += sprintf(&rbuf[index], "%s\n",
				ts_test->result[GTP_DELTA_TEST] ? "PASS"
								: "FAIL");
		}
		if (ts_test->item[GTP_SHORT_TEST]) {
			index += sprintf(&rbuf[index], "Short test:\n");
			index += sprintf(&rbuf[index], "%s\n",
				ts_test->result[GTP_SHORT_TEST] ? "PASS"
								: "FAIL");
		}
		if (ts_test->item[GTP_NOISE_TEST]) {
			index += sprintf(&rbuf[index], "Noise test:\n");
			index += sprintf(&rbuf[index], "%s\n",
				ts_test->result[GTP_NOISE_TEST] ? "PASS"
								: "FAIL");
		}
		if (ts_test->item[GTP_SELFCAP_TEST]) {
			index += sprintf(&rbuf[index], "Self test:\n");
			index += sprintf(&rbuf[index], "%s\n",
				ts_test->result[GTP_SELFCAP_TEST] ? "PASS"
								  : "FAIL");
		}
	} else {
		goodix_save_header();
		goodix_save_data();
		goodix_save_tail();
	}
}

static void goto_next_line(char **ptr)
{
	do {
		*ptr = *ptr + 1;
	} while (**ptr != '\n' && **ptr != '\0');
	if (**ptr == '\0') {
		return;
	}
	*ptr = *ptr + 1;
}

static void copy_this_line(char *dest, char *src)
{
	char *copy_from;
	char *copy_to;

	copy_from = src;
	copy_to = dest;
	do {
		*copy_to = *copy_from;
		copy_from++;
		copy_to++;
	} while ((*copy_from != '\n') && (*copy_from != '\r') &&
		 (*copy_from != '\0'));
	*copy_to = '\0';
}

static int getrid_space(s8 *data, s32 len)
{
	u8 *buf = NULL;
	s32 i;
	u32 count = 0;

	buf = (char *)kzalloc(len + 5, GFP_KERNEL);
	if (buf == NULL) {
		ts_err("get space kzalloc error");
		return -ESRCH;
	}

	for (i = 0; i < len; i++) {
		if (data[i] == ' ' || data[i] == '\r' || data[i] == '\n') {
			continue;
		}
		buf[count++] = data[i];
	}

	buf[count++] = '\0';

	memcpy(data, buf, count);
	kfree(buf);

	return count;
}

static int parse_valid_data(
	char *buf_start, loff_t buf_size, char *ptr, s16 *data, s32 rows)
{
	int i = 0;
	int j = 0;
	char *token = NULL;
	char *tok_ptr = NULL;
	char *row_data = NULL;
	long temp_val;

	if (!ptr || !data)
		return -EINVAL;

	row_data = (char *)kzalloc(MAX_LINE_LEN, GFP_KERNEL);
	if (!row_data) {
		ts_err("alloc index %d failed.", MAX_LINE_LEN);
		return -ENOMEM;
	}

	for (i = 0; i < rows; i++) {
		memset(row_data, 0, MAX_LINE_LEN);
		copy_this_line(row_data, ptr);
		getrid_space(row_data, strlen(row_data));
		tok_ptr = row_data;
		while ((token = strsep(&tok_ptr, ","))) {
			if (strlen(token) == 0)
				continue;
			if (kstrtol(token, 0, &temp_val)) {
				kfree(row_data);
				return -EINVAL;
			}
			data[j++] = (s16)temp_val;
		}
		if (i == rows - 1)
			break;
		goto_next_line(&ptr); // next row
		if (!ptr || (0 == strlen(ptr)) ||
			(ptr >= (buf_start + buf_size))) {
			ts_info("invalid ptr, return");
			kfree(row_data);
			row_data = NULL;
			return -EPERM;
		}
	}
	kfree(row_data);
	return j;
}

static int parse_csvfile(
	char *buf, size_t size, char *target_name, s16 *data, s32 rows, s32 col)
{
	char *ptr = NULL;

	if (!data || !buf)
		return -EIO;

	ptr = buf;
	ptr = strstr(ptr, target_name);
	if (!ptr) {
		ts_info("load %s failed 1, maybe not this item", target_name);
		return -EINTR;
	}

	goto_next_line(&ptr);
	if (!ptr || (0 == strlen(ptr))) {
		ts_err("load %s failed 2!", target_name);
		return -EIO;
	}

	return parse_valid_data(buf, size, ptr, data, rows);
}

static int goodix_obtain_testlimits(void)
{
	const struct firmware *firmware = NULL;
	struct device *dev = &cd->pdev->dev;
	int tx = cd->ic_info.parm.drv_num;
	int rx = cd->ic_info.parm.sen_num;
	char *limit_file = cd->board_data.test_limits_name;
	char *temp_buf = NULL;
	char *raw_limit_min = CSV_TP_SPECIAL_RAW_MIN;
	char *raw_limit_max = CSV_TP_SPECIAL_RAW_MAX;
	s16 data_buf[7];
	int ret;

	ts_info("limit_file_name:%s", limit_file);

	ret = request_firmware(&firmware, limit_file, dev);
	if (ret < 0) {
		ts_err("limits file [%s] not available", limit_file);
		return -EINVAL;
	}
	if (firmware->size <= 0) {
		ts_err("request_firmware, limits param length error,len:%zu",
			firmware->size);
		ret = -EINVAL;
		goto exit_free;
	}
	temp_buf = kzalloc(firmware->size + 1, GFP_KERNEL);
	if (!temp_buf) {
		ret = -ENOMEM;
		goto exit_free;
	}
	memcpy(temp_buf, firmware->data, firmware->size);

	if (ts_test->item[GTP_CAP_TEST]) {
		if (ts_test->freq > 0) {
			raw_limit_min = CSV_TP_SPECIAL_FREQ_RAW_MIN;
			raw_limit_max = CSV_IP_SPECIAL_FREQ_RAW_MAX;
		}

		/* obtain mutual_raw min */
		ret = parse_csvfile(temp_buf, firmware->size, raw_limit_min,
			ts_test->min_limits, rx, tx);
		if (ret < 0) {
			ts_err("Failed get min_limits");
			goto exit_free;
		}
		/* obtain mutual_raw max */
		ret = parse_csvfile(temp_buf, firmware->size, raw_limit_max,
			ts_test->max_limits, rx, tx);
		if (ret < 0) {
			ts_err("Failed get max_limits");
			goto exit_free;
		}
		/* obtain delta limit */
		ret = parse_csvfile(temp_buf, firmware->size,
			CSV_TP_SPECIAL_RAW_DELTA, ts_test->deviation_limits, rx,
			tx);
		if (ret < 0) {
			ts_err("Failed get delta limit");
			goto exit_free;
		}
	}

	if (ts_test->item[GTP_SELFCAP_TEST]) {
		/* obtain self_raw min */
		ret = parse_csvfile(temp_buf, firmware->size,
			CSV_TP_SPECIAL_SELFRAW_MIN, ts_test->self_min_limits, 1,
			tx + rx);
		if (ret < 0) {
			ts_err("Failed get self_min_limits");
			goto exit_free;
		}
		/* obtain self_raw max */
		ret = parse_csvfile(temp_buf, firmware->size,
			CSV_TP_SPECIAL_SELFRAW_MAX, ts_test->self_max_limits, 1,
			tx + rx);
		if (ret < 0) {
			ts_err("Failed get self_min_limits");
			goto exit_free;
		}
	}

	if (ts_test->item[GTP_NOISE_TEST]) {
		/* obtain noise_threshold */
		ret = parse_csvfile(temp_buf, firmware->size,
			CSV_TP_NOISE_LIMIT, &ts_test->noise_threshold, 1, 1);
		if (ret < 0) {
			ts_err("Failed get noise limits");
			goto exit_free;
		}
	}

	if (ts_test->item[GTP_SHORT_TEST]) {
		/* obtain short_params */
		ret = parse_csvfile(temp_buf, firmware->size,
			CSV_TP_SHORT_THRESHOLD, data_buf, 1, 7);
		if (ret < 0) {
			ts_err("Failed get short circuit limits");
			goto exit_free;
		}
		ts_test->short_threshold = data_buf[0];
		ts_test->r_drv_drv_threshold = data_buf[1];
		ts_test->r_drv_sen_threshold = data_buf[2];
		ts_test->r_sen_sen_threshold = data_buf[3];
		ts_test->r_drv_gnd_threshold = data_buf[4];
		ts_test->r_sen_gnd_threshold = data_buf[5];
		ts_test->avdd_value = data_buf[6];

		if (cd->bus->ic_type == IC_TYPE_BERLIN_B)
			ts_test->params_info = &params_brb;
		else if (cd->bus->ic_type == IC_TYPE_BERLIN_D)
			ts_test->params_info = &params_brd;
		else if (cd->bus->ic_type == IC_TYPE_NOTTINGHAM)
			ts_test->params_info = &params_not;
	}

exit_free:
	kfree(temp_buf);
	if (firmware)
		release_firmware(firmware);
	return ret;
}

static int goodix_delta_test(void)
{
	int i, j;
	int max_val;
	int raw;
	int temp;
	int tx = cd->ic_info.parm.drv_num;
	int rx = cd->ic_info.parm.sen_num;
	u32 data_size = tx * rx;
	int ret = 0;

	for (i = 0; i < raw_data_cnt; i++) {
		for (j = 0; j < data_size; j++) {
			raw = ts_test->rawdata[i].data[j];
			max_val = 0;
			/* calcu delta with above node */
			if (j - tx >= 0) {
				temp = ts_test->rawdata[i].data[j - tx];
				temp = ABS(temp - raw);
				max_val = MAX(max_val, temp);
			}
			/* calcu delta with bellow node */
			if (j + tx < data_size) {
				temp = ts_test->rawdata[i].data[j + tx];
				temp = ABS(temp - raw);
				max_val = MAX(max_val, temp);
			}
			/* calcu delta with left node */
			if (j % tx) {
				temp = ts_test->rawdata[i].data[j - 1];
				temp = ABS(temp - raw);
				max_val = MAX(max_val, temp);
			}
			/* calcu delta with right node */
			if ((j + 1) % tx) {
				temp = ts_test->rawdata[i].data[j + 1];
				temp = ABS(temp - raw);
				max_val = MAX(max_val, temp);
			}
			temp = max_val * 1000 / raw;
			ts_test->deltadata[i].data[j] = temp;
			if (temp > ts_test->deviation_limits[j]) {
				ts_err("delta_data[%d] > limits[%d]", temp,
					ts_test->deviation_limits[j]);
				ret = -EINVAL;
			}
		}
	}

	return ret;
}

static int goodix_open_test(void)
{
	u8 *tmp_buf;
	struct goodix_ts_cmd temp_cmd;
	int tx = cd->ic_info.parm.drv_num;
	int rx = cd->ic_info.parm.sen_num;
	u32 sync_addr = cd->ic_info.misc.frame_data_addr;
	u32 raw_addr;
	int ret;
	int err_cnt = 0;
	int i, j;
	s16 tmp_val;
	u16 tmp_freq;
	u8 val;
	int retry;

	raw_addr = cd->ic_info.misc.frame_data_addr +
		   cd->ic_info.misc.frame_data_head_len +
		   cd->ic_info.misc.fw_attr_len + cd->ic_info.misc.fw_log_len +
		   8;

	tmp_buf = kzalloc(GOODIX_MAX_FRAMEDATA_LEN, GFP_KERNEL);
	if (tmp_buf == NULL)
		return -ENOMEM;

	/* open test prepare */
	temp_cmd.cmd = 0x90;
	temp_cmd.data[0] = 0x84;
	temp_cmd.len = 5;
	ret = cd->hw_ops->send_cmd(cd, &temp_cmd);
	if (ret < 0) {
		ts_err("send rawdata cmd failed");
		goto exit;
	}

	/* switch freq */
	if (ts_test->freq > 0) {
		ts_info("set freq %d", ts_test->freq);
		tmp_freq = ts_test->freq / 61;
		temp_cmd.len = 6;
		temp_cmd.cmd = 0xB1;
		temp_cmd.data[0] = tmp_freq & 0xFF;
		temp_cmd.data[1] = (tmp_freq >> 8) & 0xFF;
		ret = cd->hw_ops->send_cmd(cd, &temp_cmd);
		if (ret < 0) {
			ts_err("set freq %d failed", ts_test->freq);
			goto exit;
		}
	}

	/* discard the first few frames */
	for (i = 0; i < 3; i++) {
		val = 0;
		cd->hw_ops->write(cd, sync_addr, &val, 1);
		usleep_range(20000, 21000);
	}

	/* read rawdata */
	for (i = 0; i < raw_data_cnt; i++) {
		val = 0;
		cd->hw_ops->write(cd, sync_addr, &val, 1);
		retry = 20;
		while (retry--) {
			usleep_range(5000, 5100);
			cd->hw_ops->read(cd, sync_addr, &val, 1);
			if (val & 0x80)
				break;
		}
		if (retry < 0) {
			ts_err("rawdata is not ready val:0x%02x i:%d, exit",
				val, i);
			ret = -EINVAL;
			goto exit;
		}

		cd->hw_ops->read(cd, raw_addr, tmp_buf, tx * rx * 2);
		goodix_rotate_abcd2cbad(tx, rx, (s16 *)tmp_buf, NULL);
		memcpy((u8 *)ts_test->rawdata[i].data, tmp_buf, tx * rx * 2);
	}

	/* analysis results */
	ts_test->result[GTP_CAP_TEST] = TEST_OK;
	for (i = 0; i < raw_data_cnt; i++) {
		for (j = 0; j < tx * rx; j++) {
			tmp_val = ts_test->rawdata[i].data[j];
			if (tmp_val > ts_test->max_limits[j] ||
				tmp_val < ts_test->min_limits[j]) {
				ts_err("rawdata[%d] out of range[%d %d]",
					tmp_val, ts_test->min_limits[j],
					ts_test->max_limits[j]);
				err_cnt++;
			}
		}
	}

	if (err_cnt > 0) {
		ret = -EINVAL;
		ts_test->result[GTP_CAP_TEST] = TEST_NG;
	}

	if (goodix_delta_test() == 0)
		ts_test->result[GTP_DELTA_TEST] = TEST_OK;

exit:
	kfree(tmp_buf);
	return ret;
}

static int goodix_self_open_test(void)
{
	u8 *tmp_buf;
	struct goodix_ts_cmd temp_cmd;
	int tx = cd->ic_info.parm.drv_num;
	int rx = cd->ic_info.parm.sen_num;
	u32 sync_addr = cd->ic_info.misc.frame_data_addr;
	u32 raw_addr;
	int ret;
	int j;
	s16 tmp_val;
	u8 val;
	int retry;

	raw_addr = cd->ic_info.misc.frame_data_addr +
		   cd->ic_info.misc.frame_data_head_len +
		   cd->ic_info.misc.fw_attr_len + cd->ic_info.misc.fw_log_len +
		   cd->ic_info.misc.mutual_struct_len + 10;

	tmp_buf = kzalloc(GOODIX_MAX_FRAMEDATA_LEN, GFP_KERNEL);
	if (tmp_buf == NULL)
		return -ENOMEM;

	/* test prepare */
	temp_cmd.cmd = 0x90;
	temp_cmd.data[0] = 0x84;
	temp_cmd.len = 5;
	ret = cd->hw_ops->send_cmd(cd, &temp_cmd);
	if (ret < 0) {
		ts_err("send rawdata cmd failed");
		goto exit;
	}

	/* discard the first few frames */
	for (j = 0; j < 3; j++) {
		val = 0;
		cd->hw_ops->write(cd, sync_addr, &val, 1);
		usleep_range(20000, 21000);
	}

	/* read self rawdata */
	val = 0;
	cd->hw_ops->write(cd, sync_addr, &val, 1);
	retry = 20;
	while (retry--) {
		usleep_range(5000, 5100);
		cd->hw_ops->read(cd, sync_addr, &val, 1);
		if (val & 0x80)
			break;
	}
	if (retry < 0) {
		ts_err("self rawdata is not ready val:0x%02x, exit", val);
		ret = -EINVAL;
		goto exit;
	}

	cd->hw_ops->read(cd, raw_addr, tmp_buf, (tx + rx) * 2);
	memcpy((u8 *)ts_test->selfrawdata.data, tmp_buf, (tx + rx) * 2);

	/* analysis results */
	ts_test->result[GTP_SELFCAP_TEST] = TEST_OK;
	for (j = 0; j < tx + rx; j++) {
		tmp_val = ts_test->selfrawdata.data[j];
		if (tmp_val > ts_test->self_max_limits[j] ||
			tmp_val < ts_test->self_min_limits[j]) {
			ts_err("self_rawdata[%d] out of range[%d %d]", tmp_val,
				ts_test->self_min_limits[j],
				ts_test->self_max_limits[j]);
			ts_test->result[GTP_SELFCAP_TEST] = TEST_NG;
			ret = -EINVAL;
		}
	}

exit:
	kfree(tmp_buf);
	return ret;
}

static int goodix_noise_test(void)
{
	u8 *tmp_buf;
	struct goodix_ts_cmd temp_cmd;
	int tx = cd->ic_info.parm.drv_num;
	int rx = cd->ic_info.parm.sen_num;
	u32 sync_addr = cd->ic_info.misc.frame_data_addr;
	u32 raw_addr;
	int ret;
	int i, j;
	s16 tmp_val;
	u8 val;
	int retry;

	raw_addr = cd->ic_info.misc.frame_data_addr +
		   cd->ic_info.misc.frame_data_head_len +
		   cd->ic_info.misc.fw_attr_len + cd->ic_info.misc.fw_log_len +
		   8;

	tmp_buf = kzalloc(GOODIX_MAX_FRAMEDATA_LEN, GFP_KERNEL);
	if (tmp_buf == NULL)
		return -ENOMEM;

	/* open test prepare */
	temp_cmd.cmd = 0x90;
	temp_cmd.data[0] = 0x82;
	temp_cmd.len = 5;
	ret = cd->hw_ops->send_cmd(cd, &temp_cmd);
	if (ret < 0) {
		ts_err("send rawdata cmd failed");
		goto exit;
	}

	/* discard the first few frames */
	for (i = 0; i < 3; i++) {
		val = 0;
		cd->hw_ops->write(cd, sync_addr, &val, 1);
		usleep_range(20000, 21000);
	}

	/* read noisedata */
	for (i = 0; i < noise_data_cnt; i++) {
		val = 0;
		cd->hw_ops->write(cd, sync_addr, &val, 1);
		retry = 20;
		while (retry--) {
			usleep_range(5000, 5100);
			cd->hw_ops->read(cd, sync_addr, &val, 1);
			if (val & 0x80)
				break;
		}
		if (retry < 0) {
			ts_err("noisedata is not ready val:0x%02x i:%d, exit",
				val, i);
			ret = -EINVAL;
			goto exit;
		}

		cd->hw_ops->read(cd, raw_addr, tmp_buf, tx * rx * 2);
		goodix_rotate_abcd2cbad(tx, rx, (s16 *)tmp_buf, NULL);
		memcpy((u8 *)ts_test->noisedata[i].data, tmp_buf, tx * rx * 2);
	}

	/* analysis results */
	ts_test->result[GTP_NOISE_TEST] = TEST_OK;
	for (i = 0; i < noise_data_cnt; i++) {
		for (j = 0; j < tx * rx; j++) {
			tmp_val = ts_test->noisedata[i].data[j];
			tmp_val = ABS(tmp_val);
			if (tmp_val > ts_test->noise_threshold) {
				ts_err("noise data[%d] > noise threshold[%d]",
					tmp_val, ts_test->noise_threshold);
				ts_test->result[GTP_NOISE_TEST] = TEST_NG;
				ret = -EINVAL;
			}
		}
	}

exit:
	kfree(tmp_buf);
	return ret;
}

static int goodix_auto_test(bool is_brief)
{
	struct goodix_ts_cmd temp_cmd;
	int ret;

	ret = goodix_obtain_testlimits();
	if (ret < 0) {
		ts_err("obtain open test limits failed");
		return ret;
	}

	cd->hw_ops->irq_enable(cd, false);
	goodix_ts_blocking_notify(NOTIFY_ESD_OFF, NULL);

	temp_cmd.len = 5;
	temp_cmd.cmd = 0x64;
	temp_cmd.data[0] = 1;

	if (ts_test->item[GTP_CAP_TEST]) {
		ret = cd->hw_ops->send_cmd(cd, &temp_cmd);
		if (ret < 0)
			ts_err("enter test mode failed");
		goodix_open_test();
		cd->hw_ops->reset(cd, 100);
	}

	if (ts_test->item[GTP_NOISE_TEST]) {
		ret = cd->hw_ops->send_cmd(cd, &temp_cmd);
		if (ret < 0)
			ts_err("enter test mode failed");
		goodix_noise_test();
		cd->hw_ops->reset(cd, 100);
	}

	if (ts_test->item[GTP_SELFCAP_TEST]) {
		goodix_self_open_test();
		cd->hw_ops->reset(cd, 100);
	}

	if (ts_test->item[GTP_SHORT_TEST]) {
		goodix_shortcircut_test();
		cd->hw_ops->reset(cd, 100);
	}

	cd->hw_ops->irq_enable(cd, true);
	goodix_ts_blocking_notify(NOTIFY_ESD_ON, NULL);
	goodix_save_test_result(is_brief);
	return 0;
}

static void goodix_auto_noise_test(u16 cnt, int threshold)
{
	struct goodix_ts_cmd temp_cmd;
	struct goodix_ts_cmd rb_cmd;
	u32 sync_addr = cd->ic_info.misc.frame_data_addr;
	u32 raw_addr;
	int tx = cd->ic_info.parm.drv_num;
	int rx = cd->ic_info.parm.sen_num;
	s16 *tmp_buf;
	int tmp_val;
	u8 status;
	int test_try = 2;
	int ret = 0;
	int retry = 10;
	int err_cnt = 0;
	int i;

	tmp_buf = kcalloc(MAX_DRV_NUM * MAX_SEN_NUM, 2, GFP_KERNEL);
	if (tmp_buf == NULL)
		return;

	raw_addr = cd->ic_info.misc.frame_data_addr +
		   cd->ic_info.misc.frame_data_head_len +
		   cd->ic_info.misc.fw_attr_len + cd->ic_info.misc.fw_log_len +
		   8;

	cd->hw_ops->irq_enable(cd, false);
	goodix_ts_blocking_notify(NOTIFY_ESD_OFF, NULL);

restart:
	temp_cmd.len = 0x07;
	temp_cmd.cmd = 0x90;
	temp_cmd.data[0] = 0x86;
	temp_cmd.data[1] = cnt & 0xFF;
	temp_cmd.data[2] = (cnt >> 8) & 0xFF;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
	cd->hw_ops->read(
		cd, cd->ic_info.misc.cmd_addr, rb_cmd.buf, sizeof(rb_cmd));
	ts_info("rb_cmd:%*ph", (int)sizeof(rb_cmd), rb_cmd.buf);

	msleep(cnt * 20);

	while (retry--) {
		cd->hw_ops->read(cd, sync_addr, &status, 1);
		if (status & 0x80)
			break;
		usleep_range(5000, 5100);
	}
	if (retry < 0) {
		ts_err("noise data not ready, status[%x]", status);
		ret = -EINVAL;
		goto exit;
	}

	cd->hw_ops->read(cd, raw_addr, (u8 *)tmp_buf, tx * rx * 2);
	goodix_rotate_abcd2cbad(tx, rx, tmp_buf, NULL);
	index += sprintf(&rbuf[index], "max:\n");
	for (i = 0; i < tx * rx; i++) {
		tmp_val = tmp_buf[i];
		index += sprintf(&rbuf[index], "%3d,", tmp_val);
		if ((i + 1) % tx == 0)
			index += sprintf(&rbuf[index], "\n");
		if (ABS(tmp_val) > threshold)
			err_cnt++;
	}

	status = 0;
	cd->hw_ops->write(cd, sync_addr, &status, 1);
	retry = 10;
	while (retry--) {
		cd->hw_ops->read(cd, sync_addr, &status, 1);
		if (status & 0x80)
			break;
		usleep_range(5000, 5100);
	}
	if (retry < 0) {
		ts_err("noise data not ready, status[%x]", status);
		ret = -EINVAL;
		goto exit;
	}
	cd->hw_ops->read(cd, raw_addr, (u8 *)tmp_buf, tx * rx * 2);
	goodix_rotate_abcd2cbad(tx, rx, tmp_buf, NULL);
	index += sprintf(&rbuf[index], "min:\n");
	for (i = 0; i < tx * rx; i++) {
		tmp_val = tmp_buf[i];
		index += sprintf(&rbuf[index], "%3d,", tmp_val);
		if ((i + 1) % tx == 0)
			index += sprintf(&rbuf[index], "\n");
		if (ABS(tmp_val) > threshold)
			err_cnt++;
	}

	if (err_cnt > 0)
		index += sprintf(&rbuf[index], "Result: FAIL\n");
	else
		index += sprintf(&rbuf[index], "Result: PASS\n");

exit:
	cd->hw_ops->reset(cd, 100);
	if (ret < 0 && --test_try > 0) {
		ts_err("auto noise running failed, retry:%d", test_try);
		ret = 0;
		index = 0;
		goto restart;
	}
	kfree(tmp_buf);
	cd->hw_ops->irq_enable(cd, true);
	goodix_ts_blocking_notify(NOTIFY_ESD_ON, NULL);
}

static int get_cap_data(uint8_t *type)
{
	struct goodix_ts_cmd temp_cmd;
	int tx = cd->ic_info.parm.drv_num;
	int rx = cd->ic_info.parm.sen_num;
	u8 val;
	int retry = 20;
	u8 *frame_buf;
	u32 flag_addr = cd->ic_info.misc.frame_data_addr;
	u32 mutual_addr;
	u32 self_addr;
	u32 tx_freq_addr;
	int i;
	int ret;

	mutual_addr = cd->ic_info.misc.frame_data_addr +
		      cd->ic_info.misc.frame_data_head_len +
		      cd->ic_info.misc.fw_attr_len +
		      cd->ic_info.misc.fw_log_len + 8;
	self_addr = cd->ic_info.misc.frame_data_addr +
		    cd->ic_info.misc.frame_data_head_len +
		    cd->ic_info.misc.fw_attr_len + cd->ic_info.misc.fw_log_len +
		    cd->ic_info.misc.mutual_struct_len + 10;
	tx_freq_addr = cd->ic_info.misc.frame_data_addr +
		       cd->ic_info.misc.frame_data_head_len +
		       cd->ic_info.misc.fw_attr_len +
		       cd->ic_info.misc.fw_log_len + 2;

	frame_buf = kzalloc(GOODIX_MAX_FRAMEDATA_LEN, GFP_KERNEL);
	if (frame_buf == NULL)
		return -ENOMEM;

	/* disable irq & close esd */
	cd->hw_ops->irq_enable(cd, false);
	goodix_ts_blocking_notify(NOTIFY_ESD_OFF, NULL);

	if (strstr(type, CMD_GET_BASEDATA) ||
		strstr(type, CMD_GET_SELF_BASEDATA)) {
		temp_cmd.data[0] = 0x83;
	} else if (strstr(type, CMD_GET_RAWDATA) ||
		   strstr(type, CMD_GET_SELF_RAWDATA) ||
		   strstr(type, CMD_GET_TX_FREQ)) {
		temp_cmd.data[0] = 0x81;
	} else {
		temp_cmd.data[0] = 0x82;
	}

	temp_cmd.cmd = 0x90;
	temp_cmd.len = 5;
	ret = cd->hw_ops->send_cmd(cd, &temp_cmd);
	if (ret < 0) {
		ts_err("report rawdata failed, exit!");
		goto exit;
	}

	/* clean touch event flag */
	val = 0;
	ret = cd->hw_ops->write(cd, flag_addr, &val, 1);
	if (ret < 0) {
		ts_err("clean touch event failed, exit!");
		goto exit;
	}

	while (retry--) {
		usleep_range(2000, 2100);
		ret = cd->hw_ops->read(cd, flag_addr, &val, 1);
		if (!ret && (val & 0x80))
			break;
	}
	if (retry < 0) {
		ts_err("framedata is not ready val:0x%02x, exit!", val);
		ret = -EINVAL;
		goto exit;
	}

	if (strstr(type, CMD_GET_TX_FREQ)) {
		ret = cd->hw_ops->read(cd, tx_freq_addr, frame_buf, 2);
		if (ret < 0) {
			ts_err("read frame data failed");
			goto exit;
		}

		index = sprintf(rbuf, "%s: %dHz\n", CMD_GET_TX_FREQ,
			le16_to_cpup((__le16 *)frame_buf) * 61);
		goto exit;
	}

	if (strstr(type, CMD_GET_RAWDATA) || strstr(type, CMD_GET_DIFFDATA) ||
		strstr(type, CMD_GET_BASEDATA)) {
		ret = cd->hw_ops->read(cd, mutual_addr, frame_buf, tx * rx * 2);
		if (ret < 0) {
			ts_err("read frame data failed");
			goto exit;
		}
		goodix_rotate_abcd2cbad(tx, rx, (s16 *)frame_buf, NULL);
		for (i = 0; i < tx * rx; i++) {
			index += sprintf(
				&rbuf[index], "%5d,", *((s16 *)frame_buf + i));
			if ((i + 1) % tx == 0)
				index += sprintf(&rbuf[index], "\n");
		}
	} else {
		ret = cd->hw_ops->read(cd, self_addr, frame_buf, (tx + rx) * 2);
		if (ret < 0) {
			ts_err("read frame data failed");
			goto exit;
		}
		index += sprintf(&rbuf[index], "TX:");
		for (i = 0; i < tx + rx; i++) {
			index += sprintf(
				&rbuf[index], "%5d,", *((s16 *)frame_buf + i));
			if ((i + 1) == tx)
				index += sprintf(&rbuf[index], "\nRX:");
		}
		index += sprintf(&rbuf[index], "\n");
	}

exit:
	kfree(frame_buf);
	temp_cmd.cmd = 0x90;
	temp_cmd.data[0] = 0;
	temp_cmd.len = 5;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
	/* enable irq & esd */
	cd->hw_ops->irq_enable(cd, true);
	goodix_ts_blocking_notify(NOTIFY_ESD_ON, NULL);
	return ret;
}

static void goodix_set_sense_mode(u8 val)
{
	struct goodix_ts_cmd temp_cmd;

	temp_cmd.len = 4;
	temp_cmd.cmd = 0xA7;

	if (val == 1) {
		/* normal mode */
		index = sprintf(rbuf, "switch to coordinate mode\n");
		cd->hw_ops->send_cmd(cd, &temp_cmd);
		goodix_ts_blocking_notify(NOTIFY_ESD_ON, NULL);
		cd->hw_ops->irq_enable(cd, true);
		atomic_set(&cd->suspended, 0);
	} else if (val == 2) {
		/* gesture mode */
		index = sprintf(rbuf, "switch to gesture mode\n");
		goodix_ts_blocking_notify(NOTIFY_ESD_OFF, NULL);
		cd->hw_ops->gesture(cd, 0);
		cd->hw_ops->irq_enable(cd, true);
		atomic_set(&cd->suspended, 1);
	} else {
		/* sleep mode */
		index = sprintf(rbuf, "switch to sleep mode\n");
		goodix_ts_blocking_notify(NOTIFY_ESD_OFF, NULL);
		cd->hw_ops->irq_enable(cd, false);
		cd->hw_ops->suspend(cd);
	}
}

static void goodix_set_scan_mode(u8 val)
{
	struct goodix_ts_cmd temp_cmd;

	temp_cmd.len = 5;
	temp_cmd.cmd = 0x9F;

	if (val == 0) {
		temp_cmd.data[0] = 0;
		ts_info("set scan mode to default");
		index = sprintf(rbuf, "set scan mode to default\n");
	} else if (val == 1) {
		temp_cmd.data[0] = 3;
		ts_info("set scan mode to idle");
		index = sprintf(rbuf, "set scan mode to idle\n");
	} else {
		temp_cmd.data[0] = 2;
		ts_info("set scan mode to active");
		index = sprintf(rbuf, "set scan mode to active\n");
	}

	cd->hw_ops->send_cmd(cd, &temp_cmd);
}

static void goodix_get_scan_mode(void)
{
	u8 status;

	cd->hw_ops->read(cd, 0x10219, &status, 1);
	ts_info("ic status:%d", status);

	if (status == 1) {
		index = sprintf(rbuf, "normal active\n");
	} else if (status == 2) {
		index = sprintf(rbuf, "normal idle\n");
	} else if (status == 3) {
		index = sprintf(rbuf, "lowpower active\n");
	} else if (status == 4) {
		index = sprintf(rbuf, "lowpower idle\n");
	} else if (status == 5) {
		index = sprintf(rbuf, "sleep\n");
	} else {
		index = sprintf(rbuf, "invalid mode %d\n", status);
	}
}

static void goodix_set_continue_mode(u8 val)
{
	struct goodix_ts_cmd temp_cmd;

	if (val == 0) {
		ts_info("enable continue report");
		index = sprintf(rbuf, "enable continue report\n");
	} else {
		ts_info("disable continue report");
		index = sprintf(rbuf, "disable continue report\n");
	}

	temp_cmd.len = 5;
	temp_cmd.cmd = 0xC6;
	temp_cmd.data[0] = val;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
}

static void goodix_read_config(void)
{
	int ret;
	u8 *cfg_buf;
	u32 cfg_id;
	u8 cfg_ver;

	cfg_buf = kzalloc(GOODIX_CFG_MAX_SIZE, GFP_KERNEL);
	if (cfg_buf == NULL) {
		ts_err("failed to alloc cfg buffer");
		return;
	}

	ret = cd->hw_ops->read_config(cd, cfg_buf, GOODIX_CFG_MAX_SIZE);
	if (ret < 0) {
		ts_err("read config failed");
		goto exit;
	}

	cfg_id = le32_to_cpup((__le32 *)&cfg_buf[30]);
	cfg_ver = cfg_buf[34];
	index = sprintf(
		rbuf, "config_id:0x%X config_ver:0x%02X\n", cfg_id, cfg_ver);

exit:
	kfree(cfg_buf);
}

static void goodix_get_fw_status(void)
{
	u32 status_addr;
	u32 noise_lv_addr;
	u32 offset;
	u8 val;

	offset = cd->ic_info.misc.frame_data_addr +
		 cd->ic_info.misc.frame_data_head_len +
		 cd->ic_info.misc.fw_attr_len;
	status_addr = offset + 38;
	noise_lv_addr = offset + 65;

	cd->hw_ops->read(cd, 0x1021A, &val, 1);
	index += sprintf(
		&rbuf[index], "coordfilter_status[%d] ", (val >> 7) & 0x01);
	index += sprintf(
		&rbuf[index], "set_highsense_mode[%d] ", (val >> 6) & 0x01);
	index +=
		sprintf(&rbuf[index], "set_noise_mode[%d] ", (val >> 4) & 0x03);
	index +=
		sprintf(&rbuf[index], "set_water_mode[%d] ", (val >> 3) & 0x01);
	index += sprintf(&rbuf[index], "set_grip_mode[%d] ", (val >> 2) & 0x01);
	index += sprintf(&rbuf[index], "set_palm_mode[%d] ", (val >> 1) & 0x01);
	index += sprintf(
		&rbuf[index], "set_heatmap_mode[%d]\n", (val >> 0) & 0x01);

	cd->hw_ops->read(cd, status_addr, &val, 1);
	ts_info("addr:0x%04x fw_status:0x%02X", status_addr, val);
	index += sprintf(
		&rbuf[index], "touch[%d] ", (val & (0x01 << 0)) ? 1 : 0);
	index +=
		sprintf(&rbuf[index], "game[%d] ", (val & (0x01 << 1)) ? 1 : 0);
	index +=
		sprintf(&rbuf[index], "palm[%d] ", (val & (0x01 << 2)) ? 1 : 0);
	index += sprintf(
		&rbuf[index], "water[%d] ", (val & (0x01 << 3)) ? 1 : 0);
	index += sprintf(
		&rbuf[index], "charge[%d] ", (val & (0x01 << 4)) ? 1 : 0);
	index += sprintf(
		&rbuf[index], "lowtemp[%d] ", (val & (0x01 << 5)) ? 1 : 0);

	cd->hw_ops->read(cd, noise_lv_addr, &val, 1);
	ts_info("noise level addr: 0x%04x", noise_lv_addr);
	index += sprintf(&rbuf[index], "noise-lv[%d]\n", val);
}

static void goodix_set_highsense_mode(u8 val)
{
	struct goodix_ts_cmd temp_cmd;
	static bool flag = false;

	if (val == 0 && flag) {
		flag = false;
		ts_info("exit highsense mode");
		index = sprintf(rbuf, "exit highsense mode\n");
	} else if (val == 1 && !flag) {
		flag = true;
		ts_info("enter highsense mode");
		index = sprintf(rbuf, "enter highsense mode\n");
	} else {
		ts_info("have already %s", val ? "ON" : "OFF");
		return;
	}

	temp_cmd.len = 5;
	temp_cmd.cmd = 0x72;
	temp_cmd.data[0] = val;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
}

static void goodix_set_grip_data(u8 val)
{
	struct goodix_ts_cmd temp_cmd;

	if (val == 0) {
		ts_info("portrait mode");
		index = sprintf(rbuf, "portrait mode\n");
		temp_cmd.len = 4;
		temp_cmd.cmd = 0x18;
	} else if (val == 1) {
		ts_info("landscape left");
		index = sprintf(rbuf, "landscape left\n");
		temp_cmd.len = 5;
		temp_cmd.cmd = 0x17;
		temp_cmd.data[0] = 0;
	} else if (val == 2) {
		ts_info("landscape right");
		index = sprintf(rbuf, "landscape right\n");
		temp_cmd.len = 5;
		temp_cmd.cmd = 0x17;
		temp_cmd.data[0] = 1;
	} else {
		ts_err("invalid grip data, %d", val);
		return;
	}

	cd->hw_ops->send_cmd(cd, &temp_cmd);
}

static void goodix_set_custom_mode(u8 type, u8 val)
{
	struct goodix_ts_cmd temp_cmd;

	if (type == PALM_FUNC) {
		index = sprintf(&rbuf[index], "set palm %s\n",
			val ? "enabled" : "disabled");
	} else if (type == NOISE_FUNC) {
		if (val == 0) {
			index = sprintf(&rbuf[index], "set noise disabled\n");
		} else if (val == 1) {
			index = sprintf(&rbuf[index], "set noise enabled\n");
		} else if (val == 2) {
			index = sprintf(&rbuf[index], "set noise lv0\n");
		} else {
			index = sprintf(&rbuf[index], "set noise lv1\n");
		}
	} else if (type == WATER_FUNC) {
		index = sprintf(&rbuf[index], "set water %s\n",
			val ? "enabled" : "disabled");
	} else if (type == GRIP_FUNC) {
		index = sprintf(&rbuf[index], "set grip %s\n",
			val ? "enabled" : "disabled");
	} else {
		ts_err("invalid type, %d", type);
		return;
	}

	temp_cmd.len = 6;
	temp_cmd.cmd = 0xC7;
	temp_cmd.data[0] = type;
	temp_cmd.data[1] = val;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
}

static int obtain_param(char **buf)
{
	char *token;
	int val;

	token = strsep(buf, ",");
	if (!token) {
		if (kstrtos32(*buf, 10, &val))
			return -EINVAL;
	} else {
		if (kstrtos32(token, 10, &val))
			return -EINVAL;
	}

	return val;
}

static int goodix_parse_gesture_param(u8 type, char **buf)
{
	if (type == GESTURE_STTW) {
		gesture_param_st.length = sizeof(gesture_param_st);
		gesture_param_st.type = type;
		gesture_param_st.st_min_x = obtain_param(buf);
		gesture_param_st.st_max_x = obtain_param(buf);
		gesture_param_st.st_min_y = obtain_param(buf);
		gesture_param_st.st_max_y = obtain_param(buf);
		gesture_param_st.st_min_count = obtain_param(buf);
		gesture_param_st.st_max_count = obtain_param(buf);
		gesture_param_st.st_motion_tolerance = obtain_param(buf);
		gesture_param_st.st_max_size = obtain_param(buf);
		goodix_append_checksum(gesture_param_st.buf,
			sizeof(gesture_param_st) - 2, CHECKSUM_MODE_U8_LE);
		ts_info("st_min_x:                  %d",
			gesture_param_st.st_min_x);
		ts_info("st_max_x:                  %d",
			gesture_param_st.st_max_x);
		ts_info("st_min_y:                  %d",
			gesture_param_st.st_min_y);
		ts_info("st_max_y:                  %d",
			gesture_param_st.st_max_y);
		ts_info("st_min_count:              %d",
			gesture_param_st.st_min_count);
		ts_info("st_max_count:              %d",
			gesture_param_st.st_max_count);
		ts_info("st_motion_tolerance:       %d",
			gesture_param_st.st_motion_tolerance);
		ts_info("st_max_size:               %d",
			gesture_param_st.st_max_size);
	} else {
		gesture_param_lp.length = sizeof(gesture_param_lp);
		gesture_param_lp.type = type;
		gesture_param_lp.lp_min_x = obtain_param(buf);
		gesture_param_lp.lp_max_x = obtain_param(buf);
		gesture_param_lp.lp_min_y = obtain_param(buf);
		gesture_param_lp.lp_max_y = obtain_param(buf);
		gesture_param_lp.lp_min_count = obtain_param(buf);
		gesture_param_lp.lp_max_size = obtain_param(buf);
		gesture_param_lp.lp_marginal_min_x = obtain_param(buf);
		gesture_param_lp.lp_marginal_max_x = obtain_param(buf);
		gesture_param_lp.lp_marginal_min_y = obtain_param(buf);
		gesture_param_lp.lp_marginal_max_y = obtain_param(buf);
		gesture_param_lp.lp_monitor_chan_min_tx = obtain_param(buf);
		gesture_param_lp.lp_monitor_chan_max_tx = obtain_param(buf);
		gesture_param_lp.lp_monitor_chan_min_rx = obtain_param(buf);
		gesture_param_lp.lp_monitor_chan_max_rx = obtain_param(buf);
		gesture_param_lp.lp_min_node_count = obtain_param(buf);
		gesture_param_lp.lp_motion_tolerance_inner = obtain_param(buf);
		gesture_param_lp.lp_motion_tolerance_outer = obtain_param(buf);
		goodix_append_checksum(gesture_param_lp.buf,
			sizeof(gesture_param_lp) - 2, CHECKSUM_MODE_U8_LE);
		ts_info("lp_min_x:                  %d",
			gesture_param_lp.lp_min_x);
		ts_info("lp_max_x:                  %d",
			gesture_param_lp.lp_max_x);
		ts_info("lp_min_y:                  %d",
			gesture_param_lp.lp_min_y);
		ts_info("lp_max_y:                  %d",
			gesture_param_lp.lp_max_y);
		ts_info("lp_min_count:              %d",
			gesture_param_lp.lp_min_count);
		ts_info("lp_max_size:               %d",
			gesture_param_lp.lp_max_size);
		ts_info("lp_marginal_min_x:         %d",
			gesture_param_lp.lp_marginal_min_x);
		ts_info("lp_marginal_max_x:         %d",
			gesture_param_lp.lp_marginal_max_x);
		ts_info("lp_marginal_min_y:         %d",
			gesture_param_lp.lp_marginal_min_y);
		ts_info("lp_marginal_max_y:         %d",
			gesture_param_lp.lp_marginal_max_y);
		ts_info("lp_monitor_chan_min_tx:    %d",
			gesture_param_lp.lp_monitor_chan_min_tx);
		ts_info("lp_monitor_chan_max_tx:    %d",
			gesture_param_lp.lp_monitor_chan_max_tx);
		ts_info("lp_monitor_chan_min_rx:    %d",
			gesture_param_lp.lp_monitor_chan_min_rx);
		ts_info("lp_monitor_chan_max_rx:    %d",
			gesture_param_lp.lp_monitor_chan_max_rx);
		ts_info("lp_min_node_count:         %d",
			gesture_param_lp.lp_min_node_count);
		ts_info("lp_motion_tolerance_inner: %d",
			gesture_param_lp.lp_motion_tolerance_inner);
		ts_info("lp_motion_tolerance_outer: %d",
			gesture_param_lp.lp_motion_tolerance_outer);
	}

	return 0;
}

static void goodix_set_gesture_param(u8 type)
{
	struct goodix_ts_cmd temp_cmd;
	u32 cmd_reg = cd->ic_info.misc.cmd_addr;
	u32 fw_buffer_addr = cd->ic_info.misc.fw_buffer_addr;
	int retry;
	u8 status;

	temp_cmd.len = 4;
	temp_cmd.cmd = 0xC8;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
	retry = 20;
	while (retry--) {
		usleep_range(5000, 5100);
		cd->hw_ops->read(cd, cmd_reg, &status, 1);
		if (status == 0x80)
			break;
	}
	if (retry < 0) {
		ts_err("failed to start write gesture param, status[%x]",
			status);
		goto exit;
	}
	if (type == GESTURE_STTW) {
		ts_info("STTW param:%*ph", gesture_param_st.length,
			gesture_param_st.buf);
		cd->hw_ops->write(cd, fw_buffer_addr, gesture_param_st.buf,
			sizeof(gesture_param_st));
	} else {
		ts_info("LPTW param:%*ph", gesture_param_lp.length,
			gesture_param_lp.buf);
		cd->hw_ops->write(cd, fw_buffer_addr, gesture_param_lp.buf,
			sizeof(gesture_param_lp));
	}

	temp_cmd.len = 4;
	temp_cmd.cmd = 0x05;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
	retry = 20;
	while (retry--) {
		usleep_range(5000, 5100);
		cd->hw_ops->read(cd, cmd_reg, &status, 1);
		if (status == 0x80 || status == 0x03)
			break;
	}
	if (retry < 0) {
		ts_err("failed to update gesture param, status[%x]", status);
		goto exit;
	}

	if (status == 0x80) {
		ts_info("update gesture param OK");
		index = sprintf(rbuf, "update gesture param OK\n");
	} else {
		ts_info("update gesture param FAIL");
		index = sprintf(rbuf, "update gesture param FAIL\n");
	}

exit:
	temp_cmd.len = 4;
	temp_cmd.cmd = 0x06;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
}

static void goodix_set_heatmap(int val)
{
	struct goodix_ts_cmd temp_cmd;

	cd->hw_ops->irq_enable(cd, false);
	if (val == 0) {
		index = sprintf(rbuf, "disable heatmap\n");
		temp_cmd.len = 5;
		temp_cmd.cmd = 0xC9;
		temp_cmd.data[0] = 0;
	} else {
		index = sprintf(rbuf, "enable heatmap\n");
		temp_cmd.len = 5;
		temp_cmd.cmd = 0xC9;
		temp_cmd.data[0] = 1;
	}
	cd->hw_ops->send_cmd(cd, &temp_cmd);
	cd->hw_ops->irq_enable(cd, true);
}

static void goodix_get_self_compensation(void)
{
	u8 *cfg;
	u8 *cfg_buf;
	int len;
	int cfg_num;
	int sub_cfg_index;
	int sub_cfg_len;
	int tx = cd->ic_info.parm.drv_num;
	int rx = cd->ic_info.parm.sen_num;
	s16 val;
	int i, j;

	cfg_buf = kzalloc(GOODIX_CFG_MAX_SIZE, GFP_KERNEL);
	if (cfg_buf == NULL) {
		ts_err("failed to alloc cfg buffer");
		return;
	}

	len = cd->hw_ops->read_config(cd, cfg_buf, GOODIX_CFG_MAX_SIZE);
	if (len < 0) {
		ts_err("read config failed");
		goto exit;
	}

	cfg = cfg_buf;
	cfg_num = cfg[61];
	cfg += 64;
	for (i = 0; i < cfg_num; i++) {
		sub_cfg_len = cfg[0] - 2;
		sub_cfg_index = cfg[1];
		if (sub_cfg_index == 13) { // TX self cancel
			ts_info("sub_cfg_len:%d", sub_cfg_len);
			index += sprintf(&rbuf[index], "Tx:");
			for (j = 0; j < tx; j++) {
				val = le16_to_cpup((__le16 *)&cfg[2 + j * 4]) +
				      le16_to_cpup((__le16 *)&cfg[4 + j * 4]);
				index += sprintf(&rbuf[index], "%d,", val);
			}
			index += sprintf(&rbuf[index], "\n");
		} else if (sub_cfg_index == 14) { // RX self cancel
			ts_info("sub_cfg_len:%d", sub_cfg_len);
			index += sprintf(&rbuf[index], "Rx:");
			for (j = 0; j < rx; j++) {
				val = le16_to_cpup((__le16 *)&cfg[2 + j * 2]);
				index += sprintf(&rbuf[index], "%d,", val);
			}
			index += sprintf(&rbuf[index], "\n");
		}
		cfg += (sub_cfg_len + 2);
	}
exit:
	kfree(cfg_buf);
}

static void goodix_set_report_rate(int rate)
{
	struct goodix_ts_cmd temp_cmd;

	index = sprintf(rbuf, "set report rate %d\n", rate);
	ts_info("set report rate %d", rate);
	temp_cmd.len = 5;
	temp_cmd.cmd = 0x9D;
	temp_cmd.data[0] = rate;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
}

#define DUMP_AREA1_ADDR 0x10194
#define DUMP_AREA1_LEN 132
#define DUMP_AREA2_ADDR 0x10400
#define DUMP_AREA2_LEN 596
#define DUMP_AREA3_ADDR 0x10308
#define DUMP_AREA3_LEN 64
static void goodix_get_dump_log(void)
{
	u8 buf[600];
	int i;

	cd->hw_ops->read(cd, DUMP_AREA1_ADDR, buf, DUMP_AREA1_LEN);
	index += sprintf(&rbuf[index], "0x%04x:\n", DUMP_AREA1_ADDR);
	for (i = 0; i < DUMP_AREA1_LEN; i++) {
		index += sprintf(&rbuf[index], "%02x,", buf[i]);
		if ((i + 1) % 32 == 0)
			index += sprintf(&rbuf[index], "\n");
	}

	cd->hw_ops->read(cd, DUMP_AREA2_ADDR, buf, DUMP_AREA2_LEN);
	index += sprintf(&rbuf[index], "\n0x%04x:\n", DUMP_AREA2_ADDR);
	for (i = 0; i < DUMP_AREA2_LEN; i++) {
		index += sprintf(&rbuf[index], "%02x,", buf[i]);
		if ((i + 1) % 32 == 0)
			index += sprintf(&rbuf[index], "\n");
	}

	cd->hw_ops->read(cd, DUMP_AREA3_ADDR, buf, DUMP_AREA3_LEN);
	index += sprintf(&rbuf[index], "\n0x%04x:\n", DUMP_AREA3_ADDR);
	for (i = 0; i < DUMP_AREA3_LEN; i++) {
		index += sprintf(&rbuf[index], "%02x,", buf[i]);
		if ((i + 1) % 32 == 0)
			index += sprintf(&rbuf[index], "\n");
	}
}

static void goodix_get_stylus_data(void)
{
	struct goodix_stylus_data stylus_data;
	u8 temp_buf[40] = { 0 };
	u32 flag_addr = cd->ic_info.misc.touch_data_addr;
	int tx = cd->ic_info.parm.drv_num;
	int rx = cd->ic_info.parm.sen_num;
	u32 stylus_struct_addr;
	u8 point_type;
	int touch_num;
	int tx1_coor_x;
	int tx1_coor_y;
	s8 angle_x;
	s8 angle_y;
	int retry = 20;
	int ret;
	int i;

	if (cd->bus->ic_type != IC_TYPE_BERLIN_B) {
		index = sprintf(rbuf, "not support stylus data\n");
		return;
	}

	/* disable irq & close esd */
	cd->hw_ops->irq_enable(cd, false);
	goodix_ts_blocking_notify(NOTIFY_ESD_OFF, NULL);

	/* clean touch event flag */
	ret = cd->hw_ops->write(cd, flag_addr, temp_buf, 1);
	if (ret < 0) {
		ts_err("clean touch event failed, exit!");
		goto exit;
	}

	while (retry--) {
		usleep_range(2000, 2100);
		ret = cd->hw_ops->read(cd, flag_addr, temp_buf, 8 + 16 + 2);
		if (!ret && (temp_buf[0] & 0x80))
			break;
	}
	if (retry < 0) {
		ts_err("touch data is not ready val:0x%02x, exit!",
			temp_buf[0]);
		ret = -EINVAL;
		goto exit;
	}

	touch_num = temp_buf[2] & 0x0F;
	if (touch_num == 0) {
		ts_err("touch num is 0");
		goto exit;
	}
	point_type = temp_buf[8] & 0x0F;
	if (point_type != 0x01 && point_type != 0x03) {
		ts_err("point type is not stylus");
		goto exit;
	}

	tx1_coor_x = le16_to_cpup((__le16 *)(temp_buf + 10));
	tx1_coor_y = le16_to_cpup((__le16 *)(temp_buf + 12));
	angle_x = le16_to_cpup((__le16 *)(temp_buf + 16)) / 100;
	angle_y = le16_to_cpup((__le16 *)(temp_buf + 18)) / 100;

	stylus_struct_addr = cd->ic_info.misc.frame_data_addr +
			     cd->ic_info.misc.frame_data_head_len +
			     cd->ic_info.misc.fw_attr_len +
			     cd->ic_info.misc.fw_log_len;
	ret = cd->hw_ops->read(
		cd, stylus_struct_addr, (u8 *)&stylus_data, sizeof(stylus_data));
	if (ret < 0) {
		ts_err("read stylus struct data failed");
		goto exit;
	}

	index += sprintf(&rbuf[index], "Tx1_rawdata\n");
	for (i = 0; i < tx; i++)
		index += sprintf(&rbuf[index], "%d,", stylus_data.tx1[i]);

	index += sprintf(&rbuf[index], "\nRx1_rawdata\n");
	for (i = 0; i < rx; i++)
		index += sprintf(&rbuf[index], "%d,", stylus_data.rx1[i]);

	index += sprintf(&rbuf[index], "\nTx2_rawdata\n");
	for (i = 0; i < tx; i++)
		index += sprintf(&rbuf[index], "%d,", stylus_data.tx2[i]);

	index += sprintf(&rbuf[index], "\nRx2_rawdata\n");
	for (i = 0; i < rx; i++)
		index += sprintf(&rbuf[index], "%d,", stylus_data.rx2[i]);

	index += sprintf(&rbuf[index], "\nTx1_coordinate_X/Tx1_coordinate_Y\n");
	index += sprintf(&rbuf[index], "%d,%d", tx1_coor_x, tx1_coor_y);

	index += sprintf(&rbuf[index], "\nTx2_coordinate_X/Tx2_coordinate_Y\n");
	index += sprintf(&rbuf[index], "%d,%d", stylus_data.angle_coord_x,
		stylus_data.angle_coord_y);

	index += sprintf(&rbuf[index], "\nRing_delta_X/Ring_delta_Y\n");
	index += sprintf(&rbuf[index], "%d,%d", stylus_data.delta_x,
		stylus_data.delta_y);

	index += sprintf(&rbuf[index], "\nRing_Angle_X/Y\n");
	index += sprintf(&rbuf[index], "%d,%d", angle_x, angle_y);

	index += sprintf(&rbuf[index],
		"\nfreq_indexA/freq_indexB/freq1_noise_level/freq2_noise_level/freq3_noise_level/freq4_noise_level\n");
	index += sprintf(&rbuf[index], "%d,%d,%d,%d,%d,%d\n",
		stylus_data.freq_indexA, stylus_data.freq_indexB,
		stylus_data.stylus_noise_value[0],
		stylus_data.stylus_noise_value[1],
		stylus_data.stylus_noise_value[2],
		stylus_data.stylus_noise_value[3]);

exit:
	/* enable irq & esd */
	cd->hw_ops->irq_enable(cd, true);
	goodix_ts_blocking_notify(NOTIFY_ESD_ON, NULL);
}

static void goodix_force_update(void)
{
	int i;
	int ret;

	for (i = 0; i < GOODIX_MAX_CONFIG_GROUP; i++) {
		kfree(cd->ic_configs[i]);
		cd->ic_configs[i] = NULL;
	}

	ret = goodix_get_config_proc(cd);
	if (ret < 0)
		ts_err("not found valid config");

	ret = goodix_do_fw_update(cd->ic_configs[CONFIG_TYPE_NORMAL],
		UPDATE_MODE_BLOCK | UPDATE_MODE_FORCE |
			UPDATE_MODE_SRC_REQUEST);
	if (ret < 0)
		index = sprintf(rbuf, "%s: NG\n", CMD_FW_UPDATE);
	else
		index = sprintf(rbuf, "%s: OK\n", CMD_FW_UPDATE);
}

static void goodix_set_freq_index(int freq)
{
	struct goodix_ts_cmd temp_cmd;

	index = sprintf(rbuf, "set frequency index %d\n", freq);
	ts_info("set frequency index %d", freq);
	temp_cmd.len = 5;
	temp_cmd.cmd = 0x9C;
	temp_cmd.data[0] = freq;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
}

static void goodix_disable_coor_filter(int val)
{
	struct goodix_ts_cmd temp_cmd;

	index = sprintf(rbuf, "disable coordinate filter %d\n", val);
	temp_cmd.len = 5;
	temp_cmd.cmd = 0xCA;
	temp_cmd.data[0] = val ? 1 : 0;
	cd->hw_ops->send_cmd(cd, &temp_cmd);
}

static ssize_t driver_test_write(
	struct file *file, const char __user *buf, size_t count, loff_t *pos)
{
	struct goodix_fw_version fw_ver;
	struct goodix_ic_info ic_info;
	char *p = wbuf;
	char *token;
	int ret;
	int cmd_val;
	int cmd_val2;
	u8 id;

	if (count > SHORT_SIZE) {
		ts_err("invalid cmd size[%ld]", count);
		return count;
	}

	memset(wbuf, 0, sizeof(wbuf));
	if (copy_from_user(p, buf, count) != 0) {
		ts_err("copy from user failed");
		return count;
	}

	vfree(rbuf);
	rbuf = NULL;
	index = 0;
	release_test_resource();

	ts_info("input cmd[%s]", p);

	if (!strncmp(p, CMD_FW_UPDATE, strlen(CMD_FW_UPDATE))) {
		rbuf = vzalloc(SHORT_SIZE);
		goodix_force_update();
		goto exit;
	}

	if (!strncmp(p, CMD_GET_VERSION, strlen(CMD_GET_VERSION))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		cd->hw_ops->read_version(cd, &fw_ver);
		cd->hw_ops->get_ic_info(cd, &ic_info);
		index = sprintf(rbuf, "%s: 0x%02x%02x%02x%02x 0x%x\n",
			CMD_GET_VERSION, fw_ver.patch_vid[0],
			fw_ver.patch_vid[1], fw_ver.patch_vid[2],
			fw_ver.patch_vid[3], ic_info.version.config_id);
		goto exit;
	}

	if (!strncmp(p, CMD_GET_RAWDATA, strlen(CMD_GET_RAWDATA))) {
		rbuf = vzalloc(LARGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = get_cap_data(CMD_GET_RAWDATA);
		if (ret < 0) {
			index = sprintf(rbuf, "%s: NG\n", CMD_GET_RAWDATA);
		}
		goto exit;
	}

	if (!strncmp(p, CMD_GET_BASEDATA, strlen(CMD_GET_BASEDATA))) {
		rbuf = vzalloc(LARGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = get_cap_data(CMD_GET_BASEDATA);
		if (ret < 0) {
			index = sprintf(rbuf, "%s: NG\n", CMD_GET_BASEDATA);
		}
		goto exit;
	}

	if (!strncmp(p, CMD_GET_DIFFDATA, strlen(CMD_GET_DIFFDATA))) {
		rbuf = vzalloc(LARGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = get_cap_data(CMD_GET_DIFFDATA);
		if (ret < 0) {
			index = sprintf(rbuf, "%s: NG\n", CMD_GET_DIFFDATA);
		}
		goto exit;
	}

	if (!strncmp(p, CMD_GET_SELF_RAWDATA, strlen(CMD_GET_SELF_RAWDATA))) {
		rbuf = vzalloc(LARGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = get_cap_data(CMD_GET_SELF_RAWDATA);
		if (ret < 0) {
			index = sprintf(rbuf, "%s: NG\n", CMD_GET_SELF_RAWDATA);
		}
		goto exit;
	}

	if (!strncmp(p, CMD_GET_SELF_DIFFDATA, strlen(CMD_GET_SELF_DIFFDATA))) {
		rbuf = vzalloc(LARGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = get_cap_data(CMD_GET_SELF_DIFFDATA);
		if (ret < 0) {
			index = sprintf(
				rbuf, "%s: NG\n", CMD_GET_SELF_DIFFDATA);
		}
		goto exit;
	}

	if (!strncmp(p, CMD_GET_SELF_BASEDATA, strlen(CMD_GET_SELF_BASEDATA))) {
		rbuf = vzalloc(LARGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = get_cap_data(CMD_GET_SELF_BASEDATA);
		if (ret < 0) {
			index = sprintf(
				rbuf, "%s: NG\n", CMD_GET_SELF_BASEDATA);
		}
		goto exit;
	}

	if (!strncmp(p, CMD_SET_DOUBLE_TAP, strlen(CMD_SET_DOUBLE_TAP))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_DOUBLE_TAP);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_DOUBLE_TAP);
			goto exit;
		}
		if (cmd_val == 0) {
			cd->gesture_type &= ~GESTURE_DOUBLE_TAP;
			index = sprintf(
				rbuf, "%s: disable OK\n", CMD_SET_DOUBLE_TAP);
			ts_info("disable double tap");
		} else {
			cd->gesture_type |= GESTURE_DOUBLE_TAP;
			index = sprintf(
				rbuf, "%s: enable OK\n", CMD_SET_DOUBLE_TAP);
			ts_info("enable single tap");
		}
		goto exit;
	}

	if (!strncmp(p, CMD_SET_SINGLE_TAP, strlen(CMD_SET_SINGLE_TAP))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_SINGLE_TAP);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_SINGLE_TAP);
			goto exit;
		}
		if (cmd_val == 0) {
			cd->gesture_type &= ~GESTURE_SINGLE_TAP;
			index = sprintf(
				rbuf, "%s: disable OK\n", CMD_SET_SINGLE_TAP);
			ts_info("disable single tap");
		} else {
			cd->gesture_type |= GESTURE_SINGLE_TAP;
			index = sprintf(
				rbuf, "%s: enable OK\n", CMD_SET_SINGLE_TAP);
			ts_info("enable single tap");
		}
		goto exit;
	}

	if (!strncmp(p, CMD_SET_LONG_PRESS, strlen(CMD_SET_LONG_PRESS))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_LONG_PRESS);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_LONG_PRESS);
			goto exit;
		}
		if (cmd_val == 0) {
			cd->gesture_type &= ~GESTURE_FOD_PRESS;
			index = sprintf(
				rbuf, "%s: disable OK\n", CMD_SET_LONG_PRESS);
			ts_info("disable long press");
		} else {
			cd->gesture_type |= GESTURE_FOD_PRESS;
			index = sprintf(
				rbuf, "%s: enable OK\n", CMD_SET_LONG_PRESS);
			ts_info("enable long press");
		}
		goto exit;
	}

	if (!strncmp(p, CMD_SET_IRQ_ENABLE, strlen(CMD_SET_IRQ_ENABLE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_IRQ_ENABLE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_IRQ_ENABLE);
			goto exit;
		}
		if (cmd_val == 0) {
			cd->hw_ops->irq_enable(cd, false);
			index = sprintf(
				rbuf, "%s: disable OK\n", CMD_SET_IRQ_ENABLE);
		} else {
			cd->hw_ops->irq_enable(cd, true);
			index = sprintf(
				rbuf, "%s: enable OK\n", CMD_SET_IRQ_ENABLE);
		}
		goto exit;
	}

	if (!strncmp(p, CMD_SET_ESD_ENABLE, strlen(CMD_SET_ESD_ENABLE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_ESD_ENABLE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_ESD_ENABLE);
			goto exit;
		}
		if (cmd_val == 0) {
			goodix_ts_blocking_notify(NOTIFY_ESD_OFF, NULL);
			index = sprintf(
				rbuf, "%s: disable OK\n", CMD_SET_ESD_ENABLE);
		} else {
			goodix_ts_blocking_notify(NOTIFY_ESD_ON, NULL);
			index = sprintf(
				rbuf, "%s: enable OK\n", CMD_SET_ESD_ENABLE);
		}
		goto exit;
	}

	if (!strncmp(p, CMD_SET_DEBUG_LOG, strlen(CMD_SET_DEBUG_LOG))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_DEBUG_LOG);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_DEBUG_LOG);
			goto exit;
		}
		if (cmd_val == 0) {
			debug_log_flag = false;
			index = sprintf(
				rbuf, "%s: disable OK\n", CMD_SET_DEBUG_LOG);
		} else {
			debug_log_flag = true;
			index = sprintf(
				rbuf, "%s: enable OK\n", CMD_SET_DEBUG_LOG);
		}
		goto exit;
	}

	if (!strncmp(p, CMD_AUTO_TEST, strlen(CMD_AUTO_TEST))) {
		raw_data_cnt = 16;
		noise_data_cnt = 1;
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = malloc_test_resource();
		if (ret < 0) {
			ts_err("malloc test resource failed");
			goto exit;
		}
		ts_test->item[GTP_CAP_TEST] = true;
		ts_test->item[GTP_NOISE_TEST] = true;
		ts_test->item[GTP_DELTA_TEST] = true;
		ts_test->item[GTP_SELFCAP_TEST] = true;
		ts_test->item[GTP_SHORT_TEST] = true;
		goodix_auto_test(true);
		goto exit;
	}

	if (!strncmp(p, CMD_GET_CHANNEL_NUM, strlen(CMD_GET_CHANNEL_NUM))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		index = sprintf(rbuf, "TX:%d RX:%d\n", cd->ic_info.parm.drv_num,
			cd->ic_info.parm.sen_num);
		goto exit;
	}

	if (!strncmp(p, CMD_GET_TX_FREQ, strlen(CMD_GET_TX_FREQ))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = get_cap_data(CMD_GET_TX_FREQ);
		if (ret < 0) {
			index = sprintf(rbuf, "%s: NG\n", CMD_GET_TX_FREQ);
		}
		goto exit;
	}

	if (!strncmp(p, CMD_RESET, strlen(CMD_RESET))) {
		cd->hw_ops->irq_enable(cd, false);
		cd->hw_ops->reset(cd, 100);
		cd->hw_ops->irq_enable(cd, true);
		goto exit;
	}

	if (!strncmp(p, CMD_SET_SENSE_MODE, strlen(CMD_SET_SENSE_MODE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_SENSE_MODE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_SENSE_MODE);
			goto exit;
		}
		if (cmd_val > 2 || cmd_val < 0) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_SENSE_MODE);
			goto exit;
		}
		goodix_set_sense_mode(cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_NOISE_TEST, strlen(CMD_NOISE_TEST))) {
		token = strsep(&p, ",");
		if (!token || !p) {
			ts_err("%s: invalid cmd param", CMD_NOISE_TEST);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			ts_err("%s: invalid cmd param", CMD_NOISE_TEST);
			goto exit;
		}
		noise_data_cnt = cmd_val;
		rbuf = vzalloc(noise_data_cnt * 2000 + 5000);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = malloc_test_resource();
		if (ret < 0) {
			ts_err("malloc test resource failed");
			goto exit;
		}
		ts_test->item[GTP_NOISE_TEST] = true;
		goodix_auto_test(false);
		goto exit;
	}

	if (!strncmp(p, CMD_AUTO_NOISE_TEST, strlen(CMD_AUTO_NOISE_TEST))) {
		token = strsep(&p, ",");
		if (!token || !p) {
			ts_err("%s: invalid cmd param", CMD_AUTO_NOISE_TEST);
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			ts_err("%s: invalid cmd param", CMD_AUTO_NOISE_TEST);
			goto exit;
		}
		if (kstrtos32(token, 10, &cmd_val)) {
			ts_err("%s: invalid cmd param", CMD_AUTO_NOISE_TEST);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val2)) {
			ts_err("%s: invalid cmd param", CMD_AUTO_NOISE_TEST);
			goto exit;
		}
		rbuf = vzalloc(HUGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		goodix_auto_noise_test(cmd_val, cmd_val2);
		goto exit;
	}

	if (!strncmp(p, CMD_GET_PACKAGE_ID, strlen(CMD_GET_PACKAGE_ID))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		mutex_lock(&cd->cmd_lock);
		usleep_range(6000, 6100);
		ret = goodix_flash_read(0x1F301, &id, 1);
		mutex_unlock(&cd->cmd_lock);
		if (ret < 0)
			index = sprintf(rbuf, "%s: NG\n", CMD_GET_PACKAGE_ID);
		else
			index = sprintf(
				rbuf, "%s: 0x%x\n", CMD_GET_PACKAGE_ID, id);
		goto exit;
	}

	if (!strncmp(p, CMD_GET_MCU_ID, strlen(CMD_GET_MCU_ID))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		mutex_lock(&cd->cmd_lock);
		usleep_range(6000, 6100);
		ret = goodix_flash_read(0x1F314, &id, 1);
		mutex_unlock(&cd->cmd_lock);
		if (ret < 0)
			index = sprintf(rbuf, "%s: NG\n", CMD_GET_MCU_ID);
		else
			index = sprintf(rbuf, "%s: 0x%x\n", CMD_GET_MCU_ID, id);
		goto exit;
	}

	if (!strncmp(p, CMD_SET_SCAN_MODE, strlen(CMD_SET_SCAN_MODE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_SCAN_MODE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_SCAN_MODE);
			goto exit;
		}
		if (cmd_val > 2 || cmd_val < 0) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_SCAN_MODE);
			goto exit;
		}
		goodix_set_scan_mode(cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_GET_SCAN_MODE, strlen(CMD_GET_SCAN_MODE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		goodix_get_scan_mode();
		goto exit;
	}

	if (!strncmp(p, CMD_SET_CONTINUE_MODE, strlen(CMD_SET_CONTINUE_MODE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_CONTINUE_MODE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_CONTINUE_MODE);
			goto exit;
		}
		if (cmd_val > 1 || cmd_val < 0) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_CONTINUE_MODE);
			goto exit;
		}
		goodix_set_continue_mode(cmd_val);
		goto exit;
	}

	/* open test */
	if (!strncmp(p, CMD_OPEN_TEST, strlen(CMD_OPEN_TEST))) {
		token = strsep(&p, ",");
		if (!token || !p) {
			ts_err("%s: invalid cmd param", CMD_OPEN_TEST);
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			ts_err("%s: invalid cmd param", CMD_OPEN_TEST);
			goto exit;
		}
		if (kstrtos32(token, 10, &cmd_val)) {
			ts_err("%s: invalid cmd param", CMD_OPEN_TEST);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val2)) {
			ts_err("%s: invalid cmd param", CMD_OPEN_TEST);
			goto exit;
		}
		raw_data_cnt = cmd_val;
		rbuf = vzalloc(raw_data_cnt * 5000 + 10000);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = malloc_test_resource();
		if (ret < 0) {
			ts_err("malloc test resource failed");
			goto exit;
		}
		ts_test->item[GTP_CAP_TEST] = true;
		ts_test->freq = cmd_val2;
		goodix_auto_test(false);
		goto exit;
	}

	if (!strncmp(p, CMD_SELF_OPEN_TEST, strlen(CMD_SELF_OPEN_TEST))) {
		rbuf = vzalloc(HUGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = malloc_test_resource();
		if (ret < 0) {
			ts_err("malloc test resource failed");
			goto exit;
		}
		ts_test->item[GTP_SELFCAP_TEST] = true;
		goodix_auto_test(false);
		goto exit;
	}

	if (!strncmp(p, CMD_SHORT_TEST, strlen(CMD_SHORT_TEST))) {
		rbuf = vzalloc(HUGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		ret = malloc_test_resource();
		if (ret < 0) {
			ts_err("malloc test resource failed");
			goto exit;
		}
		ts_test->item[GTP_SHORT_TEST] = true;
		goodix_auto_test(false);
		goto exit;
	}

	if (!strncmp(p, CMD_GET_CONFIG, strlen(CMD_GET_CONFIG))) {
		rbuf = vzalloc(LARGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		goodix_read_config();
		goto exit;
	}

	if (!strncmp(p, CMD_GET_FW_STATUS, strlen(CMD_GET_FW_STATUS))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		goodix_get_fw_status();
		goto exit;
	}

	if (!strncmp(p, CMD_SET_HIGHSENSE_MODE,
		    strlen(CMD_SET_HIGHSENSE_MODE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_HIGHSENSE_MODE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_HIGHSENSE_MODE);
			goto exit;
		}
		if (cmd_val > 1 || cmd_val < 0) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_HIGHSENSE_MODE);
			goto exit;
		}
		goodix_set_highsense_mode(cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_SET_GRIP_DATA, strlen(CMD_SET_GRIP_DATA))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_GRIP_DATA);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_GRIP_DATA);
			goto exit;
		}
		goodix_set_grip_data(cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_SET_GRIP_MODE, strlen(CMD_SET_GRIP_MODE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_GRIP_MODE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_GRIP_MODE);
			goto exit;
		}
		goodix_set_custom_mode(GRIP_FUNC, cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_SET_PALM_MODE, strlen(CMD_SET_PALM_MODE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_PALM_MODE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_PALM_MODE);
			goto exit;
		}
		goodix_set_custom_mode(PALM_FUNC, cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_SET_NOISE_MODE, strlen(CMD_SET_NOISE_MODE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_NOISE_MODE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_NOISE_MODE);
			goto exit;
		}
		goodix_set_custom_mode(NOISE_FUNC, cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_SET_WATER_MODE, strlen(CMD_SET_WATER_MODE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_WATER_MODE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_WATER_MODE);
			goto exit;
		}
		goodix_set_custom_mode(WATER_FUNC, cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_SET_ST_PARAM, strlen(CMD_SET_ST_PARAM))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_ST_PARAM);
			goto exit;
		}
		goodix_parse_gesture_param(GESTURE_STTW, &p);
		goodix_set_gesture_param(GESTURE_STTW);
		goto exit;
	}

	if (!strncmp(p, CMD_SET_LP_PARAM, strlen(CMD_SET_LP_PARAM))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_LP_PARAM);
			goto exit;
		}
		goodix_parse_gesture_param(GESTURE_LPTW, &p);
		goodix_set_gesture_param(GESTURE_LPTW);
		goto exit;
	}

	if (!strncmp(p, CMD_SET_HEATMAP, strlen(CMD_SET_HEATMAP))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_HEATMAP);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_HEATMAP);
			goto exit;
		}
		goodix_set_heatmap(cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_GET_SELF_COMPEN, strlen(CMD_GET_SELF_COMPEN))) {
		rbuf = vzalloc(LARGE_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		goodix_get_self_compensation();
		goto exit;
	}

	if (!strncmp(p, CMD_SET_REPORT_RATE, strlen(CMD_SET_REPORT_RATE))) {
		rbuf = vzalloc(SHORT_SIZE);
		if (!rbuf) {
			ts_err("failed to alloc rbuf");
			goto exit;
		}
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_REPORT_RATE);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_REPORT_RATE);
			goto exit;
		}
		goodix_set_report_rate(cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_GET_DUMP_LOG, strlen(CMD_GET_DUMP_LOG))) {
		rbuf = vzalloc(LARGE_SIZE);
		goodix_get_dump_log();
		goto exit;
	}
	if (!strncmp(p, CMD_GET_STYLUS_DATA, strlen(CMD_GET_STYLUS_DATA))) {
		rbuf = vzalloc(LARGE_SIZE);
		goodix_get_stylus_data();
		goto exit;
	}


	if (!strncmp(p, CMD_GET_STYLUS_DATA, strlen(CMD_GET_STYLUS_DATA))) {
		rbuf = vzalloc(LARGE_SIZE);
		goodix_get_stylus_data();
		goto exit;
	}

	if (!strncmp(p, CMD_SET_FREQ_INDEX, strlen(CMD_SET_FREQ_INDEX))) {
		rbuf = vzalloc(SHORT_SIZE);
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_FREQ_INDEX);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_SET_FREQ_INDEX);
			goto exit;
		}
		goodix_set_freq_index(cmd_val);
		goto exit;
	}

	if (!strncmp(p, CMD_DISABLE_FILTER, strlen(CMD_DISABLE_FILTER))) {
		rbuf = vzalloc(SHORT_SIZE);
		token = strsep(&p, ",");
		if (!token || !p) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_DISABLE_FILTER);
			goto exit;
		}
		if (kstrtos32(p, 10, &cmd_val)) {
			index = sprintf(rbuf, "%s: invalid cmd param\n",
				CMD_DISABLE_FILTER);
			goto exit;
		}
		goodix_disable_coor_filter(cmd_val);
		goto exit;
	}

	rbuf = vzalloc(SHORT_SIZE);
	if (!rbuf) {
		ts_err("failed to alloc rbuf");
		goto exit;
	}
	index = sprintf(rbuf, "not support cmd %s\n", p);
	ts_err("not support cmd[%s]", p);
exit:
	return count;
}

static int cmd_list_show(struct seq_file *m, void *v)
{
	int i = 0;

	if (!m || !v)
		return -EIO;

	while (cmd_list[i] != NULL) {
		seq_printf(m, "%s\n", cmd_list[i]);
		i++;
	}

	return 0;
}

static int cmd_list_open(struct inode *inode, struct file *file)
{
	return single_open(file, cmd_list_show, NULL);
}

#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 6, 0))
static const struct proc_ops driver_test_ops = {
	.proc_open = driver_test_open,
	.proc_read = seq_read,
	.proc_write = driver_test_write,
	.proc_lseek = seq_lseek,
	.proc_release = driver_test_release,
};

static const struct proc_ops cmd_list_ops = {
	.proc_open = cmd_list_open,
	.proc_read = seq_read,
	.proc_lseek = seq_lseek,
	.proc_release = single_release,
};
#else
static const struct file_operations driver_test_ops = {
	.open = driver_test_open,
	.read = seq_read,
	.write = driver_test_write,
	.llseek = seq_lseek,
	.release = driver_test_release,
};

static const struct file_operations cmd_list_ops = {
	.open = cmd_list_open,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
};
#endif

int driver_test_selftest(char* buf)
{
	int ret = 0;

	release_test_resource();
	index = 0;
	if (rbuf != NULL) {
		vfree(rbuf);
		rbuf = NULL;
	}

	raw_data_cnt = 16;
	noise_data_cnt = 1;
	rbuf = vzalloc(SHORT_SIZE);
	if (rbuf == NULL) {
		ts_err("failed to alloc rbuf");
		ret = -ENOMEM;
		goto exit;
	}
	ret = malloc_test_resource();
	if (ret < 0) {
		ts_err("malloc test resource failed");
		goto exit;
	}
	ts_test->item[GTP_CAP_TEST] = true;
	ts_test->item[GTP_NOISE_TEST] = true;
	ts_test->item[GTP_DELTA_TEST] = true;
	ts_test->item[GTP_SELFCAP_TEST] = true;
	ts_test->item[GTP_SHORT_TEST] = true;
	goodix_auto_test(true);

	strlcpy(buf, rbuf, PAGE_SIZE);

exit:
	return ret;
}

int driver_test_proc_init(struct goodix_ts_core *core_data)
{
	struct proc_dir_entry *proc_entry;

	proc_entry = proc_create(
		"goodix_ts/driver_test", 0660, NULL, &driver_test_ops);
	if (!proc_entry) {
		ts_err("failed to create proc entry");
		return -ENOMEM;
	}

	proc_entry =
		proc_create("goodix_ts/cmd_list", 0440, NULL, &cmd_list_ops);

	cd = core_data;
	return 0;
}

void driver_test_proc_remove(void)
{
	remove_proc_entry("goodix_ts/cmd_list", NULL);
	remove_proc_entry("goodix_ts/driver_test", NULL);
}