1*4882a593Smuzhiyun /* drivers/input/touchscreen/goodix_tool.c
2*4882a593Smuzhiyun *
3*4882a593Smuzhiyun * 2010 - 2014 Goodix Technology.
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * This program is free software; you can redistribute it and/or modify
6*4882a593Smuzhiyun * it under the terms of the GNU General Public License as published by
7*4882a593Smuzhiyun * the Free Software Foundation; either version 2 of the License, or
8*4882a593Smuzhiyun * (at your option) any later version.
9*4882a593Smuzhiyun *
10*4882a593Smuzhiyun * This program is distributed in the hope that it will be a reference
11*4882a593Smuzhiyun * to you, when you are integrating the GOODiX's CTP IC into your system,
12*4882a593Smuzhiyun * but WITHOUT ANY WARRANTY; without even the implied warranty of
13*4882a593Smuzhiyun * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14*4882a593Smuzhiyun * General Public License for more details.
15*4882a593Smuzhiyun *
16*4882a593Smuzhiyun * Version: 1.4
17*4882a593Smuzhiyun * Release Date: 2015/07/10
18*4882a593Smuzhiyun */
19*4882a593Smuzhiyun
20*4882a593Smuzhiyun #include <linux/delay.h>
21*4882a593Smuzhiyun #include <linux/uaccess.h>
22*4882a593Smuzhiyun #include <linux/proc_fs.h>
23*4882a593Smuzhiyun #include <generated/utsrelease.h>
24*4882a593Smuzhiyun #include "gt1x_generic.h"
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun static ssize_t gt1x_tool_read(struct file *filp, char __user *buffer, size_t count, loff_t *ppos);
27*4882a593Smuzhiyun static ssize_t gt1x_tool_write(struct file *filp, const char *buffer, size_t count, loff_t *ppos);
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun static int gt1x_tool_release(struct inode *inode, struct file *filp);
31*4882a593Smuzhiyun static int gt1x_tool_open(struct inode *inode, struct file *file);
32*4882a593Smuzhiyun
33*4882a593Smuzhiyun #pragma pack(1)
34*4882a593Smuzhiyun typedef struct {
35*4882a593Smuzhiyun u8 wr;
36*4882a593Smuzhiyun u8 flag;
37*4882a593Smuzhiyun u8 flag_addr[2];
38*4882a593Smuzhiyun u8 flag_val;
39*4882a593Smuzhiyun u8 flag_relation;
40*4882a593Smuzhiyun u16 circle;
41*4882a593Smuzhiyun u8 times;
42*4882a593Smuzhiyun u8 retry;
43*4882a593Smuzhiyun u16 delay;
44*4882a593Smuzhiyun u16 data_len;
45*4882a593Smuzhiyun u8 addr_len;
46*4882a593Smuzhiyun u8 addr[2];
47*4882a593Smuzhiyun u8 res[3];
48*4882a593Smuzhiyun u8 *data;
49*4882a593Smuzhiyun } st_cmd_head;
50*4882a593Smuzhiyun #pragma pack()
51*4882a593Smuzhiyun st_cmd_head cmd_head;
52*4882a593Smuzhiyun
53*4882a593Smuzhiyun s32 DATA_LENGTH;
54*4882a593Smuzhiyun s8 IC_TYPE[16] = "GT1X";
55*4882a593Smuzhiyun
56*4882a593Smuzhiyun #define UPDATE_FUNCTIONS
57*4882a593Smuzhiyun #define DATA_LENGTH_UINT 512
58*4882a593Smuzhiyun #define CMD_HEAD_LENGTH (sizeof(st_cmd_head) - sizeof(u8 *))
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun static char procname[20] = { 0 };
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun static struct proc_dir_entry *gt1x_tool_proc_entry;
63*4882a593Smuzhiyun static const struct proc_ops gt1x_tool_fops = {
64*4882a593Smuzhiyun .proc_read = gt1x_tool_read,
65*4882a593Smuzhiyun .proc_write = gt1x_tool_write,
66*4882a593Smuzhiyun .proc_open = gt1x_tool_open,
67*4882a593Smuzhiyun .proc_release = gt1x_tool_release,
68*4882a593Smuzhiyun };
69*4882a593Smuzhiyun
set_tool_node_name(char * procname)70*4882a593Smuzhiyun static void set_tool_node_name(char *procname)
71*4882a593Smuzhiyun {
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun int v0 = 0, v1 = 0, v2 = 0;
74*4882a593Smuzhiyun
75*4882a593Smuzhiyun sscanf(UTS_RELEASE, "%d.%d.%d", &v0, &v1, &v2);
76*4882a593Smuzhiyun sprintf(procname, "gmnode%02d%02d%02d", v0, v1, v2);
77*4882a593Smuzhiyun }
78*4882a593Smuzhiyun
gt1x_init_tool_node(void)79*4882a593Smuzhiyun int gt1x_init_tool_node(void)
80*4882a593Smuzhiyun {
81*4882a593Smuzhiyun memset(&cmd_head, 0, sizeof(cmd_head));
82*4882a593Smuzhiyun /*if the first operation is read, will return fail.*/
83*4882a593Smuzhiyun cmd_head.wr = 1;
84*4882a593Smuzhiyun cmd_head.data = kzalloc(DATA_LENGTH_UINT, GFP_KERNEL);
85*4882a593Smuzhiyun if (NULL == cmd_head.data) {
86*4882a593Smuzhiyun GTP_ERROR("Apply for memory failed.");
87*4882a593Smuzhiyun return -1;
88*4882a593Smuzhiyun }
89*4882a593Smuzhiyun GTP_INFO("Alloc memory size:%d.", DATA_LENGTH_UINT);
90*4882a593Smuzhiyun DATA_LENGTH = DATA_LENGTH_UINT - GTP_ADDR_LENGTH;
91*4882a593Smuzhiyun
92*4882a593Smuzhiyun set_tool_node_name(procname);
93*4882a593Smuzhiyun
94*4882a593Smuzhiyun gt1x_tool_proc_entry = proc_create(procname, 0755, NULL, >1x_tool_fops);
95*4882a593Smuzhiyun if (gt1x_tool_proc_entry == NULL) {
96*4882a593Smuzhiyun GTP_ERROR("CAN't create proc entry /proc/%s.", procname);
97*4882a593Smuzhiyun return -1;
98*4882a593Smuzhiyun } else {
99*4882a593Smuzhiyun GTP_INFO("Created proc entry /proc/%s.", procname);
100*4882a593Smuzhiyun }
101*4882a593Smuzhiyun return 0;
102*4882a593Smuzhiyun }
103*4882a593Smuzhiyun
gt1x_deinit_tool_node(void)104*4882a593Smuzhiyun void gt1x_deinit_tool_node(void)
105*4882a593Smuzhiyun {
106*4882a593Smuzhiyun remove_proc_entry(procname, NULL);
107*4882a593Smuzhiyun kfree(cmd_head.data);
108*4882a593Smuzhiyun cmd_head.data = NULL;
109*4882a593Smuzhiyun }
110*4882a593Smuzhiyun
tool_i2c_read(u8 * buf,u16 len)111*4882a593Smuzhiyun static s32 tool_i2c_read(u8 *buf, u16 len)
112*4882a593Smuzhiyun {
113*4882a593Smuzhiyun u16 addr = (buf[0] << 8) + buf[1];
114*4882a593Smuzhiyun if (!gt1x_i2c_read(addr, &buf[2], len)) {
115*4882a593Smuzhiyun return 1;
116*4882a593Smuzhiyun }
117*4882a593Smuzhiyun return -1;
118*4882a593Smuzhiyun }
119*4882a593Smuzhiyun
tool_i2c_write(u8 * buf,u16 len)120*4882a593Smuzhiyun static s32 tool_i2c_write(u8 *buf, u16 len)
121*4882a593Smuzhiyun {
122*4882a593Smuzhiyun u16 addr = (buf[0] << 8) + buf[1];
123*4882a593Smuzhiyun if (!gt1x_i2c_write(addr, &buf[2], len - 2)) {
124*4882a593Smuzhiyun return 1;
125*4882a593Smuzhiyun }
126*4882a593Smuzhiyun return -1;
127*4882a593Smuzhiyun }
128*4882a593Smuzhiyun
relation(u8 src,u8 dst,u8 rlt)129*4882a593Smuzhiyun static u8 relation(u8 src, u8 dst, u8 rlt)
130*4882a593Smuzhiyun {
131*4882a593Smuzhiyun u8 ret = 0;
132*4882a593Smuzhiyun
133*4882a593Smuzhiyun switch (rlt) {
134*4882a593Smuzhiyun case 0:
135*4882a593Smuzhiyun ret = (src != dst) ? true : false;
136*4882a593Smuzhiyun break;
137*4882a593Smuzhiyun
138*4882a593Smuzhiyun case 1:
139*4882a593Smuzhiyun ret = (src == dst) ? true : false;
140*4882a593Smuzhiyun GTP_DEBUG("equal:src:0x%02x dst:0x%02x ret:%d.", src, dst, (s32) ret);
141*4882a593Smuzhiyun break;
142*4882a593Smuzhiyun
143*4882a593Smuzhiyun case 2:
144*4882a593Smuzhiyun ret = (src > dst) ? true : false;
145*4882a593Smuzhiyun break;
146*4882a593Smuzhiyun
147*4882a593Smuzhiyun case 3:
148*4882a593Smuzhiyun ret = (src < dst) ? true : false;
149*4882a593Smuzhiyun break;
150*4882a593Smuzhiyun
151*4882a593Smuzhiyun case 4:
152*4882a593Smuzhiyun ret = (src & dst) ? true : false;
153*4882a593Smuzhiyun break;
154*4882a593Smuzhiyun
155*4882a593Smuzhiyun case 5:
156*4882a593Smuzhiyun ret = (!(src | dst)) ? true : false;
157*4882a593Smuzhiyun break;
158*4882a593Smuzhiyun
159*4882a593Smuzhiyun default:
160*4882a593Smuzhiyun ret = false;
161*4882a593Smuzhiyun break;
162*4882a593Smuzhiyun }
163*4882a593Smuzhiyun
164*4882a593Smuzhiyun return ret;
165*4882a593Smuzhiyun }
166*4882a593Smuzhiyun
167*4882a593Smuzhiyun /*******************************************************
168*4882a593Smuzhiyun Function:
169*4882a593Smuzhiyun Comfirm function.
170*4882a593Smuzhiyun Input:
171*4882a593Smuzhiyun None.
172*4882a593Smuzhiyun Output:
173*4882a593Smuzhiyun Return write length.
174*4882a593Smuzhiyun ********************************************************/
comfirm(void)175*4882a593Smuzhiyun static u8 comfirm(void)
176*4882a593Smuzhiyun {
177*4882a593Smuzhiyun s32 i = 0;
178*4882a593Smuzhiyun u8 buf[32];
179*4882a593Smuzhiyun
180*4882a593Smuzhiyun memcpy(buf, cmd_head.flag_addr, cmd_head.addr_len);
181*4882a593Smuzhiyun
182*4882a593Smuzhiyun for (i = 0; i < cmd_head.times; i++) {
183*4882a593Smuzhiyun if (tool_i2c_read(buf, 1) <= 0) {
184*4882a593Smuzhiyun GTP_ERROR("Read flag data failed!");
185*4882a593Smuzhiyun return -1;
186*4882a593Smuzhiyun }
187*4882a593Smuzhiyun
188*4882a593Smuzhiyun if (true == relation(buf[GTP_ADDR_LENGTH], cmd_head.flag_val, cmd_head.flag_relation)) {
189*4882a593Smuzhiyun GTP_DEBUG("value at flag addr:0x%02x.", buf[GTP_ADDR_LENGTH]);
190*4882a593Smuzhiyun GTP_DEBUG("flag value:0x%02x.", cmd_head.flag_val);
191*4882a593Smuzhiyun break;
192*4882a593Smuzhiyun }
193*4882a593Smuzhiyun
194*4882a593Smuzhiyun msleep(cmd_head.circle);
195*4882a593Smuzhiyun }
196*4882a593Smuzhiyun
197*4882a593Smuzhiyun if (i >= cmd_head.times) {
198*4882a593Smuzhiyun GTP_ERROR("Didn't get the flag to continue!");
199*4882a593Smuzhiyun return -1;
200*4882a593Smuzhiyun }
201*4882a593Smuzhiyun
202*4882a593Smuzhiyun return 0;
203*4882a593Smuzhiyun }
204*4882a593Smuzhiyun
205*4882a593Smuzhiyun /*******************************************************
206*4882a593Smuzhiyun Function:
207*4882a593Smuzhiyun Goodix tool write function.
208*4882a593Smuzhiyun Input:
209*4882a593Smuzhiyun standard proc write function param.
210*4882a593Smuzhiyun Output:
211*4882a593Smuzhiyun Return write length.
212*4882a593Smuzhiyun ********************************************************/
gt1x_tool_write(struct file * filp,const char __user * buff,size_t len,loff_t * data)213*4882a593Smuzhiyun static ssize_t gt1x_tool_write(struct file *filp, const char __user *buff, size_t len, loff_t *data)
214*4882a593Smuzhiyun {
215*4882a593Smuzhiyun u64 ret = 0;
216*4882a593Smuzhiyun GTP_DEBUG_FUNC();
217*4882a593Smuzhiyun GTP_DEBUG_ARRAY((u8 *) buff, len);
218*4882a593Smuzhiyun
219*4882a593Smuzhiyun ret = copy_from_user(&cmd_head, buff, CMD_HEAD_LENGTH);
220*4882a593Smuzhiyun if (ret) {
221*4882a593Smuzhiyun GTP_ERROR("copy_from_user failed.");
222*4882a593Smuzhiyun }
223*4882a593Smuzhiyun
224*4882a593Smuzhiyun GTP_DEBUG("wr :0x%02x.", cmd_head.wr);
225*4882a593Smuzhiyun /*
226*4882a593Smuzhiyun GTP_DEBUG("flag:0x%02x.", cmd_head.flag);
227*4882a593Smuzhiyun GTP_DEBUG("flag addr:0x%02x%02x.", cmd_head.flag_addr[0], cmd_head.flag_addr[1]);
228*4882a593Smuzhiyun GTP_DEBUG("flag val:0x%02x.", cmd_head.flag_val);
229*4882a593Smuzhiyun GTP_DEBUG("flag rel:0x%02x.", cmd_head.flag_relation);
230*4882a593Smuzhiyun GTP_DEBUG("circle :%d.", (s32)cmd_head.circle);
231*4882a593Smuzhiyun GTP_DEBUG("times :%d.", (s32)cmd_head.times);
232*4882a593Smuzhiyun GTP_DEBUG("retry :%d.", (s32)cmd_head.retry);
233*4882a593Smuzhiyun GTP_DEBUG("delay :%d.", (s32)cmd_head.delay);
234*4882a593Smuzhiyun GTP_DEBUG("data len:%d.", (s32)cmd_head.data_len);
235*4882a593Smuzhiyun GTP_DEBUG("addr len:%d.", (s32)cmd_head.addr_len);
236*4882a593Smuzhiyun GTP_DEBUG("addr:0x%02x%02x.", cmd_head.addr[0], cmd_head.addr[1]);
237*4882a593Smuzhiyun GTP_DEBUG("len:%d.", (s32)len);
238*4882a593Smuzhiyun GTP_DEBUG("buf[20]:0x%02x.", buff[CMD_HEAD_LENGTH]);
239*4882a593Smuzhiyun */
240*4882a593Smuzhiyun
241*4882a593Smuzhiyun if (1 == cmd_head.wr) {
242*4882a593Smuzhiyun u16 addr, data_len, pos;
243*4882a593Smuzhiyun
244*4882a593Smuzhiyun if (1 == cmd_head.flag) {
245*4882a593Smuzhiyun if (comfirm()) {
246*4882a593Smuzhiyun GTP_ERROR("[WRITE]Comfirm fail!");
247*4882a593Smuzhiyun return -1;
248*4882a593Smuzhiyun }
249*4882a593Smuzhiyun } else if (2 == cmd_head.flag) {
250*4882a593Smuzhiyun /*Need interrupt!*/
251*4882a593Smuzhiyun }
252*4882a593Smuzhiyun
253*4882a593Smuzhiyun addr = (cmd_head.addr[0] << 8) + cmd_head.addr[1];
254*4882a593Smuzhiyun data_len = cmd_head.data_len;
255*4882a593Smuzhiyun pos = 0;
256*4882a593Smuzhiyun while (data_len > 0) {
257*4882a593Smuzhiyun len = data_len > DATA_LENGTH ? DATA_LENGTH : data_len;
258*4882a593Smuzhiyun ret = copy_from_user(&cmd_head.data[GTP_ADDR_LENGTH], &buff[CMD_HEAD_LENGTH + pos], len);
259*4882a593Smuzhiyun if (ret) {
260*4882a593Smuzhiyun GTP_ERROR("[WRITE]copy_from_user failed.");
261*4882a593Smuzhiyun return -1;
262*4882a593Smuzhiyun }
263*4882a593Smuzhiyun cmd_head.data[0] = ((addr >> 8) & 0xFF);
264*4882a593Smuzhiyun cmd_head.data[1] = (addr & 0xFF);
265*4882a593Smuzhiyun
266*4882a593Smuzhiyun GTP_DEBUG_ARRAY(cmd_head.data, len + GTP_ADDR_LENGTH);
267*4882a593Smuzhiyun
268*4882a593Smuzhiyun if (tool_i2c_write(cmd_head.data, len + GTP_ADDR_LENGTH) <= 0) {
269*4882a593Smuzhiyun GTP_ERROR("[WRITE]Write data failed!");
270*4882a593Smuzhiyun return -1;
271*4882a593Smuzhiyun }
272*4882a593Smuzhiyun addr += len;
273*4882a593Smuzhiyun pos += len;
274*4882a593Smuzhiyun data_len -= len;
275*4882a593Smuzhiyun }
276*4882a593Smuzhiyun
277*4882a593Smuzhiyun if (cmd_head.delay) {
278*4882a593Smuzhiyun msleep(cmd_head.delay);
279*4882a593Smuzhiyun }
280*4882a593Smuzhiyun return cmd_head.data_len + CMD_HEAD_LENGTH;
281*4882a593Smuzhiyun } else if (3 == cmd_head.wr) { /* gt1x unused */
282*4882a593Smuzhiyun memcpy(IC_TYPE, cmd_head.data, min((u16)sizeof(IC_TYPE), cmd_head.data_len));
283*4882a593Smuzhiyun return cmd_head.data_len + CMD_HEAD_LENGTH;
284*4882a593Smuzhiyun } else if (5 == cmd_head.wr) { /* ? */
285*4882a593Smuzhiyun /*memcpy(IC_TYPE, cmd_head.data, cmd_head.data_len);*/
286*4882a593Smuzhiyun return cmd_head.data_len + CMD_HEAD_LENGTH;
287*4882a593Smuzhiyun } else if (7 == cmd_head.wr) { /* disable irq! */
288*4882a593Smuzhiyun gt1x_irq_disable();
289*4882a593Smuzhiyun #if GTP_ESD_PROTECT
290*4882a593Smuzhiyun gt1x_esd_switch(SWITCH_OFF);
291*4882a593Smuzhiyun #endif
292*4882a593Smuzhiyun return CMD_HEAD_LENGTH;
293*4882a593Smuzhiyun } else if (9 == cmd_head.wr) { /* enable irq! */
294*4882a593Smuzhiyun gt1x_irq_enable();
295*4882a593Smuzhiyun #if GTP_ESD_PROTECT
296*4882a593Smuzhiyun gt1x_esd_switch(SWITCH_ON);
297*4882a593Smuzhiyun #endif
298*4882a593Smuzhiyun return CMD_HEAD_LENGTH;
299*4882a593Smuzhiyun } else if (17 == cmd_head.wr) {
300*4882a593Smuzhiyun ret = copy_from_user(&cmd_head.data[GTP_ADDR_LENGTH], &buff[CMD_HEAD_LENGTH], cmd_head.data_len);
301*4882a593Smuzhiyun if (ret) {
302*4882a593Smuzhiyun GTP_ERROR("copy_from_user failed.");
303*4882a593Smuzhiyun return -1;
304*4882a593Smuzhiyun }
305*4882a593Smuzhiyun
306*4882a593Smuzhiyun if (cmd_head.data[GTP_ADDR_LENGTH]) {
307*4882a593Smuzhiyun GTP_DEBUG("gtp enter rawdiff.");
308*4882a593Smuzhiyun gt1x_rawdiff_mode = true;
309*4882a593Smuzhiyun } else {
310*4882a593Smuzhiyun gt1x_rawdiff_mode = false;
311*4882a593Smuzhiyun GTP_DEBUG("gtp leave rawdiff.");
312*4882a593Smuzhiyun }
313*4882a593Smuzhiyun
314*4882a593Smuzhiyun return CMD_HEAD_LENGTH;
315*4882a593Smuzhiyun } else if (11 == cmd_head.wr) {
316*4882a593Smuzhiyun gt1x_enter_update_mode();
317*4882a593Smuzhiyun } else if (13 == cmd_head.wr) {
318*4882a593Smuzhiyun gt1x_leave_update_mode();
319*4882a593Smuzhiyun } else if (15 == cmd_head.wr) {
320*4882a593Smuzhiyun struct task_struct *thrd = NULL;
321*4882a593Smuzhiyun memset(cmd_head.data, 0, cmd_head.data_len + 1);
322*4882a593Smuzhiyun memcpy(cmd_head.data, &buff[CMD_HEAD_LENGTH], cmd_head.data_len);
323*4882a593Smuzhiyun GTP_DEBUG("update firmware, filename: %s", cmd_head.data);
324*4882a593Smuzhiyun thrd = kthread_run(gt1x_update_firmware, (void *)cmd_head.data, "GT1x FW Update");
325*4882a593Smuzhiyun if (IS_ERR(thrd)) {
326*4882a593Smuzhiyun return PTR_ERR(thrd);
327*4882a593Smuzhiyun }
328*4882a593Smuzhiyun }
329*4882a593Smuzhiyun return CMD_HEAD_LENGTH;
330*4882a593Smuzhiyun }
331*4882a593Smuzhiyun
332*4882a593Smuzhiyun static u8 devicecount;
gt1x_tool_open(struct inode * inode,struct file * file)333*4882a593Smuzhiyun static int gt1x_tool_open(struct inode *inode, struct file *file)
334*4882a593Smuzhiyun {
335*4882a593Smuzhiyun if (devicecount > 0) {
336*4882a593Smuzhiyun return -ERESTARTSYS;
337*4882a593Smuzhiyun GTP_ERROR("tools open failed!");
338*4882a593Smuzhiyun }
339*4882a593Smuzhiyun devicecount++;
340*4882a593Smuzhiyun return 0;
341*4882a593Smuzhiyun }
342*4882a593Smuzhiyun
gt1x_tool_release(struct inode * inode,struct file * filp)343*4882a593Smuzhiyun static int gt1x_tool_release(struct inode *inode, struct file *filp)
344*4882a593Smuzhiyun {
345*4882a593Smuzhiyun devicecount--;
346*4882a593Smuzhiyun return 0;
347*4882a593Smuzhiyun }
348*4882a593Smuzhiyun /*******************************************************
349*4882a593Smuzhiyun Function:
350*4882a593Smuzhiyun Goodix tool read function.
351*4882a593Smuzhiyun Input:
352*4882a593Smuzhiyun standard proc read function param.
353*4882a593Smuzhiyun Output:
354*4882a593Smuzhiyun Return read length.
355*4882a593Smuzhiyun ********************************************************/
gt1x_tool_read(struct file * filp,char __user * buffer,size_t count,loff_t * ppos)356*4882a593Smuzhiyun static ssize_t gt1x_tool_read(struct file *filp, char __user *buffer, size_t count, loff_t *ppos)
357*4882a593Smuzhiyun {
358*4882a593Smuzhiyun GTP_DEBUG_FUNC();
359*4882a593Smuzhiyun if (*ppos) {
360*4882a593Smuzhiyun GTP_DEBUG("[PARAM]size: %zd, *ppos: %d", count, (int)*ppos);
361*4882a593Smuzhiyun *ppos = 0;
362*4882a593Smuzhiyun return 0;
363*4882a593Smuzhiyun }
364*4882a593Smuzhiyun
365*4882a593Smuzhiyun if (cmd_head.wr % 2) {
366*4882a593Smuzhiyun GTP_ERROR("[READ] invaild operator fail!");
367*4882a593Smuzhiyun return -1;
368*4882a593Smuzhiyun } else if (!cmd_head.wr) {
369*4882a593Smuzhiyun /* general i2c read */
370*4882a593Smuzhiyun u16 addr, data_len, len, loc;
371*4882a593Smuzhiyun
372*4882a593Smuzhiyun if (1 == cmd_head.flag) {
373*4882a593Smuzhiyun if (comfirm()) {
374*4882a593Smuzhiyun GTP_ERROR("[READ]Comfirm fail!");
375*4882a593Smuzhiyun return -1;
376*4882a593Smuzhiyun }
377*4882a593Smuzhiyun } else if (2 == cmd_head.flag) {
378*4882a593Smuzhiyun /*Need interrupt!*/
379*4882a593Smuzhiyun }
380*4882a593Smuzhiyun
381*4882a593Smuzhiyun addr = (cmd_head.addr[0] << 8) + cmd_head.addr[1];
382*4882a593Smuzhiyun data_len = cmd_head.data_len;
383*4882a593Smuzhiyun loc = 0;
384*4882a593Smuzhiyun
385*4882a593Smuzhiyun GTP_DEBUG("[READ] ADDR:0x%04X.", addr);
386*4882a593Smuzhiyun GTP_DEBUG("[READ] Length: %d", data_len);
387*4882a593Smuzhiyun
388*4882a593Smuzhiyun if (cmd_head.delay) {
389*4882a593Smuzhiyun msleep(cmd_head.delay);
390*4882a593Smuzhiyun }
391*4882a593Smuzhiyun
392*4882a593Smuzhiyun while (data_len > 0) {
393*4882a593Smuzhiyun len = data_len > DATA_LENGTH ? DATA_LENGTH : data_len;
394*4882a593Smuzhiyun cmd_head.data[0] = (addr >> 8) & 0xFF;
395*4882a593Smuzhiyun cmd_head.data[1] = (addr & 0xFF);
396*4882a593Smuzhiyun if (tool_i2c_read(cmd_head.data, len) <= 0) {
397*4882a593Smuzhiyun GTP_ERROR("[READ]Read data failed!");
398*4882a593Smuzhiyun return -1;
399*4882a593Smuzhiyun }
400*4882a593Smuzhiyun memcpy(&buffer[loc], &cmd_head.data[GTP_ADDR_LENGTH], len);
401*4882a593Smuzhiyun data_len -= len;
402*4882a593Smuzhiyun addr += len;
403*4882a593Smuzhiyun loc += len;
404*4882a593Smuzhiyun GTP_DEBUG_ARRAY(&cmd_head.data[GTP_ADDR_LENGTH], len);
405*4882a593Smuzhiyun }
406*4882a593Smuzhiyun *ppos += cmd_head.data_len;
407*4882a593Smuzhiyun return cmd_head.data_len;
408*4882a593Smuzhiyun } else if (2 == cmd_head.wr) {
409*4882a593Smuzhiyun GTP_DEBUG("Return ic type:%s len:%d.", buffer, (s32) cmd_head.data_len);
410*4882a593Smuzhiyun return -1;
411*4882a593Smuzhiyun } else if (4 == cmd_head.wr) {
412*4882a593Smuzhiyun /* read fw update progress */
413*4882a593Smuzhiyun buffer[0] = update_info.progress >> 8;
414*4882a593Smuzhiyun buffer[1] = update_info.progress & 0xff;
415*4882a593Smuzhiyun buffer[2] = update_info.max_progress >> 8;
416*4882a593Smuzhiyun buffer[3] = update_info.max_progress & 0xff;
417*4882a593Smuzhiyun *ppos += 4;
418*4882a593Smuzhiyun return 4;
419*4882a593Smuzhiyun } else if (6 == cmd_head.wr) {
420*4882a593Smuzhiyun /*Read error code!*/
421*4882a593Smuzhiyun return -1;
422*4882a593Smuzhiyun } else if (8 == cmd_head.wr) {
423*4882a593Smuzhiyun /* Read driver version */
424*4882a593Smuzhiyun s32 tmp_len;
425*4882a593Smuzhiyun tmp_len = strlen(GTP_DRIVER_VERSION);
426*4882a593Smuzhiyun memcpy(buffer, GTP_DRIVER_VERSION, tmp_len);
427*4882a593Smuzhiyun buffer[tmp_len] = 0;
428*4882a593Smuzhiyun *ppos += tmp_len + 1;
429*4882a593Smuzhiyun return (tmp_len + 1);
430*4882a593Smuzhiyun }
431*4882a593Smuzhiyun *ppos += cmd_head.data_len;
432*4882a593Smuzhiyun return cmd_head.data_len;
433*4882a593Smuzhiyun }
434