659 lines
17 KiB
C
659 lines
17 KiB
C
/*
|
|
* Copyright (c) 2006-2022, RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2022-02-25 Wayne the first version
|
|
*/
|
|
|
|
#include <rtthread.h>
|
|
#include <rtdevice.h>
|
|
|
|
#include <nu_bitutil.h>
|
|
|
|
#define DBG_TAG "ili_tpc"
|
|
#define DBG_LVL DBG_INFO
|
|
#include <rtdbg.h>
|
|
|
|
#include "ili.h"
|
|
|
|
#define ILI_MAX_TOUCH 5
|
|
#define ILI_ADDRESS 0x41
|
|
|
|
#define BL_V1_8 0x108
|
|
#define BL_V1_7 0x107
|
|
#define BL_V1_6 0x106
|
|
|
|
#define ILITEK_TP_CMD_GET_TP_RES 0x20
|
|
#define ILITEK_TP_CMD_GET_SCRN_RES 0x21
|
|
#define ILITEK_TP_CMD_SET_IC_SLEEP 0x30
|
|
#define ILITEK_TP_CMD_SET_IC_WAKE 0x31
|
|
#define ILITEK_TP_CMD_GET_FW_VER 0x40
|
|
#define ILITEK_TP_CMD_GET_PRL_VER 0x42
|
|
#define ILITEK_TP_CMD_GET_MCU_VER 0x61
|
|
#define ILITEK_TP_CMD_GET_IC_MODE 0xC0
|
|
#define ILITEK_TP_CMD_RESET 0x60
|
|
|
|
#define REPORT_COUNT_ADDRESS 61
|
|
|
|
struct ili_protocol_info
|
|
{
|
|
rt_uint16_t ver;
|
|
rt_uint8_t ver_major;
|
|
};
|
|
|
|
struct ili_ts_data
|
|
{
|
|
struct rt_touch_device touch_device;
|
|
struct rt_i2c_client *client;
|
|
|
|
rt_base_t reset_pin;
|
|
rt_base_t irq_pin;
|
|
|
|
struct ili_protocol_info ptl;
|
|
rt_uint8_t product_id[30];
|
|
rt_uint16_t mcu_ver;
|
|
rt_uint8_t ic_mode;
|
|
rt_uint8_t firmware_ver[8];
|
|
|
|
rt_int32_t screen_max_x;
|
|
rt_int32_t screen_max_y;
|
|
rt_int32_t screen_min_x;
|
|
rt_int32_t screen_min_y;
|
|
rt_int32_t max_tp;
|
|
};
|
|
typedef struct ili_ts_data *ili_ts_data_t;
|
|
|
|
// Private data
|
|
static struct ili_ts_data g_iliTsData;
|
|
|
|
static rt_err_t ili_i2c_write_and_read(struct rt_i2c_client *psI2cClient,
|
|
rt_uint8_t *cmd, int write_len, int delay,
|
|
rt_uint8_t *data, int read_len)
|
|
{
|
|
struct rt_i2c_msg msgs[] =
|
|
{
|
|
{
|
|
.addr = psI2cClient->client_addr,
|
|
.flags = RT_I2C_WR,
|
|
.len = write_len,
|
|
.buf = cmd,
|
|
},
|
|
{
|
|
.addr = psI2cClient->client_addr,
|
|
.flags = RT_I2C_RD,
|
|
.len = read_len,
|
|
.buf = data,
|
|
},
|
|
};
|
|
|
|
if (delay == 0 && write_len > 0 && read_len > 0)
|
|
{
|
|
if (rt_i2c_transfer(psI2cClient->bus, msgs, 2) != 2)
|
|
goto exit_ili_i2c_write_and_read;
|
|
}
|
|
else
|
|
{
|
|
if (write_len > 0)
|
|
{
|
|
if (rt_i2c_transfer(psI2cClient->bus, msgs, 1) != 1)
|
|
goto exit_ili_i2c_write_and_read;
|
|
}
|
|
|
|
if (delay > 0)
|
|
rt_thread_mdelay(delay);
|
|
|
|
if (read_len > 0)
|
|
{
|
|
if (rt_i2c_transfer(psI2cClient->bus, msgs + 1, 1) != 1)
|
|
goto exit_ili_i2c_write_and_read;
|
|
}
|
|
}
|
|
|
|
return RT_EOK;
|
|
|
|
exit_ili_i2c_write_and_read:
|
|
|
|
return -RT_ERROR;
|
|
}
|
|
|
|
static int ili_get_ptl_ver(ili_ts_data_t psIliTs,
|
|
rt_uint16_t cmd, rt_uint8_t *inbuf, rt_uint8_t *outbuf)
|
|
{
|
|
rt_int32_t error;
|
|
rt_uint8_t buf[64];
|
|
|
|
buf[0] = cmd;
|
|
error = ili_i2c_write_and_read(psIliTs->client, buf, 1, 5, outbuf, 3);
|
|
if (error)
|
|
return error;
|
|
|
|
psIliTs->ptl.ver = nu_get16_be(outbuf);
|
|
psIliTs->ptl.ver_major = outbuf[0];
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ili_get_mcu_ver(ili_ts_data_t psIliTs,
|
|
rt_uint16_t cmd, rt_uint8_t *inbuf, rt_uint8_t *outbuf)
|
|
{
|
|
rt_int32_t error;
|
|
rt_uint8_t buf[64];
|
|
|
|
buf[0] = cmd;
|
|
error = ili_i2c_write_and_read(psIliTs->client, buf, 1, 5, outbuf, 32);
|
|
if (error)
|
|
return error;
|
|
|
|
psIliTs->mcu_ver = nu_get16_le(outbuf);
|
|
rt_memset(psIliTs->product_id, 0, sizeof(psIliTs->product_id));
|
|
rt_memcpy(psIliTs->product_id, outbuf + 6, 26);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ili_get_fw_ver(ili_ts_data_t psIliTs,
|
|
rt_uint16_t cmd, rt_uint8_t *inbuf, rt_uint8_t *outbuf)
|
|
{
|
|
rt_int32_t error;
|
|
rt_uint8_t buf[64];
|
|
|
|
buf[0] = cmd;
|
|
error = ili_i2c_write_and_read(psIliTs->client, buf, 1, 5, outbuf, 8);
|
|
if (error)
|
|
return error;
|
|
|
|
rt_memcpy(psIliTs->firmware_ver, outbuf, 8);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ili_get_scrn_res(ili_ts_data_t psIliTs,
|
|
rt_uint16_t cmd, rt_uint8_t *inbuf, rt_uint8_t *outbuf)
|
|
{
|
|
rt_int32_t error;
|
|
rt_uint8_t buf[64];
|
|
|
|
buf[0] = cmd;
|
|
error = ili_i2c_write_and_read(psIliTs->client, buf, 1, 5, outbuf, 8);
|
|
if (error)
|
|
return error;
|
|
|
|
psIliTs->screen_min_x = nu_get16_le(outbuf);
|
|
psIliTs->screen_min_y = nu_get16_le(outbuf + 2);
|
|
psIliTs->screen_max_x = nu_get16_le(outbuf + 4);
|
|
psIliTs->screen_max_y = nu_get16_le(outbuf + 6);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ili_get_tp_res(ili_ts_data_t psIliTs,
|
|
rt_uint16_t cmd, rt_uint8_t *inbuf, rt_uint8_t *outbuf)
|
|
{
|
|
rt_int32_t error;
|
|
rt_uint8_t buf[64];
|
|
|
|
buf[0] = cmd;
|
|
error = ili_i2c_write_and_read(psIliTs->client, buf, 1, 5, outbuf, 15);
|
|
if (error)
|
|
return error;
|
|
|
|
psIliTs->max_tp = outbuf[8];
|
|
if (psIliTs->max_tp > ILI_MAX_TOUCH)
|
|
{
|
|
return -RT_EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ili_get_ic_mode(ili_ts_data_t psIliTs,
|
|
rt_uint16_t cmd, rt_uint8_t *inbuf, rt_uint8_t *outbuf)
|
|
{
|
|
rt_int32_t error;
|
|
rt_uint8_t buf[64];
|
|
|
|
buf[0] = cmd;
|
|
error = ili_i2c_write_and_read(psIliTs->client, buf, 1, 5, outbuf, 2);
|
|
if (error)
|
|
return error;
|
|
|
|
psIliTs->ic_mode = outbuf[0];
|
|
return 0;
|
|
}
|
|
|
|
static int ili_send_soft_reset(ili_ts_data_t psIliTs,
|
|
rt_uint16_t cmd, rt_uint8_t *inbuf, rt_uint8_t *outbuf)
|
|
{
|
|
rt_int32_t error;
|
|
rt_uint8_t buf[64];
|
|
|
|
buf[0] = cmd;
|
|
error = ili_i2c_write_and_read(psIliTs->client, buf, 1, 0, RT_NULL, 0);
|
|
if (error)
|
|
return error;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ili_tpc_reset(ili_ts_data_t psIliTs, int delay_ms)
|
|
{
|
|
if (0)
|
|
{
|
|
//FIXME
|
|
/* hw pin init*/
|
|
rt_pin_mode(psIliTs->reset_pin, PIN_MODE_OUTPUT);
|
|
|
|
/* Reset */
|
|
rt_pin_write(psIliTs->reset_pin, PIN_HIGH);
|
|
rt_thread_mdelay(10);
|
|
rt_pin_write(psIliTs->reset_pin, PIN_LOW);
|
|
}
|
|
else
|
|
{
|
|
rt_err_t error;
|
|
error = ili_send_soft_reset(psIliTs, ILITEK_TP_CMD_RESET, RT_NULL, RT_NULL);
|
|
if (error)
|
|
return;
|
|
}
|
|
rt_thread_mdelay(delay_ms);
|
|
}
|
|
|
|
static rt_err_t ili_get_info(ili_ts_data_t psIliTs, struct rt_touch_info *info)
|
|
{
|
|
rt_uint8_t outbuf[256];
|
|
rt_err_t error;
|
|
|
|
error = ili_get_ptl_ver(psIliTs, ILITEK_TP_CMD_GET_PRL_VER, RT_NULL, outbuf);
|
|
if (error)
|
|
goto exit_ili_get_info;
|
|
|
|
error = ili_get_mcu_ver(psIliTs, ILITEK_TP_CMD_GET_MCU_VER, RT_NULL, outbuf);
|
|
if (error)
|
|
goto exit_ili_get_info;
|
|
|
|
error = ili_get_fw_ver(psIliTs, ILITEK_TP_CMD_GET_FW_VER, NULL, outbuf);
|
|
if (error)
|
|
goto exit_ili_get_info;
|
|
|
|
error = ili_get_scrn_res(psIliTs, ILITEK_TP_CMD_GET_SCRN_RES, NULL, outbuf);
|
|
if (error)
|
|
goto exit_ili_get_info;
|
|
|
|
error = ili_get_tp_res(psIliTs, ILITEK_TP_CMD_GET_TP_RES, NULL, outbuf);
|
|
if (error)
|
|
goto exit_ili_get_info;
|
|
|
|
error = ili_get_ic_mode(psIliTs, ILITEK_TP_CMD_GET_IC_MODE, NULL, outbuf);
|
|
if (error)
|
|
goto exit_ili_get_info;
|
|
|
|
LOG_I("touch device probed");
|
|
|
|
return RT_EOK;
|
|
|
|
exit_ili_get_info:
|
|
|
|
return -RT_ERROR;
|
|
}
|
|
|
|
static void ili_info_dump(ili_ts_data_t psIliTs)
|
|
{
|
|
rt_kprintf("reset_pin: %d\n", psIliTs->reset_pin);
|
|
rt_kprintf("irq_pin: %d\n", psIliTs->irq_pin);
|
|
rt_kprintf("ptl.ver: %x \n", psIliTs->ptl.ver_major);
|
|
rt_kprintf("mcu_ver: %x\n", psIliTs->mcu_ver);
|
|
rt_kprintf("firmware_ver:[%02X%02X.%02X%02X.%02X%02X.%02X%02X]\n",
|
|
psIliTs->firmware_ver[0],
|
|
psIliTs->firmware_ver[1],
|
|
psIliTs->firmware_ver[2],
|
|
psIliTs->firmware_ver[3],
|
|
psIliTs->firmware_ver[4],
|
|
psIliTs->firmware_ver[5],
|
|
psIliTs->firmware_ver[6],
|
|
psIliTs->firmware_ver[7]);
|
|
|
|
rt_kprintf("product_id: %s\n", psIliTs->product_id);
|
|
|
|
rt_kprintf("screen_max_x: %d\n", psIliTs->screen_max_x);
|
|
rt_kprintf("screen_max_y: %d\n", psIliTs->screen_max_y);
|
|
rt_kprintf("screen_min_x: %d\n", psIliTs->screen_min_x);
|
|
rt_kprintf("screen_min_y: %d\n", psIliTs->screen_min_y);
|
|
rt_kprintf("max_tp: %d\n", psIliTs->max_tp);
|
|
rt_kprintf("ic_mode: %d\n", psIliTs->ic_mode);
|
|
}
|
|
|
|
static rt_int16_t pre_x[ILI_MAX_TOUCH];
|
|
static rt_int16_t pre_y[ILI_MAX_TOUCH];
|
|
static rt_int16_t pre_w[ILI_MAX_TOUCH];
|
|
static rt_uint8_t s_tp_dowm[ILI_MAX_TOUCH];
|
|
|
|
static void ili_touch_up(void *buf, int8_t id)
|
|
{
|
|
struct rt_touch_data *read_data = (struct rt_touch_data *)buf;
|
|
|
|
if (s_tp_dowm[id] == 1)
|
|
{
|
|
s_tp_dowm[id] = 0;
|
|
read_data[id].event = RT_TOUCH_EVENT_UP;
|
|
}
|
|
else
|
|
{
|
|
read_data[id].event = RT_TOUCH_EVENT_NONE;
|
|
}
|
|
|
|
read_data[id].timestamp = rt_touch_get_ts();
|
|
read_data[id].width = pre_w[id];
|
|
read_data[id].x_coordinate = pre_x[id];
|
|
read_data[id].y_coordinate = pre_y[id];
|
|
read_data[id].track_id = id;
|
|
|
|
pre_x[id] = -1; /* last point is none */
|
|
pre_y[id] = -1;
|
|
pre_w[id] = -1;
|
|
}
|
|
|
|
static void ili_touch_down(void *buf, int8_t id, int16_t x, int16_t y, int16_t w)
|
|
{
|
|
struct rt_touch_data *read_data = (struct rt_touch_data *)buf;
|
|
|
|
if (s_tp_dowm[id] == 1)
|
|
{
|
|
read_data[id].event = RT_TOUCH_EVENT_MOVE;
|
|
|
|
}
|
|
else
|
|
{
|
|
read_data[id].event = RT_TOUCH_EVENT_DOWN;
|
|
s_tp_dowm[id] = 1;
|
|
}
|
|
|
|
read_data[id].timestamp = rt_touch_get_ts();
|
|
read_data[id].width = w;
|
|
read_data[id].x_coordinate = x;
|
|
read_data[id].y_coordinate = y;
|
|
read_data[id].track_id = id;
|
|
|
|
pre_x[id] = x; /* save last point */
|
|
pre_y[id] = y;
|
|
pre_w[id] = w;
|
|
}
|
|
|
|
static int8_t pre_id[ILI_MAX_TOUCH];
|
|
static rt_uint8_t pre_touch = 0;
|
|
static rt_size_t ili_read_point(struct rt_touch_device *touch, void *buf, rt_size_t read_num)
|
|
{
|
|
#define DIV_ROUND_UP(n,d) (((n) + (d) - 1) / (d))
|
|
|
|
struct ili_ts_data *ts = (ili_ts_data_t)touch;
|
|
rt_uint8_t tmpbuf[256] = {0};
|
|
rt_err_t error = 0;
|
|
rt_int32_t packet_len = 5;
|
|
rt_int32_t packet_max_point = 10;
|
|
rt_int8_t touch_num;
|
|
rt_int32_t i, count;
|
|
rt_uint16_t x, y;
|
|
rt_int32_t tip, point_id;
|
|
|
|
RT_ASSERT(touch);
|
|
RT_ASSERT(buf);
|
|
RT_ASSERT(read_num != 0);
|
|
RT_ASSERT(read_num <= ILI_MAX_TOUCH);
|
|
|
|
error = ili_i2c_write_and_read(ts->client, NULL, 0, 0, tmpbuf, 64);
|
|
if (error)
|
|
{
|
|
LOG_E("get touch info failed, err:%d\n", error);
|
|
goto exit_ili_read_point;
|
|
}
|
|
|
|
touch_num = tmpbuf[REPORT_COUNT_ADDRESS];
|
|
if (touch_num > ts->max_tp)
|
|
{
|
|
LOG_E("FW report max point:%d > panel info. max:%d\n", touch_num, ts->max_tp);
|
|
goto exit_ili_read_point;
|
|
}
|
|
|
|
count = DIV_ROUND_UP(touch_num, packet_max_point);
|
|
for (i = 1; i < count; i++)
|
|
{
|
|
error = ili_i2c_write_and_read(ts->client, NULL, 0, 0, tmpbuf + i * 64, 64);
|
|
if (error)
|
|
{
|
|
LOG_E("get touch info. failed, cnt:%d, err:%d\n", count, error);
|
|
goto exit_ili_read_point;
|
|
}
|
|
}
|
|
|
|
if (pre_touch > touch_num) /* point up */
|
|
{
|
|
for (i = 0; i < ILI_MAX_TOUCH; i++)
|
|
{
|
|
rt_uint8_t j;
|
|
for (j = 0; j < touch_num; j++) /* this time touch num */
|
|
{
|
|
point_id = tmpbuf[j * packet_len + 1] & 0x3F;
|
|
|
|
if (pre_id[i] == point_id) /* this id is not free */
|
|
break;
|
|
|
|
}
|
|
if ((j == touch_num) && (pre_id[i] != -1))
|
|
{
|
|
ili_touch_up(buf, pre_id[i]);
|
|
pre_id[i] = -1;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (touch_num > 0)
|
|
{
|
|
uint32_t range_x = touch->info.range_x;
|
|
uint32_t range_y = touch->info.range_y;
|
|
|
|
for (i = 0; i < touch_num; i++)
|
|
{
|
|
tip = tmpbuf[i * packet_len + 1] & 0x40;
|
|
point_id = tmpbuf[i * packet_len + 1] & 0x3F;
|
|
pre_id[i] = point_id;
|
|
if (!tip)
|
|
{
|
|
// Up
|
|
ili_touch_up(buf, point_id);
|
|
continue;
|
|
}
|
|
|
|
x = nu_get16_le(tmpbuf + i * packet_len + 2);
|
|
y = nu_get16_le(tmpbuf + i * packet_len + 4);
|
|
|
|
if (x > ts->screen_max_x || x < ts->screen_min_x ||
|
|
y > ts->screen_max_y || y < ts->screen_min_y)
|
|
{
|
|
LOG_E("invalid position, X[%d,%u,%d], Y[%d,%u,%d]\n",
|
|
ts->screen_min_x, x, ts->screen_max_x,
|
|
ts->screen_min_y, y, ts->screen_max_y);
|
|
continue;
|
|
}
|
|
x = (uint16_t)(range_x * x / ts->screen_max_x);
|
|
y = (uint16_t)(range_y * y / ts->screen_max_y);
|
|
|
|
ili_touch_down(buf, point_id, x, y, 255);
|
|
}
|
|
}
|
|
|
|
pre_touch = touch_num;
|
|
|
|
return read_num;
|
|
|
|
exit_ili_read_point:
|
|
|
|
pre_touch = 0;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static rt_err_t ili_control(struct rt_touch_device *touch, int cmd, void *arg)
|
|
{
|
|
switch (cmd)
|
|
{
|
|
case RT_TOUCH_CTRL_GET_ID:
|
|
{
|
|
RT_ASSERT(arg);
|
|
rt_uint8_t *pu8ID = arg;
|
|
rt_memcpy((void *)pu8ID, (void *)&g_iliTsData.product_id[0], 8);
|
|
}
|
|
break;
|
|
|
|
case RT_TOUCH_CTRL_GET_INFO:
|
|
{
|
|
RT_ASSERT(arg);
|
|
|
|
touch->info.type = RT_TOUCH_TYPE_CAPACITANCE;
|
|
touch->info.vendor = RT_TOUCH_VENDOR_UNKNOWN;
|
|
touch->info.point_num = g_iliTsData.max_tp;
|
|
|
|
rt_memcpy(arg, &touch->info, sizeof(struct rt_touch_info));
|
|
}
|
|
break;
|
|
|
|
case RT_TOUCH_CTRL_SET_X_RANGE:
|
|
{
|
|
RT_ASSERT(arg);
|
|
uint16_t range_x = *(rt_uint16_t *)arg;
|
|
if (range_x > g_iliTsData.screen_max_x || range_x < g_iliTsData.screen_min_x)
|
|
{
|
|
LOG_E("Set x range failed. %d", range_x);
|
|
}
|
|
else
|
|
{
|
|
touch->info.range_x = range_x;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case RT_TOUCH_CTRL_SET_Y_RANGE:
|
|
{
|
|
RT_ASSERT(arg);
|
|
uint16_t range_y = *(rt_uint16_t *)arg;
|
|
if (range_y > g_iliTsData.screen_max_y || range_y < g_iliTsData.screen_min_y)
|
|
{
|
|
LOG_E("Set y range failed. %d", range_y);
|
|
}
|
|
else
|
|
{
|
|
touch->info.range_y = range_y;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case RT_TOUCH_CTRL_SET_MODE:
|
|
{
|
|
rt_uint16_t trig_type;
|
|
RT_ASSERT(arg);
|
|
trig_type = *(rt_uint16_t *)arg;
|
|
|
|
switch (trig_type)
|
|
{
|
|
case RT_DEVICE_FLAG_INT_RX:
|
|
break;
|
|
case RT_DEVICE_FLAG_RDONLY:
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
break;
|
|
|
|
default:
|
|
{
|
|
}
|
|
break;
|
|
|
|
}
|
|
|
|
return RT_EOK;
|
|
}
|
|
|
|
static struct rt_touch_ops ili_touch_ops =
|
|
{
|
|
.touch_readpoint = ili_read_point,
|
|
.touch_control = ili_control,
|
|
};
|
|
|
|
int rt_hw_ili_tpc_init(const char *name, struct rt_touch_config *cfg)
|
|
{
|
|
struct rt_touch_device *touch_device = RT_NULL;
|
|
rt_uint32_t bus_speed = 400000;
|
|
|
|
touch_device = (struct rt_touch_device *)&g_iliTsData.touch_device;
|
|
rt_memset((void *)touch_device, 0, sizeof(struct rt_touch_device));
|
|
|
|
g_iliTsData.client = (struct rt_i2c_client *)rt_malloc(sizeof(struct rt_i2c_client));
|
|
if (g_iliTsData.client == RT_NULL)
|
|
{
|
|
LOG_E("touch device malloc fail");
|
|
goto exit_rt_hw_ili_tpc_init;
|
|
}
|
|
rt_memset((void *)g_iliTsData.client, 0, sizeof(struct rt_i2c_client));
|
|
|
|
g_iliTsData.reset_pin = *((rt_base_t *)cfg->user_data);
|
|
g_iliTsData.irq_pin = cfg->irq_pin.pin;
|
|
|
|
g_iliTsData.client->client_addr = ILI_ADDRESS;
|
|
g_iliTsData.client->bus = (struct rt_i2c_bus_device *)rt_device_find(cfg->dev_name);
|
|
if (g_iliTsData.client->bus == RT_NULL)
|
|
{
|
|
LOG_E("Can't find %s device", cfg->dev_name);
|
|
goto exit_rt_hw_ili_tpc_init;
|
|
}
|
|
|
|
if (rt_device_open((rt_device_t)g_iliTsData.client->bus, RT_DEVICE_FLAG_RDWR) != RT_EOK)
|
|
{
|
|
LOG_E("open %s device failed", cfg->dev_name);
|
|
goto exit_rt_hw_ili_tpc_init;
|
|
}
|
|
|
|
rt_memset(&pre_x[0], 0xff, ILI_MAX_TOUCH * sizeof(int16_t));
|
|
rt_memset(&pre_y[0], 0xff, ILI_MAX_TOUCH * sizeof(int16_t));
|
|
rt_memset(&pre_w[0], 0xff, ILI_MAX_TOUCH * sizeof(int16_t));
|
|
rt_memset(&s_tp_dowm[0], 0, ILI_MAX_TOUCH * sizeof(int16_t));
|
|
rt_memset(&pre_id[0], 0xff, ILI_MAX_TOUCH * sizeof(int8_t));
|
|
|
|
/* register touch device */
|
|
rt_memcpy(&touch_device->config, cfg, sizeof(struct rt_touch_config));
|
|
touch_device->ops = &ili_touch_ops;
|
|
if (rt_hw_touch_register(touch_device, name, RT_DEVICE_FLAG_INT_RX, RT_NULL) != RT_EOK)
|
|
{
|
|
LOG_E("register %s device failed", name);
|
|
goto exit_rt_hw_ili_tpc_init;
|
|
}
|
|
|
|
ili_tpc_reset(&g_iliTsData, 300);
|
|
|
|
if (rt_device_control((rt_device_t)g_iliTsData.client->bus, RT_I2C_DEV_CTRL_CLK, &bus_speed) != RT_EOK)
|
|
{
|
|
LOG_E("control %s device failed", cfg->dev_name);
|
|
goto exit_rt_hw_ili_tpc_init;
|
|
}
|
|
|
|
/* Probe */
|
|
if (ili_get_info(&g_iliTsData, &touch_device->info) != RT_EOK)
|
|
{
|
|
LOG_E("Get info failed");
|
|
return -RT_ERROR;
|
|
}
|
|
ili_info_dump(&g_iliTsData);
|
|
|
|
|
|
return 0;
|
|
|
|
exit_rt_hw_ili_tpc_init:
|
|
|
|
if (g_iliTsData.client)
|
|
rt_free(g_iliTsData.client);
|
|
|
|
return -RT_ERROR;
|
|
}
|