From 8e4bff4cab0ddac6060645b0715210484d02ff40 Mon Sep 17 00:00:00 2001 From: Yuval Adam <_@yuv.al> Date: Wed, 30 Aug 2017 08:25:59 +0000 Subject: Initial file dump from open source release --- drivers/input/touchscreen/ist30xxb/ist30xxb_misc.c | 1142 ++++++++++++++++++++ 1 file changed, 1142 insertions(+) create mode 100755 drivers/input/touchscreen/ist30xxb/ist30xxb_misc.c (limited to 'drivers/input/touchscreen/ist30xxb/ist30xxb_misc.c') diff --git a/drivers/input/touchscreen/ist30xxb/ist30xxb_misc.c b/drivers/input/touchscreen/ist30xxb/ist30xxb_misc.c new file mode 100755 index 00000000..f91e85ee --- /dev/null +++ b/drivers/input/touchscreen/ist30xxb/ist30xxb_misc.c @@ -0,0 +1,1142 @@ +/* + * Copyright (C) 2010,Imagis Technology Co. Ltd. All Rights Reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + */ + +#include +#include +#include + +#include +#include "ist30xxb_update.h" +#include "ist30xxb_misc.h" + +#define TSP_CH_SCREEN (1) +#define TSP_CH_KEY (2) + +#define TOUCH_NODE_PARSING_DEBUG (0) + +extern struct ist30xx_data *ts_data; + +TSP_INFO ist30xx_tsp_info; +TKEY_INFO ist30xx_tkey_info; + +static u32 *ist30xx_frame_buf; +static u32 *ist30xx_frame_rawbuf; +static u32 *ist30xx_frame_fltbuf; + + +int ist30xx_tkey_update_info(void) +{ + int ret = 0; + u32 tkey_info1, tkey_info2, tkey_info3; + TKEY_INFO *tkey = &ist30xx_tkey_info; + + ret = ist30xx_read_cmd(ts_data->client, CMD_GET_KEY_INFO1, &tkey_info1); + if (ret) return ret; + ret = ist30xx_read_cmd(ts_data->client, CMD_GET_KEY_INFO2, &tkey_info2); + if (ret) return ret; + ret = ist30xx_read_cmd(ts_data->client, CMD_GET_KEY_INFO3, &tkey_info3); + if (ret) return ret; + + tkey->enable = ((tkey_info1 & (0xFF << 24)) ? true : false); + tkey->key_num = (tkey_info1 >> 16) & 0xFF; + tkey->ch_num[0] = (tkey_info2 >> 24) & 0xFF; + tkey->ch_num[1] = (tkey_info2 >> 16) & 0xFF; + tkey->ch_num[2] = (tkey_info2 >> 8) & 0xFF; + tkey->ch_num[3] = tkey_info2 & 0xFF; + tkey->ch_num[4] = (tkey_info3 >> 24) & 0xFF; + + return ret; +} + + +#define TSP_INFO_SWAP_XY (1 << 0) +#define TSP_INFO_FLIP_X (1 << 1) +#define TSP_INFO_FLIP_Y (1 << 2) +int ist30xx_tsp_update_info(void) +{ + int ret = 0; + u32 tsp_ch_num, tsp_swap, tsp_dir; + TSP_INFO *tsp = &ist30xx_tsp_info; + + ret = ist30xx_read_cmd(ts_data->client, CMD_GET_TSP_SWAP_INFO, &tsp_swap); + if (ret) return ret; + + ret = ist30xx_read_cmd(ts_data->client, CMD_GET_TSP_DIRECTION, &tsp_dir); + if (ret) return ret; + + ret = ist30xx_read_cmd(ts_data->client, CMD_GET_TSP_CHNUM1, &tsp_ch_num); + if (ret || !tsp_ch_num) return ret; + + tsp->finger_num = IST30XX_MAX_MT_FINGERS; + + tsp->ch_num.rx = tsp_ch_num >> 16; + tsp->ch_num.tx = tsp_ch_num & 0xFFFF; + + tsp->dir.swap_xy = (tsp_swap & TSP_INFO_SWAP_XY ? true : false); + tsp->dir.flip_x = (tsp_swap & TSP_INFO_FLIP_X ? true : false); + tsp->dir.flip_y = (tsp_swap & TSP_INFO_FLIP_Y ? true : false); + + tsp->node.len = tsp->ch_num.tx * tsp->ch_num.rx; + tsp->height = (tsp->dir.swap_xy ? tsp->ch_num.rx : tsp->ch_num.tx); + tsp->width = (tsp->dir.swap_xy ? tsp->ch_num.tx : tsp->ch_num.rx); + + return ret; +} + + +int ist30xx_check_valid_ch(int ch_tx, int ch_rx) +{ + TKEY_INFO *tkey = &ist30xx_tkey_info; + TSP_INFO *tsp = &ist30xx_tsp_info; + + if ((ch_tx > tsp->ch_num.tx) || (ch_rx > tsp->ch_num.rx)) + return 0; + + if (tkey->enable) { + if (tkey->axis_rx) { + tsp_verb("tx: %d, rx: %d\n", ch_tx, ch_rx); + if (ch_rx == tsp->ch_num.rx - 1) { + tsp_verb("ch_tx: %d\n", ch_tx); + if ((ch_tx == tkey->ch_num[0]) || (ch_tx == tkey->ch_num[1]) || + (ch_tx == tkey->ch_num[2]) || (ch_tx == tkey->ch_num[3]) || + (ch_tx == tkey->ch_num[4])) + return TSP_CH_KEY; + else + return 0; + } + } else { + if (ch_tx == tsp->ch_num.tx - 1) { + if ((ch_rx == tkey->ch_num[0]) || (ch_rx == tkey->ch_num[1]) || + (ch_rx == tkey->ch_num[2]) || (ch_rx == tkey->ch_num[3]) || + (ch_rx == tkey->ch_num[4])) + return TSP_CH_KEY; + else + return 0; + } + } + } + + return TSP_CH_SCREEN; +} + + +int ist30xx_parse_touch_node(u8 flag, struct TSP_NODE_BUF *node) +{ +#if TOUCH_NODE_PARSING_DEBUG + int j; + TSP_INFO *tsp = &ist30xx_tsp_info; +#endif + int i; + u16 *raw = (u16 *)&node->raw; + u16 *base = (u16 *)&node->base; + u16 *filter = (u16 *)&node->filter; + + for (i = 0; i < node->len; i++) { + if (flag & (NODE_FLAG_RAW | NODE_FLAG_BASE)) { + *raw++ = *ist30xx_frame_rawbuf & 0xFFF; + *base++ = (*ist30xx_frame_rawbuf >> 16) & 0xFFF; + + ist30xx_frame_rawbuf++; + } + if (flag & NODE_FLAG_FILTER) + *filter++ = *ist30xx_frame_fltbuf++ & 0xFFF; + } + +#if TOUCH_NODE_PARSING_DEBUG + tsp_info("RAW - %d * %d\n", tsp->ch_num.tx, tsp->ch_num.rx); + for (i = 0; i < tsp->ch_num.tx; i++) { + printk("\n[ TSP ] "); + for (j = 0; j < tsp->ch_num.rx; j++) + printk("%4d ", node->raw[i][j]); + } + + tsp_info("BASE - %d * %d\n", tsp->ch_num.tx, tsp->ch_num.rx); + for (i = 0; i < tsp->ch_num.tx; i++) { + printk("\n[ TSP ] "); + for (j = 0; j < tsp->ch_num.rx; j++) + printk("%4d ", node->base[i][j]); + } + + tsp_info("FILTER - %d * %d\n", tsp->ch_num.tx, tsp->ch_num.rx); + for (i = 0; i < tsp->ch_num.tx; i++) { + printk("\n[ TSP ] "); + for (j = 0; j < tsp->ch_num.rx; j++) + printk("%4d ", node->filter[i][j]); + } +#endif + + return 0; +} + +int print_touch_node(u8 flag, struct TSP_NODE_BUF *node, char *buf, bool ch_tsp) +{ + int i, j; + int count = 0; + int val = 0; + const int msg_len = 128; + char msg[msg_len]; + TSP_INFO *tsp = &ist30xx_tsp_info; + + if (tsp->dir.swap_xy) { + } else { + for (i = 0; i < tsp->ch_num.tx; i++) { + for (j = 0; j < tsp->ch_num.rx; j++) { + if (ch_tsp && (ist30xx_check_valid_ch(i, j) != TSP_CH_SCREEN)) + continue; + + if (flag == NODE_FLAG_RAW) + val = (int)node->raw[i][j]; + else if (flag == NODE_FLAG_BASE) + val = (int)node->base[i][j]; + else if (flag == NODE_FLAG_FILTER) + val = (int)node->filter[i][j]; + else if (flag == NODE_FLAG_DIFF) + val = (int)(node->raw[i][j] - node->base[i][j]); + else + return 0; + + if (val < 0) val = 0; + + count += snprintf(msg, msg_len, "%4d ", val); + strncat(buf, msg, msg_len); + } + + count += snprintf(msg, msg_len, "\n"); + strncat(buf, msg, msg_len); + } + } + + return count; +} + +int parse_tsp_node(u8 flag, struct TSP_NODE_BUF *node, s16 *buf16) +{ + int i, j; + s16 val = 0; + TSP_INFO *tsp = &ist30xx_tsp_info; + + if ((flag != NODE_FLAG_RAW) && (flag != NODE_FLAG_BASE) && + (flag != NODE_FLAG_FILTER) && (flag != NODE_FLAG_DIFF)) + return -EPERM; + + if (tsp->dir.swap_xy) { + } else { + for (i = 0; i < tsp->ch_num.tx; i++) { + for (j = 0; j < tsp->ch_num.rx; j++) { + if (ist30xx_check_valid_ch(i, j) != TSP_CH_SCREEN) + continue; + + switch ((int)flag) { + case NODE_FLAG_RAW: + val = (s16)node->raw[i][j]; + break; + case NODE_FLAG_BASE: + val = (s16)node->base[i][j]; + break; + case NODE_FLAG_FILTER: + val = (s16)node->filter[i][j]; + break; + case NODE_FLAG_DIFF: + val = (s16)(node->raw[i][j] - node->base[i][j]); + break; + } + + if (val < 0) val = 0; + + *buf16++ = val; + } + } + } + + return 0; +} + + +int ist30xx_read_touch_node(u8 flag, struct TSP_NODE_BUF *node) +{ + int ret = 0; + + ist30xx_disable_irq(ts_data); + ret = ist30xx_cmd_reg(ts_data->client, CMD_ENTER_REG_ACCESS); + if (ret) goto read_tsp_node_end; + + ret = ist30xx_write_cmd(ts_data->client, IST30XX_RX_CNT_ADDR, node->len); + if (ret) goto read_tsp_node_end; + + if (flag & (NODE_FLAG_RAW | NODE_FLAG_BASE)) { + tsp_debug("Reg addr: %x, size: %d\n", IST30XXB_RAW_ADDR, node->len); + ret = ist30xx_read_buf(ts_data->client, IST30XXB_RAW_ADDR, + ist30xx_frame_rawbuf, node->len); + if (ret) goto read_tsp_node_end; + } + if (flag & NODE_FLAG_FILTER) { + tsp_debug("Reg addr: %x, size: %d\n", IST30XXB_FILTER_ADDR, node->len); + ret = ist30xx_read_buf(ts_data->client, IST30XXB_FILTER_ADDR, + ist30xx_frame_fltbuf, node->len); + if (ret) goto read_tsp_node_end; + } + + ret = ist30xx_cmd_reg(ts_data->client, CMD_EXIT_REG_ACCESS); + if (ret) goto read_tsp_node_end; + + ret = ist30xx_cmd_start_scan(ts_data->client); + if (ret) goto read_tsp_node_end; + +read_tsp_node_end: + ist30xx_enable_irq(ts_data); + + return ret; +} + + +/* sysfs: /sys/class/touch/node/refresh */ +ssize_t ist30xx_frame_refresh(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int ret = 0; + TSP_INFO *tsp = &ist30xx_tsp_info; + u8 flag = NODE_FLAG_RAW | NODE_FLAG_BASE | NODE_FLAG_FILTER; + + ret = ist30xx_read_touch_node(flag, &tsp->node); + if (ret) + ret = sprintf(buf, "cmd 1frame raw update fail\n"); + + ret = ist30xx_parse_touch_node(flag, &tsp->node); + + return ret; +} + + +/* sysfs: /sys/class/touch/node/base */ +ssize_t ist30xx_base_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int count = 0; + TSP_INFO *tsp = &ist30xx_tsp_info; + + buf[0] = '\0'; + count = sprintf(buf, "dump ist30xxb baseline(%d)\n", tsp->node.len); + + count += print_touch_node(NODE_FLAG_BASE, &tsp->node, buf, false); + + return count; +} + + +/* sysfs: /sys/class/touch/node/raw */ +ssize_t ist30xx_raw_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int count = 0; + TSP_INFO *tsp = &ist30xx_tsp_info; + + buf[0] = '\0'; + count = sprintf(buf, "dump ist30xxb raw(%d)\n", tsp->node.len); + + count += print_touch_node(NODE_FLAG_RAW, &tsp->node, buf, false); + + return count; +} + + +/* sysfs: /sys/class/touch/node/diff */ +ssize_t ist30xx_diff_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int count = 0; + TSP_INFO *tsp = &ist30xx_tsp_info; + + buf[0] = '\0'; + count = sprintf(buf, "dump ist30xxb difference (%d)\n", tsp->node.len); + + count += print_touch_node(NODE_FLAG_DIFF, &tsp->node, buf, false); + + return count; +} + + +/* sysfs: /sys/class/touch/node/filter */ +ssize_t ist30xx_filter_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int count = 0; + TSP_INFO *tsp = &ist30xx_tsp_info; + + buf[0] = '\0'; + count = sprintf(buf, "dump ist30xxb filter (%d)\n", tsp->node.len); + + count += print_touch_node(NODE_FLAG_FILTER, &tsp->node, buf, false); + + return count; +} + + +extern int calib_ms_delay; +/* sysfs: /sys/class/touch/sys/clb */ +ssize_t ist30xx_calib_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + int ret = -1; + int ms_delay; + + sscanf(buf, "%d", &ms_delay); + + if (ms_delay > 10 && ms_delay < 1000) // 1sec ~ 100sec + calib_ms_delay = ms_delay; + + tsp_info("Calibration wait time %dsec\n", calib_ms_delay / 10); + + ist30xx_disable_irq(ts_data); + ret = ist30xx_cmd_run_device(ts_data->client); + if (ret) { + ist30xx_enable_irq(ts_data); + return size; + } + ist30xx_calibrate(1); + + ist30xx_start(ts_data); + + return size; +} + +ssize_t ist30xx_calib_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int ret; + int count = 0; + u32 value; + + mutex_lock(&ist30xx_mutex); + ist30xx_disable_irq(ts_data); + ret = ist30xx_cmd_run_device(ts_data->client); + if (ret) + goto calib_show_end; + + ret = ist30xx_read_cmd(ts_data->client, CMD_GET_CALIB_RESULT, &value); + if (ret) { + count = sprintf(buf, "Error Read Calibration Result\n"); + goto calib_show_end; + } + + count = sprintf(buf, + "Calibration Status : %d, Max raw gap : %d - (raw: %08x)\n", + CALIB_TO_STATUS(value), CALIB_TO_GAP(value), value); + +calib_show_end: + ist30xx_start(ts_data); + ist30xx_enable_irq(ts_data); + mutex_unlock(&ist30xx_mutex); + + return count; +} + + +/* sysfs: /sys/class/touch/sys/power */ +ssize_t ist30xx_power_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + u32 power_en; + + sscanf(buf, "%d", &power_en); + + tsp_info("Power enable: %d\n", power_en); + if (power_en > 1) { + tsp_err("Unknown argument value, %d\n", power_en); + return size; + } + + if (power_en) { + mutex_lock(&ist30xx_mutex); + ist30xx_internal_resume(ts_data); + ist30xx_enable_irq(ts_data); + mutex_unlock(&ist30xx_mutex); + + ist30xx_start(ts_data); + } else { + mutex_lock(&ist30xx_mutex); + ist30xx_disable_irq(ts_data); + ist30xx_internal_suspend(ts_data); + mutex_unlock(&ist30xx_mutex); + } + + return size; +} + +extern int ist30xx_max_error_cnt; +/* sysfs: /sys/class/touch/sys/errcnt */ +ssize_t ist30xx_errcnt_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + int err_cnt; + + sscanf(buf, "%d", &err_cnt); + + if (err_cnt < 0) return size; + + tsp_info("Request reset error count: %d\n", err_cnt); + + ist30xx_max_error_cnt = err_cnt; + + return size; +} + +#if IST30XX_EVENT_MODE +extern int ist30xx_max_scan_retry; +/* sysfs: /sys/class/touch/sys/scancnt */ +ssize_t ist30xx_scancnt_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + int retry; + + sscanf(buf, "%d", &retry); + + if (retry < 0) return size; + + tsp_info("Timer scan count retry: %d\n", retry); + + ist30xx_max_scan_retry = retry; + + return size; +} + +extern int timer_period_ms; +/* sysfs: /sys/class/touch/sys/timerms */ +ssize_t ist30xx_timerms_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + int ms; + + sscanf(buf, "%d", &ms); + + if ((ms < 0) || (ms > 10000)) return size; + + tsp_info("Timer period ms: %dms\n", ms); + + timer_period_ms = ms; + + return size; +} +#endif + +extern int ist30xx_dbg_level; +/* sysfs: /sys/class/touch/sys/printk */ +ssize_t ist30xx_printk_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + int level; + + sscanf(buf, "%d", &level); + + if ((level < DEV_ERR) || (level > DEV_VERB)) return size; + + tsp_info("prink log level: %d\n", level); + + ist30xx_dbg_level = level; + + return size; +} + +ssize_t ist30xx_printk_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + return sprintf(buf, "prink log level: %d\n", ist30xx_dbg_level); +} + +/* sysfs: /sys/class/touch/sys/dummy */ +ssize_t ist30xx_dummy_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int ret; + int count = 0; + u32 value; + + ist30xx_disable_irq(ts_data); + ret = ist30xx_read_cmd(ts_data->client, CMD_GET_COORD, &value); + if (ret) + count = sprintf(buf, "Error Read Calibration Result\n"); + ist30xx_enable_irq(ts_data); + + count = sprintf(buf, + "Calibration Status : %d, Max raw gap : %d - (raw: %08x)\n", + CALIB_TO_STATUS(value), CALIB_TO_GAP(value), value); + + return count; +} + + +#define TUNES_CMD_WRITE (1) +#define TUNES_CMD_READ (2) +#define TUNES_CMD_REG_ENTER (3) +#define TUNES_CMD_REG_EXIT (4) +#define TUNES_CMD_UPDATE_PARAM (5) +#define TUNES_CMD_UPDATE_FW (6) + +#define DIRECT_ADDR(k) (IST30XXB_DA_ADDR(k)) +#define DIRECT_CMD_WRITE ('w') +#define DIRECT_CMD_READ ('r') + +#pragma pack(1) +typedef struct { + u8 cmd; + u32 addr; + u16 len; +} TUNES_INFO; +#pragma pack() +#pragma pack(1) +typedef struct { + char cmd; + u32 addr; + u32 val; +} DIRECT_INFO; +#pragma pack() + +static TUNES_INFO ist30xx_tunes; +static DIRECT_INFO ist30xx_direct; +static bool tunes_cmd_done = false; +static bool ist30xx_reg_mode = false; + +/* sysfs: /sys/class/touch/sys/direct */ +ssize_t ist30xxb_direct_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + int ret = -EPERM; + DIRECT_INFO *direct = (DIRECT_INFO *)&ist30xx_direct; + + sscanf(buf, "%c %x %x", &direct->cmd, &direct->addr, &direct->val); + + tsp_debug("Direct cmd: %c, addr: %x, val: %x\n", + direct->cmd, direct->addr, direct->val); + + if ((direct->cmd != DIRECT_CMD_WRITE) && (direct->cmd != DIRECT_CMD_READ)) { + tsp_warn("Direct cmd is not correct!\n"); + return size; + } + + if (direct->cmd == DIRECT_CMD_WRITE) { + ret = ist30xx_write_cmd(ts_data->client, DIRECT_ADDR(direct->addr), + direct->val); + ret = ist30xx_read_cmd(ts_data->client, DIRECT_ADDR(direct->addr), + &direct->val); + tsp_debug("Direct write addr: %x, val: %x\n", + direct->addr, direct->val); + } + + return size; +} + +#define DIRECT_BUF_COUNT (4) +ssize_t ist30xxb_direct_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int i, ret, count = 0; + int len; + u32 addr; + u32 buf32[DIRECT_BUF_COUNT]; + int max_len = DIRECT_BUF_COUNT; + const int msg_len = 256; + char msg[msg_len]; + + DIRECT_INFO *direct = (DIRECT_INFO *)&ist30xx_direct; + + if (direct->cmd != DIRECT_CMD_READ) + return sprintf(buf, "ex) echo r addr len > direct\n"); + + len = direct->val; + addr = DIRECT_ADDR(direct->addr); + + ts_data->status.event_mode = false; + ist30xx_disable_irq(ts_data); + while (len > 0) { + if (len < max_len) max_len = len; + + memset(buf32, 0, sizeof(buf32)); + ret = ist30xxb_burst_read(ts_data->client, addr, buf32, max_len); + if (ret) { + count = sprintf(buf, "I2C Burst read fail, addr: %x\n", addr); + break; + } + + for (i = 0; i < max_len; i++) { + count += snprintf(msg, msg_len, "0x%08x ", buf32[i]); + strncat(buf, msg, msg_len); + } + count += snprintf(msg, msg_len, "\n"); + strncat(buf, msg, msg_len); + + addr += max_len * IST30XX_DATA_LEN; + len -= max_len; + } + ist30xx_enable_irq(ts_data); + ts_data->status.event_mode = true; + + tsp_debug("%s", buf); + + return count; +} + +/* sysfs: /sys/class/touch/tunes/regcmd */ +ssize_t tunes_regcmd_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + int ret = -1; + u32 *buf32; + + memcpy(&ist30xx_tunes, buf, sizeof(ist30xx_tunes)); + buf += sizeof(ist30xx_tunes); + buf32 = (u32 *)buf; + + tunes_cmd_done = false; + + switch (ist30xx_tunes.cmd) { + case TUNES_CMD_WRITE: + break; + case TUNES_CMD_READ: + break; + case TUNES_CMD_REG_ENTER: + ist30xx_disable_irq(ts_data); + ret = ist30xx_cmd_run_device(ts_data->client); + if (ret) + goto regcmd_fail; + + /* enter reg access mode */ + ret = ist30xx_cmd_reg(ts_data->client, CMD_ENTER_REG_ACCESS); + if (ret) + goto regcmd_fail; + + ist30xx_reg_mode = true; + + break; + case TUNES_CMD_REG_EXIT: + /* exit reg access mode */ + ret = ist30xx_cmd_reg(ts_data->client, CMD_EXIT_REG_ACCESS); + if (ret) + goto regcmd_fail; + + ret = ist30xx_cmd_start_scan(ts_data->client); + if (ret) + goto regcmd_fail; + + ist30xx_reg_mode = false; + + ist30xx_enable_irq(ts_data); + break; + default: + ist30xx_enable_irq(ts_data); + return size; + } + tunes_cmd_done = true; + + return size; + +regcmd_fail: + tsp_err("Tunes regcmd i2c_fail, ret=%d\n", ret); + return size; +} + +ssize_t tunes_regcmd_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int size; + + size = sprintf(buf, "cmd: 0x%02x, addr: 0x%08x, len: 0x%04x\n", + ist30xx_tunes.cmd, ist30xx_tunes.addr, ist30xx_tunes.len); + + return size; +} + +#define MAX_WRITE_LEN (1) +/* sysfs: /sys/class/touch/tunes/reg */ +ssize_t tunes_reg_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + int ret; + u32 *buf32 = (u32 *)buf; + int waddr, wcnt = 0, len = 0; + + if (ist30xx_tunes.cmd != TUNES_CMD_WRITE) { + tsp_err("error, IST30XX_REG_CMD is not correct!\n"); + return size; + } + + if (!ist30xx_reg_mode) { + tsp_err("error, IST30XX_REG_CMD is not ready!\n"); + return size; + } + + if (!tunes_cmd_done) { + tsp_err("error, IST30XX_REG_CMD is not ready!\n"); + return size; + } + + waddr = ist30xx_tunes.addr; + if (ist30xx_tunes.len >= MAX_WRITE_LEN) + len = MAX_WRITE_LEN; + else + len = ist30xx_tunes.len; + + while (wcnt < ist30xx_tunes.len) { + ret = ist30xx_write_buf(ts_data->client, waddr, buf32, len); + if (ret) { + tsp_err("Tunes regstore i2c_fail, ret=%d\n", ret); + return size; + } + + wcnt += len; + + if ((ist30xx_tunes.len - wcnt) < MAX_WRITE_LEN) + len = ist30xx_tunes.len - wcnt; + + buf32 += MAX_WRITE_LEN; + waddr += MAX_WRITE_LEN * IST30XX_DATA_LEN; + } + + tunes_cmd_done = false; + + return size; +} + +ssize_t tunes_reg_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int ret; + int size; + u32 *buf32 = (u32 *)buf; + +#if I2C_MONOPOLY_MODE + unsigned long flags; +#endif + + if (ist30xx_tunes.cmd != TUNES_CMD_READ) { + tsp_err("error, IST30XX_REG_CMD is not correct!\n"); + return 0; + } + + if (!tunes_cmd_done) { + tsp_err("error, IST30XX_REG_CMD is not ready!\n"); + return 0; + } + + size = ist30xx_tunes.len; + ret = ist30xx_write_cmd(ts_data->client, IST30XX_RX_CNT_ADDR, size); + if (ret) { + tsp_err("Tunes regshow i2c_fail, ret=%d\n", ret); + return 0; + } + +#if I2C_MONOPOLY_MODE + local_irq_save(flags); // Activated only when the GPIO I2C is used +#endif + ret = ist30xx_read_buf(ts_data->client, ist30xx_tunes.addr, buf32, size); +#if I2C_MONOPOLY_MODE + local_irq_restore(flags); // Activated only when the GPIO I2C is used +#endif + if (ret) { + tsp_err("Tunes regshow i2c_fail, ret=%d\n", ret); + return size; + } + + size = ist30xx_tunes.len * IST30XX_DATA_LEN; + + tunes_cmd_done = false; + + return size; +} + + +/* sysfs: /sys/class/touch/tunes/firmware */ +ssize_t tunes_fw_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + ist30xx_get_update_info(ts_data, buf, size); + + mutex_lock(&ist30xx_mutex); + ist30xx_fw_update(ts_data->client, buf, size, true); + mutex_unlock(&ist30xx_mutex); + + ist30xx_calibrate(1); + + ist30xx_init_touch_driver(ts_data); + + return size; +} + + +/* sysfs: /sys/class/touch/tunes/adb */ +ssize_t tunes_adb_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + int ret; + char *tmp, *ptr; + char token[9]; + u32 cmd, addr, len, val; + int write_len; + + sscanf(buf, "%x %x %x", &cmd, &addr, &len); + + switch (cmd) { + case TUNES_CMD_WRITE: /* write cmd */ + write_len = 0; + ptr = (char *)(buf + 15); + + while (write_len < len) { + memcpy(token, ptr, 8); + token[8] = 0; + val = simple_strtoul(token, &tmp, 16); + ret = ist30xx_write_buf(ts_data->client, addr, &val, 1); + if (ret) { + tsp_err("Tunes regstore i2c_fail, ret=%d\n", ret); + return size; + } + + ptr += 8; + write_len++; + addr += 4; + } + break; + + case TUNES_CMD_READ: /* read cmd */ + ist30xx_tunes.cmd = cmd; + ist30xx_tunes.addr = addr; + ist30xx_tunes.len = len; + break; + + case TUNES_CMD_REG_ENTER: /* enter */ + ist30xx_disable_irq(ts_data); + ret = ist30xx_cmd_run_device(ts_data->client); + if (ret < 0) + goto cmd_fail; + + ret = ist30xx_cmd_reg(ts_data->client, CMD_ENTER_REG_ACCESS); + if (ret < 0) + goto cmd_fail; + ist30xx_reg_mode = true; + break; + + case TUNES_CMD_REG_EXIT: /* exit */ + if (ist30xx_reg_mode == true) { + ret = ist30xx_cmd_reg(ts_data->client, CMD_EXIT_REG_ACCESS); + if (ret < 0) + goto cmd_fail; + + ret = ist30xx_cmd_start_scan(ts_data->client); + if (ret < 0) + goto cmd_fail; + ist30xx_reg_mode = false; + ist30xx_enable_irq(ts_data); + } + break; + + default: + break; + } + + return size; + +cmd_fail: + tsp_err("Tunes adb i2c_fail\n"); + return size; +} + +ssize_t tunes_adb_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int ret; + int i, len, size = 0; + char reg_val[10]; + +#if I2C_MONOPOLY_MODE + unsigned long flags; +#endif + + ret = ist30xx_write_cmd(ts_data->client, IST30XX_RX_CNT_ADDR, ist30xx_tunes.len); + if (ret) { + tsp_err("Tunes regshow i2c_fail, ret=%d\n", ret); + return size; + } + +#if I2C_MONOPOLY_MODE + local_irq_save(flags); +#endif + ret = ist30xx_read_buf(ts_data->client, ist30xx_tunes.addr, + ist30xx_frame_buf, ist30xx_tunes.len); +#if I2C_MONOPOLY_MODE + local_irq_restore(flags); +#endif + if (ret) { + tsp_err("Tunes regshow i2c_fail, ret=%d\n", ret); + return size; + } + + size = 0; + buf[0] = 0; + len = sprintf(reg_val, "%08x", ist30xx_tunes.addr); + strcat(buf, reg_val); + size += len; + for (i = 0; i < ist30xx_tunes.len; i++) { + len = sprintf(reg_val, "%08x", ist30xx_frame_buf[i]); + strcat(buf, reg_val); + size += len; + } + + return size; +} + +#if IST30XX_ALGORITHM_MODE +/* sysfs: /sys/class/touch/tunes/algorithm */ +extern u32 ist30xx_algr_addr, ist30xx_algr_size; +ssize_t ist30xx_algr_store(struct device *dev, struct device_attribute *attr, + const char *buf, size_t size) +{ + sscanf(buf, "%x %d", &ist30xx_algr_addr, &ist30xx_algr_size); + tsp_info("Algorithm addr: 0x%x, count: %d\n", + ist30xx_algr_addr, ist30xx_algr_size); + + ist30xx_algr_addr |= IST30XXB_ACCESS_ADDR; + + return size; +} + +ssize_t ist30xx_algr_show(struct device *dev, struct device_attribute *attr, + char *buf) +{ + int ret; + u32 algr_addr; + int count = 0; + + ret = ist30xx_read_cmd(ts_data->client, IST30XXB_MEM_ALGORITHM, &algr_addr); + if (ret) { + tsp_warn("Algorithm mem addr read fail!\n"); + return 0; + } + + tsp_info("algr_addr(0x%x): 0x%x\n", IST30XXB_MEM_ALGORITHM, algr_addr); + + count = sprintf(buf, "Algorithm addr : 0x%x\n", algr_addr); + + return count; +} +#endif // IST30XX_ALGORITHM_MODE + +#define MISC_DEFAULT_ATTR (0644) + +/* sysfs */ +static DEVICE_ATTR(refresh, MISC_DEFAULT_ATTR, ist30xx_frame_refresh, NULL); +static DEVICE_ATTR(filter, MISC_DEFAULT_ATTR, ist30xx_filter_show, NULL); +static DEVICE_ATTR(raw, MISC_DEFAULT_ATTR, ist30xx_raw_show, NULL); +static DEVICE_ATTR(base, MISC_DEFAULT_ATTR, ist30xx_base_show, NULL); +static DEVICE_ATTR(diff, MISC_DEFAULT_ATTR, ist30xx_diff_show, NULL); + +static DEVICE_ATTR(printk, MISC_DEFAULT_ATTR, ist30xx_printk_show, ist30xx_printk_store); +static DEVICE_ATTR(direct, MISC_DEFAULT_ATTR, ist30xxb_direct_show, ist30xxb_direct_store); +static DEVICE_ATTR(clb, MISC_DEFAULT_ATTR, ist30xx_calib_show, ist30xx_calib_store); +static DEVICE_ATTR(tsp_power, MISC_DEFAULT_ATTR, NULL, ist30xx_power_store); +static DEVICE_ATTR(errcnt, MISC_DEFAULT_ATTR, NULL, ist30xx_errcnt_store); +static DEVICE_ATTR(dummy, MISC_DEFAULT_ATTR, ist30xx_dummy_show, NULL); +#if IST30XX_EVENT_MODE +static DEVICE_ATTR(scancnt, MISC_DEFAULT_ATTR, NULL, ist30xx_scancnt_store); +static DEVICE_ATTR(timerms, MISC_DEFAULT_ATTR, NULL, ist30xx_timerms_store); +#endif + +static DEVICE_ATTR(regcmd, MISC_DEFAULT_ATTR, tunes_regcmd_show, tunes_regcmd_store); +static DEVICE_ATTR(reg, MISC_DEFAULT_ATTR, tunes_reg_show, tunes_reg_store); +static DEVICE_ATTR(tunes_fw, MISC_DEFAULT_ATTR, NULL, tunes_fw_store); +static DEVICE_ATTR(adb, MISC_DEFAULT_ATTR, tunes_adb_show, tunes_adb_store); +#if IST30XX_ALGORITHM_MODE +static DEVICE_ATTR(algorithm, MISC_DEFAULT_ATTR, ist30xx_algr_show, ist30xx_algr_store); +#endif + +static struct attribute *node_attributes[] = { + &dev_attr_refresh.attr, + &dev_attr_filter.attr, + &dev_attr_raw.attr, + &dev_attr_base.attr, + &dev_attr_diff.attr, + NULL, +}; + +static struct attribute *sys_attributes[] = { + &dev_attr_printk.attr, + &dev_attr_direct.attr, + &dev_attr_clb.attr, + &dev_attr_tsp_power.attr, + &dev_attr_errcnt.attr, + &dev_attr_dummy.attr, +#if IST30XX_EVENT_MODE + &dev_attr_scancnt.attr, + &dev_attr_timerms.attr, +#endif + NULL, +}; + +static struct attribute *tunes_attributes[] = { + &dev_attr_regcmd.attr, + &dev_attr_reg.attr, + &dev_attr_tunes_fw.attr, + &dev_attr_adb.attr, +#if IST30XX_ALGORITHM_MODE + &dev_attr_algorithm.attr, +#endif + NULL, +}; + +static struct attribute_group node_attr_group = { + .attrs = node_attributes, +}; + +static struct attribute_group sys_attr_group = { + .attrs = sys_attributes, +}; + +static struct attribute_group tunes_attr_group = { + .attrs = tunes_attributes, +}; + +extern struct class *ist30xx_class; +struct device *ist30xx_sys_dev; +struct device *ist30xx_tunes_dev; +struct device *ist30xx_node_dev; + + +int ist30xx_init_misc_sysfs(void) +{ + /* /sys/class/touch/sys */ + ist30xx_sys_dev = device_create(ist30xx_class, NULL, 0, NULL, "sys"); + + /* /sys/class/touch/sys/... */ + if (sysfs_create_group(&ist30xx_sys_dev->kobj, &sys_attr_group)) + tsp_err("Failed to create sysfs group(%s)!\n", "sys"); + + /* /sys/class/touch/tunes */ + ist30xx_tunes_dev = device_create(ist30xx_class, NULL, 0, NULL, "tunes"); + + /* /sys/class/touch/tunes/... */ + if (sysfs_create_group(&ist30xx_tunes_dev->kobj, &tunes_attr_group)) + tsp_err("Failed to create sysfs group(%s)!\n", "tunes"); + + /* /sys/class/touch/node */ + ist30xx_node_dev = device_create(ist30xx_class, NULL, 0, NULL, "node"); + + /* /sys/class/touch/node/... */ + if (sysfs_create_group(&ist30xx_node_dev->kobj, &node_attr_group)) + tsp_err("Failed to create sysfs group(%s)!\n", "node"); + + ist30xx_frame_buf = kmalloc(4096, GFP_KERNEL); + ist30xx_frame_rawbuf = kmalloc(4096, GFP_KERNEL); + ist30xx_frame_fltbuf = kmalloc(4096, GFP_KERNEL); + if (!ist30xx_frame_buf || !ist30xx_frame_rawbuf || !ist30xx_frame_fltbuf) + return -ENOMEM; + + return 0; +} -- cgit v1.3.1