* [PATCHv2] Add support for SiS i2c touch driver
@ 2015-08-29 9:25 Yuger
0 siblings, 0 replies; 5+ messages in thread
From: Yuger @ 2015-08-29 9:25 UTC (permalink / raw)
To: Dmitry Torokhov, linux-input; +Cc: yuger.yu, yuger_yu, tammy_tseng
Hi, This patch is to add support for SiS i2c touch panel.
Thanks a lot.
v2: Fixed coding style and changed to threaded IRQ.
Signed-off-by: Yuger <yuger_yu@sis.com>
---
drivers/input/touchscreen/Kconfig | 2 +-
drivers/input/touchscreen/sis_i2c.c | 646 +++++++++++++++---------------------
drivers/input/touchscreen/sis_i2c.h | 164 ---------
3 files changed, 273 insertions(+), 539 deletions(-)
delete mode 100644 drivers/input/touchscreen/sis_i2c.h
diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig
index 3d7a30d..ca8420e 100644
--- a/drivers/input/touchscreen/Kconfig
+++ b/drivers/input/touchscreen/Kconfig
@@ -1029,7 +1029,7 @@ config TOUCHSCREEN_ZFORCE
config TOUCHSCREEN_SIS_I2C
tristate "SiS 9200 family I2C touchscreen driver"
- depends on I2C
+ depends on I2C && CRC_ITU_T
help
Say Y here to enable support for I2C connected SiS touch panels.
diff --git a/drivers/input/touchscreen/sis_i2c.c b/drivers/input/touchscreen/sis_i2c.c
index 22dfc1f..f7b6ac5 100644
--- a/drivers/input/touchscreen/sis_i2c.c
+++ b/drivers/input/touchscreen/sis_i2c.c
@@ -12,20 +12,13 @@
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
- * Date: 2015/07/07
*/
-#include <linux/errno.h>
#include <linux/module.h>
-#include <linux/delay.h>
-#include <linux/hrtimer.h>
#include <linux/i2c.h>
#include <linux/input.h>
#include <linux/interrupt.h>
-#include <linux/io.h>
#include <linux/platform_device.h>
-#include "sis_i2c.h"
-#include <linux/linkage.h>
#include <linux/slab.h>
#include <linux/gpio.h>
#include <linux/uaccess.h>
@@ -34,27 +27,86 @@
#include <linux/input/mt.h> /*For Type-B Slot function*/
#include <linux/crc-itu-t.h> /*For CRC Check*/
-/* Addresses to scan */
-static const unsigned short normal_i2c[] = { SIS_SLAVE_ADDR, I2C_CLIENT_END };
-static struct workqueue_struct *sis_wq;
-struct sis_ts_data *ts_bak;
-static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max);
+#define SIS_I2C_NAME "sis_i2c_ts"
+#define SIS_SLAVE_ADDR 0x5c
+#define MAX_FINGERS 10
+
+/*Resolution mode*/
+/*Constant value*/
+#define SIS_MAX_X 4095
+#define SIS_MAX_Y 4095
+
+#define PACKET_BUFFER_SIZE 128
+
+#define SIS_CMD_NORMAL 0x0
+
+/* for new i2c format */
+#define TOUCHDOWN 0x3
+#define TOUCHUP 0x0
+#define MAX_BYTE 64
+#define PRESSURE_MAX 255
+
+/*Resolution diagonal */
+#define AREA_LENGTH_LONGER 5792
+/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/
+#define AREA_LENGTH_SHORT 5792
+#define AREA_UNIT (5792/32)
+
+#define P_BYTECOUNT 0
+#define ALL_IN_ONE_PACKAGE 0x10
+#define IS_TOUCH(x) (x & 0x1)
+#define IS_HIDI2C(x) ((x & 0xF) == 0x06)
+#define IS_AREA(x) ((x >> 4) & 0x1)
+#define IS_PRESSURE(x) ((x >> 5) & 0x1)
+#define IS_SCANTIME(x) ((x >> 6) & 0x1)
+#define NORMAL_LEN_PER_POINT 6
+#define AREA_LEN_PER_POINT 2
+#define PRESSURE_LEN_PER_POINT 1
+
+#define TOUCH_FORMAT 0x1
+#define HIDI2C_FORMAT 0x6
+#define P_REPORT_ID 2
+#define BYTE_BYTECOUNT 2
+#define BYTE_ReportID 1
+#define BYTE_CRC_HIDI2C 0
+#define BYTE_CRC_I2C 2
+#define BYTE_SCANTIME 2
+
+#define MAX_SLOTS 15
+
+struct sis_slot {
+ int check_id;
+ int id;
+ unsigned short x, y;
+ u16 pressure;
+ u16 width;
+ u16 height;
+};
-static int sis_command_for_read(struct i2c_client *client, int rlength,
- unsigned char *rdata)
-{
- int ret;
- struct i2c_msg msg;
+struct point {
+ int id;
+ unsigned short x, y;
+ u16 pressure;
+ u16 width;
+ u16 height;
+};
- msg.addr = client->addr;
- msg.flags = I2C_M_RD; /*Read*/
- msg.len = rlength;
- msg.buf = rdata;
- ret = i2c_transfer(client->adapter, &msg, 1);
- return ret;
-}
+struct sistp_driver_data {
+ int id;
+ int fingers;
+ struct point pt[MAX_FINGERS];
+};
+
+struct sis_ts_data {
+ struct i2c_client *client;
+ struct input_dev *input_dev;
+ struct sistp_driver_data *tp_info;
+};
-static int sis_cul_unit(uint8_t report_id)
+/* Addresses to scan */
+static void sis_tpinfo_clear(struct sistp_driver_data *tp_info, int max);
+
+static int sis_cul_unit(u8 report_id)
{
int ret = NORMAL_LEN_PER_POINT;
@@ -68,73 +120,76 @@ static int sis_cul_unit(uint8_t report_id)
return ret;
}
-static int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf)
+static int sis_readpacket(struct i2c_client *client, u8 cmd, u8 *buf)
{
- uint8_t tmpbuf[MAX_BYTE] = {0}; /*MAX_BYTE = 64;*/
+ u8 tmpbuf[MAX_BYTE] = {0}; /*MAX_BYTE = 64;*/
int ret;
int touchnum = 0;
int p_count = 0;
- int touc_formate_id = 0;
+ int touch_format_id = 0;
int locate = 0;
bool read_first = true;
/*
- * New i2c format
- * buf[0] = Low 8 bits of byte count value
- * buf[1] = High 8 bits of byte counte value
- * buf[2] = Report ID
- * buf[touch num * 6 + 2 ] = Touch information;
- * 1 touch point has 6 bytes, it could be none if no touch
- * buf[touch num * 6 + 3] = Touch numbers
- *
- * One touch point information include 6 bytes, the order is
- *
- * 1. status = touch down or touch up
- * 2. id = finger id
- * 3. x axis low 8 bits
- * 4. x axis high 8 bits
- * 5. y axis low 8 bits
- * 6. y axis high 8 bits
- * */
+ * New i2c format
+ * buf[0] = Low 8 bits of byte count value
+ * buf[1] = High 8 bits of byte count value
+ * buf[2] = Report ID
+ * buf[touch num * 6 + 2 ] = Touch information;
+ * 1 touch point has 6 bytes, it could be none if no touch
+ * buf[touch num * 6 + 3] = Touch numbers
+ *
+ * One touch point information include 6 bytes, the order is
+ *
+ * 1. status = touch down or touch up
+ * 2. id = finger id
+ * 3. x axis low 8 bits
+ * 4. x axis high 8 bits
+ * 5. y axis low 8 bits
+ * 6. y axis high 8 bits
+ */
do {
if (locate >= PACKET_BUFFER_SIZE) {
- pr_err("sis_ReadPacket: Buf Overflow\n");
+ dev_err(&client->dev, "sis_readpacket: Buf Overflow\n");
return -EPERM;
}
- ret = sis_command_for_read(client, MAX_BYTE, tmpbuf);
+ ret = i2c_master_recv(client, tmpbuf, MAX_BYTE);
if (ret < 0) {
- pr_err("sis_ReadPacket: i2c transfer error\n");
+ dev_err(&client->dev, "sis_readpacket: i2c transfer error\n");
return ret;
}
/*error package length of receiving data*/
else if (tmpbuf[P_BYTECOUNT] > MAX_BYTE) {
- pr_err("sis_ReadPacket: Error Bytecount\n");
+ dev_err(&client->dev, "sis_readpacket: Error Bytecount\n");
return -EPERM;
}
if (read_first) {
/*access NO TOUCH event unless BUTTON NO TOUCH event*/
- if (tmpbuf[P_BYTECOUNT] == 0/*NO_TOUCH_BYTECOUNT*/)
+ if (tmpbuf[P_BYTECOUNT] == 0)
return 0; /*touchnum is 0*/
}
- /*skip parsing data when two devices are registered
- * at the same slave address*/
- /*parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT
- * or P_REPORT_ID is ALL_IN_ONE_PACKAGE*/
- touc_formate_id = tmpbuf[P_REPORT_ID] & 0xf;
- if ((touc_formate_id != TOUCH_FORMAT)
- && (touc_formate_id != HIDI2C_FORMAT)
- && (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) {
- pr_err("sis_ReadPacket: Error Report_ID\n");
+ /*
+ * skip parsing data when two devices are registered
+ * at the same slave address
+ * parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT
+ * or P_REPORT_ID is ALL_IN_ONE_PACKAGE
+ */
+ touch_format_id = tmpbuf[P_REPORT_ID] & 0xf;
+ if ((touch_format_id != TOUCH_FORMAT) &&
+ (touch_format_id != HIDI2C_FORMAT) &&
+ (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) {
+ dev_err(&client->dev, "sis_readpacket: Error Report_ID\n");
return -EPERM;
}
p_count = (int) tmpbuf[P_BYTECOUNT] - 1; /*start from 0*/
if (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE) {
if (IS_TOUCH(tmpbuf[P_REPORT_ID])) {
- p_count -= BYTE_CRC_I2C;/*delete 2 byte crc*/
+ /*delete 2 byte crc*/
+ p_count -= BYTE_CRC_I2C;
} else if (IS_HIDI2C(tmpbuf[P_REPORT_ID])) {
p_count -= BYTE_CRC_HIDI2C;
} else { /*should not be happen*/
- pr_err("sis_ReadPacket: delete crc error\n");
+ dev_err(&client->dev, "sis_readpacket: delete crc error\n");
return -EPERM;
}
if (IS_SCANTIME(tmpbuf[P_REPORT_ID]))
@@ -145,76 +200,49 @@ static int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf)
touchnum = tmpbuf[p_count];
} else {
if (tmpbuf[p_count] != 0) {
- pr_err("sis_ReadPacket: get error package\n");
+ dev_err(&client->dev, "sis_readpacket: get error package\n");
return -EPERM;
}
}
-#ifdef _CHECK_CRC
- /* HID over I2C data foramt and no touch packet without CRC */
- if ((touc_formate_id != HIDI2C_FORMAT) &&
+ if ((touch_format_id != HIDI2C_FORMAT) &&
(tmpbuf[P_BYTECOUNT] > 3)) {
int crc_end = p_count + (IS_SCANTIME(
tmpbuf[P_REPORT_ID]) * 2);
- uint16_t buf_crc = crc_itu_t(
+ u16 buf_crc = crc_itu_t(
0, tmpbuf + 2, crc_end - 1);
int l_package_crc = (IS_SCANTIME(
tmpbuf[P_REPORT_ID]) * 2) + p_count + 1;
- uint16_t package_crc = get_unaligned_le16(
+ u16 package_crc = get_unaligned_le16(
&tmpbuf[l_package_crc]);
if (buf_crc != package_crc) {
- pr_err("sis_ReadPacket: CRC Error\n");
+ dev_err(&client->dev, "sis_readpacket: CRC Error\n");
return -EPERM;
}
}
-#endif
- memcpy(&buf[locate], &tmpbuf[0], 64);
+
+ memcpy(&buf[locate], &tmpbuf[0], MAX_BYTE);
/*Buf_Data [0~63] [64~128]*/
- locate += 64;
+ locate += MAX_BYTE;
read_first = false;
} while (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE &&
tmpbuf[p_count] > 5);
return touchnum;
}
-static void sis_ts_work_func(struct work_struct *work)
+static int sis_parse_i2c_event(u8 *buf, u8 fingers,
+ struct sistp_driver_data *tp_info,
+ int *check_id, struct sis_slot *sisdata)
{
- struct sis_ts_data *ts = container_of(work, struct sis_ts_data, work);
- struct sisTP_driver_data *TPInfo = ts->TPInfo;
- int ret;
int point_unit;
- uint8_t buf[PACKET_BUFFER_SIZE] = {0};
- uint8_t i = 0, fingers = 0;
- uint8_t px = 0, py = 0, pstatus = 0;
- uint8_t p_area = 0;
- uint8_t p_preasure = 0;
- int CheckID[MAX_FINGERS];
- static int Pre_CheckID[MAX_FINGERS];
- struct TypeB_Slot MM_Slot[MAX_FINGERS];
-
- memset(CheckID, 0, sizeof(int)*MAX_FINGERS);
-
- mutex_lock(&ts->mutex_wq);
- /*I2C or SMBUS block data read*/
- ret = sis_ReadPacket(ts->client, SIS_CMD_NORMAL, buf);
- /*Error Number*/
- if (ret < 0)
- goto err_free_allocate;
- /*access NO TOUCH event unless BUTTON NO TOUCH event*/
- else if (ret == 0) {
- fingers = 0;
- sis_tpinfo_clear(TPInfo, MAX_FINGERS);
-
- goto Tye_B_report;
- }
- sis_tpinfo_clear(TPInfo, MAX_FINGERS);
-
- /*Parser and Get the sis9200 data*/
+ u8 i = 0, pstatus = 0;
+ u8 px = 0, py = 0;
+ u8 p_area = 0;
+ u8 p_preasure = 0;
+ /*Parser and Get the sis data*/
point_unit = sis_cul_unit(buf[P_REPORT_ID]);
- fingers = ret;
-
- TPInfo->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers);
+ tp_info->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers);
/*fingers 10 = 0 ~ 9*/
for (i = 0; i < fingers; i++) {
@@ -228,226 +256,176 @@ static void sis_ts_work_func(struct work_struct *work)
+ (i * point_unit);
/*Calc point status*/
}
- px = pstatus + 2; /*Calc point x_coord*/
- py = px + 2; /*Calc point y_coord*/
+ px = pstatus + 2; /*Calc point x_coord*/
+ py = px + 2; /*Calc point y_coord*/
if ((buf[pstatus]) == TOUCHUP) {
- TPInfo->pt[i].Width = 0;
- TPInfo->pt[i].Height = 0;
- TPInfo->pt[i].Pressure = 0;
+ tp_info->pt[i].width = 0;
+ tp_info->pt[i].height = 0;
+ tp_info->pt[i].pressure = 0;
} else if (buf[P_REPORT_ID] == ALL_IN_ONE_PACKAGE
&& (buf[pstatus]) == TOUCHDOWN) {
- TPInfo->pt[i].Width = 1;
- TPInfo->pt[i].Height = 1;
- TPInfo->pt[i].Pressure = 1;
+ tp_info->pt[i].width = 1;
+ tp_info->pt[i].height = 1;
+ tp_info->pt[i].pressure = 1;
} else if ((buf[pstatus]) == TOUCHDOWN) {
p_area = py + 2;
p_preasure = py + 2 + (IS_AREA(buf[P_REPORT_ID]) * 2);
/*area*/
if (IS_AREA(buf[P_REPORT_ID])) {
- TPInfo->pt[i].Width = buf[p_area];
- TPInfo->pt[i].Height = buf[p_area + 1];
+ tp_info->pt[i].width = buf[p_area];
+ tp_info->pt[i].height = buf[p_area + 1];
} else {
- TPInfo->pt[i].Width = 1;
- TPInfo->pt[i].Height = 1;
+ tp_info->pt[i].width = 1;
+ tp_info->pt[i].height = 1;
}
/*pressure*/
if (IS_PRESSURE(buf[P_REPORT_ID]))
- TPInfo->pt[i].Pressure = (buf[p_preasure]);
+ tp_info->pt[i].pressure = (buf[p_preasure]);
else
- TPInfo->pt[i].Pressure = 1;
- } else {
- pr_err("sis_ts_work_func: Error Touch Status\n");
- goto err_free_allocate;
- }
- TPInfo->pt[i].id = (buf[pstatus + 1]);
- TPInfo->pt[i].x = get_unaligned_le16(&buf[px]);
- TPInfo->pt[i].y = get_unaligned_le16(&buf[py]);
-
- CheckID[TPInfo->pt[i].id] = 1;
- MM_Slot[TPInfo->pt[i].id].id = TPInfo->pt[i].id;
- MM_Slot[TPInfo->pt[i].id].Pressure = TPInfo->pt[i].Pressure;
- MM_Slot[TPInfo->pt[i].id].x = TPInfo->pt[i].x;
- MM_Slot[TPInfo->pt[i].id].y = TPInfo->pt[i].y;
- MM_Slot[TPInfo->pt[i].id].Width = TPInfo->pt[i].Width
+ tp_info->pt[i].pressure = 1;
+ } else
+ return -EPERM;
+
+ tp_info->pt[i].id = (buf[pstatus + 1]);
+ tp_info->pt[i].x = get_unaligned_le16(&buf[px]);
+ tp_info->pt[i].y = get_unaligned_le16(&buf[py]);
+
+ check_id[tp_info->pt[i].id] = 1;
+ sisdata[tp_info->pt[i].id].id = tp_info->pt[i].id;
+ sisdata[tp_info->pt[i].id].pressure = tp_info->pt[i].pressure;
+ sisdata[tp_info->pt[i].id].x = tp_info->pt[i].x;
+ sisdata[tp_info->pt[i].id].y = tp_info->pt[i].y;
+ sisdata[tp_info->pt[i].id].width = tp_info->pt[i].width
* AREA_UNIT;
- MM_Slot[TPInfo->pt[i].id].Height = TPInfo->pt[i].Height
+ sisdata[tp_info->pt[i].id].height = tp_info->pt[i].height
* AREA_UNIT;
+ }
+ return 0;
+}
+
+static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id)
+{
+ struct sis_ts_data *ts = dev_id;
+ struct sistp_driver_data *tp_info = ts->tp_info;
+ int ret;
+ u8 buf[PACKET_BUFFER_SIZE] = {0};
+ u8 i = 0, fingers = 0;
+ int check_id[MAX_FINGERS];
+ static int pre_check_id[MAX_FINGERS];
+ struct sis_slot sisdata[MAX_FINGERS];
+
+ memset(check_id, 0, sizeof(int)*MAX_FINGERS);
+ /*I2C or SMBUS block data read*/
+ ret = sis_readpacket(ts->client, SIS_CMD_NORMAL, buf);
+ /*Error Number*/
+ if (ret < 0)
+ goto out;
+ /*access NO TOUCH event unless BUTTON NO TOUCH event*/
+ else if (ret == 0) {
+ fingers = 0;
+ sis_tpinfo_clear(tp_info, MAX_FINGERS);
+ goto type_b_report;
}
-Tye_B_report:
+ sis_tpinfo_clear(tp_info, MAX_FINGERS);
+ fingers = ret;
+ ret = sis_parse_i2c_event(buf, fingers, tp_info, check_id, sisdata);
+ if (ret < 0)
+ goto out;
+
+type_b_report:
for (i = 0; i < MAX_FINGERS; i++) {
- if ((CheckID[i] != Pre_CheckID[i]) && (CheckID[i] != 1))
- CheckID[i] = -1;
+ if ((check_id[i] != pre_check_id[i]) && (check_id[i] != 1))
+ check_id[i] = -1;
}
for (i = 0; i < MAX_FINGERS; i++) {
- if (CheckID[i] == 1) {
+ if (check_id[i] == 1) {
input_mt_slot(ts->input_dev, i+1);
- if (MM_Slot[i].Pressure > 0) {
+ if (sisdata[i].pressure > 0) {
input_mt_report_slot_state(ts->input_dev,
- MT_TOOL_FINGER, true);
+ MT_TOOL_FINGER, true);
input_report_abs(ts->input_dev,
- ABS_MT_PRESSURE, MM_Slot[i].Pressure);
+ ABS_MT_PRESSURE, sisdata[i].pressure);
input_report_abs(ts->input_dev,
- ABS_MT_TOUCH_MAJOR, MM_Slot[i].Width);
+ ABS_MT_TOUCH_MAJOR, sisdata[i].width);
input_report_abs(ts->input_dev,
- ABS_MT_TOUCH_MINOR, MM_Slot[i].Height);
+ ABS_MT_TOUCH_MINOR, sisdata[i].height);
input_report_abs(ts->input_dev,
- ABS_MT_POSITION_X, MM_Slot[i].x);
+ ABS_MT_POSITION_X, sisdata[i].x);
input_report_abs(ts->input_dev,
- ABS_MT_POSITION_Y, MM_Slot[i].y);
+ ABS_MT_POSITION_Y, sisdata[i].y);
} else {
input_mt_report_slot_state(ts->input_dev,
- MT_TOOL_FINGER, false);
- CheckID[i] = 0;
+ MT_TOOL_FINGER, false);
+ check_id[i] = 0;
}
- } else if (CheckID[i] == -1) {
+ } else if (check_id[i] == -1) {
input_mt_slot(ts->input_dev, i+1);
input_mt_report_slot_state(ts->input_dev,
MT_TOOL_FINGER, false);
- CheckID[i] = 0;
+ check_id[i] = 0;
}
- Pre_CheckID[i] = CheckID[i];
+ pre_check_id[i] = check_id[i];
}
input_sync(ts->input_dev);
-err_free_allocate:
-
- if (ts->use_irq) {
-#ifdef _INT_MODE_1 /*case 1 mode*/
- /*TODO: After interrupt status low,
- * read i2c bus data by polling,
- * until interrupt status is high*/
- ret = gpio_get_value(GPIO_IRQ);
- /*interrupt pin is still LOW,
- * read data until interrupt pin is released.*/
- if (!ret)
- hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS),
- HRTIMER_MODE_REL);
- else {
- /*clear for interrupt*/
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(ts->client->irq);
- }
-#else /*case 2 mode*/
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(ts->client->irq);
-#endif
- }
-
- mutex_unlock(&ts->mutex_wq);
+out:
+ return IRQ_HANDLED;
}
-static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max)
+static void sis_tpinfo_clear(struct sistp_driver_data *tp_info, int max)
{
int i = 0;
for (i = 0; i < max; i++) {
- TPInfo->pt[i].id = -1;
- TPInfo->pt[i].x = 0;
- TPInfo->pt[i].y = 0;
- TPInfo->pt[i].Pressure = 0;
- TPInfo->pt[i].Width = 0;
+ tp_info->pt[i].id = -1;
+ tp_info->pt[i].x = 0;
+ tp_info->pt[i].y = 0;
+ tp_info->pt[i].pressure = 0;
+ tp_info->pt[i].width = 0;
}
- TPInfo->id = 0x0;
- TPInfo->fingers = 0;
-}
-
-static enum hrtimer_restart sis_ts_timer_func(struct hrtimer *timer)
-{
- struct sis_ts_data *ts = container_of(timer, struct sis_ts_data, timer);
-
- queue_work(sis_wq, &ts->work);
- if (!ts->use_irq) /*For Polling mode*/
- hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS), HRTIMER_MODE_REL);
- return HRTIMER_NORESTART;
-}
-
-static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id)
-{
- struct sis_ts_data *ts = dev_id;
-
- if (!irqd_irq_disabled(&ts->desc->irq_data))
- disable_irq_nosync(ts->client->irq);
- queue_work(sis_wq, &ts->work);
- return IRQ_HANDLED;
-}
-
-static int initial_irq(void)
-{
- int ret = 0;
-
- /* initialize gpio and interrupt pins */
- /*ex. GPIO_133 for interrupt mode*/
- ret = gpio_request(GPIO_IRQ, "GPIO_54");
- if (ret < 0) {
- /*Set Active Low.
- * Please reference the file include/linux/interrupt.h*/
- pr_err("sis_ts_probe: Failed to gpio_request\n");
- pr_err("sis_ts_probe: Fail : gpio_request was called before this driver call\n");
- }
- /* setting gpio direction here OR boardinfo file*/
- return ret;
+ tp_info->id = 0x0;
+ tp_info->fingers = 0;
}
static int sis_ts_probe(
struct i2c_client *client, const struct i2c_device_id *id)
{
- int ret = 0;
- struct sis_ts_data *ts = NULL;
- struct sis_i2c_rmi_platform_data *pdata = NULL;
-
- pr_info("sis_ts_probe\n");
- ts = kzalloc(sizeof(struct sis_ts_data), GFP_KERNEL);
- if (ts == NULL) {
- ret = -ENOMEM;
- goto err_alloc_data_failed;
- }
- ts->TPInfo = kzalloc(sizeof(struct sisTP_driver_data), GFP_KERNEL);
- if (ts->TPInfo == NULL) {
- ret = -ENOMEM;
- goto err_alloc_data_failed;
+ int err = 0;
+ struct sis_ts_data *ts;
+
+ dev_dbg(&client->dev, "sis_ts_probe\n");
+ ts = devm_kzalloc(&client->dev, sizeof(struct sis_ts_data),
+ GFP_KERNEL);
+ if (!ts)
+ return -ENOMEM;
+ ts->tp_info = devm_kzalloc(&client->dev,
+ sizeof(struct sistp_driver_data),
+ GFP_KERNEL);
+ if (!ts->tp_info) {
+ dev_err(&client->dev, "Failed to allocate memory\n");
+ return -ENOMEM;
}
- ts_bak = ts;
- mutex_init(&ts->mutex_wq);
- /*1. Init Work queue and necessary buffers*/
- INIT_WORK(&ts->work, sis_ts_work_func);
+ /*1. Init necessary buffers*/
ts->client = client;
i2c_set_clientdata(client, ts);
- pdata = client->dev.platform_data;
- if (pdata)
- ts->power = pdata->power;
- if (ts->power) {
- ret = ts->power(1);
- if (ret < 0) {
- pr_err("sis_ts_probe power on failed\n");
- goto err_power_failed;
- }
- }
+
/*2. Allocate input device*/
- ts->input_dev = input_allocate_device();
- if (ts->input_dev == NULL) {
- ret = -ENOMEM;
- pr_err("sis_ts_probe: Failed to allocate input device\n");
+ ts->input_dev = devm_input_allocate_device(&client->dev);
+ if (!ts->input_dev) {
+ err = -ENOMEM;
+ dev_err(&client->dev, "sis_ts_probe: Failed to allocate input device\n");
goto err_input_dev_alloc_failed;
}
- /*This input device name should be the same to IDC file name.*/
ts->input_dev->name = "sis_touch";
set_bit(EV_ABS, ts->input_dev->evbit);
set_bit(EV_KEY, ts->input_dev->evbit);
- set_bit(ABS_MT_POSITION_X, ts->input_dev->absbit);
- set_bit(ABS_MT_POSITION_Y, ts->input_dev->absbit);
- set_bit(ABS_MT_PRESSURE, ts->input_dev->absbit);
- set_bit(ABS_MT_TOUCH_MAJOR, ts->input_dev->absbit);
- set_bit(ABS_MT_TOUCH_MINOR, ts->input_dev->absbit);
-
- input_mt_init_slots(ts->input_dev, MAX_SLOTS, INPUT_MT_DIRECT);
-
input_set_abs_params(ts->input_dev, ABS_MT_PRESSURE,
0, PRESSURE_MAX, 0, 0);
input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR,
@@ -458,170 +436,90 @@ static int sis_ts_probe(
0, SIS_MAX_X, 0, 0);
input_set_abs_params(ts->input_dev, ABS_MT_POSITION_Y,
0, SIS_MAX_Y, 0, 0);
+ input_mt_init_slots(ts->input_dev, MAX_SLOTS, INPUT_MT_DIRECT);
/* add for touch keys */
set_bit(KEY_COMPOSE, ts->input_dev->keybit);
set_bit(KEY_BACK, ts->input_dev->keybit);
set_bit(KEY_MENU, ts->input_dev->keybit);
set_bit(KEY_HOME, ts->input_dev->keybit);
+
/*3. Register input device to core*/
- ret = input_register_device(ts->input_dev);
- if (ret) {
- pr_err("sis_ts_probe: Unable to register %s input device\n",
- ts->input_dev->name);
+ err = input_register_device(ts->input_dev);
+ if (err) {
+ dev_err(&client->dev,
+ "sis_ts_probe: Unable to register %s input device\n",
+ ts->input_dev->name);
goto err_input_register_device_failed;
}
- /*4. irq or timer setup*/
- ret = initial_irq();
- if (ret >= 0) {
- client->irq = gpio_to_irq(GPIO_IRQ);
- ret = request_irq(client->irq, sis_ts_irq_handler,
- IRQF_TRIGGER_FALLING, client->name, ts);
- if (ret == 0)
- ts->use_irq = 1;
- else
- dev_err(&client->dev, "request_irq failed\n");
- }
- ts->desc = irq_to_desc(ts_bak->client->irq);
- hrtimer_init(&ts->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
- ts->timer.function = sis_ts_timer_func;
- if (!ts->use_irq)
- hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL);
- pr_info("sis_ts_probe: Start touchscreen %s in %s mode\n",
- ts->input_dev->name,
- ts->use_irq ? "interrupt" : "polling");
- if (ts->use_irq) {
-#ifdef _INT_MODE_1
- pr_info("sis_ts_probe: interrupt case 1 mode\n");
-#else
- pr_info("sis_ts_probe: interrupt case 2 mode\n");
-#endif
+
+ /*4. irq setup*/
+ err = devm_request_threaded_irq(&client->dev, client->irq, NULL,
+ sis_ts_irq_handler,
+ IRQF_TRIGGER_FALLING, client->name,
+ ts);
+ if (err < 0) {
+ dev_err(&client->dev, "Failed to request touchscreen IRQ\n");
+ goto err_request_threaded_irq;
}
- pr_info("sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR);
+
+ dev_dbg(&client->dev, "sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR);
return 0;
+err_request_threaded_irq:
err_input_register_device_failed:
input_free_device(ts->input_dev);
err_input_dev_alloc_failed:
-err_power_failed:
- kfree(ts->TPInfo);
+ kfree(ts->tp_info);
kfree(ts);
-err_alloc_data_failed:
- return ret;
+ return err;
}
static int sis_ts_remove(struct i2c_client *client)
{
struct sis_ts_data *ts = i2c_get_clientdata(client);
- if (ts->use_irq)
- free_irq(client->irq, ts);
- else
- hrtimer_cancel(&ts->timer);
input_unregister_device(ts->input_dev);
+ input_free_device(ts->input_dev);
+ kfree(ts->tp_info);
kfree(ts);
return 0;
}
-#ifdef CONFIG_PM_SLEEP
-static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg)
+static int __maybe_unused sis_ts_suspend(struct device *dev)
{
- int ret = 0;
- struct sis_ts_data *ts = i2c_get_clientdata(client);
-
- if (ts->use_irq) {
- if (!irqd_irq_disabled(&ts->desc->irq_data))
- disable_irq(client->irq);
- } else
- hrtimer_cancel(&ts->timer);
- flush_workqueue(sis_wq); /*only flush sis_wq*/
-
-
- if (ts->power) {
- ret = ts->power(0);
- if (ret < 0)
- pr_err("sis_ts_suspend power off failed\n");
- }
+ struct i2c_client *client = to_i2c_client(dev);
+ disable_irq(client->irq);
return 0;
}
-static int sis_ts_resume(struct i2c_client *client)
+static int __maybe_unused sis_ts_resume(struct device *dev)
{
- int ret = 0;
- struct sis_ts_data *ts = i2c_get_clientdata(client);
+ struct i2c_client *client = to_i2c_client(dev);
- if (ts->power) {
- ret = ts->power(1);
- if (ret < 0)
- pr_err("sis_ts_resume power on failed\n");
- }
-
- if (ts->use_irq) {
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(client->irq);
- } else
- hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL);
+ enable_irq(client->irq);
return 0;
}
-#endif
static SIMPLE_DEV_PM_OPS(sis_ts_pm, sis_ts_suspend, sis_ts_resume);
-#ifdef CONFIG_X86
-/* Return 0 if detection is successful, -ENODEV otherwise */
-static int sis_ts_detect(struct i2c_client *client,
- struct i2c_board_info *info)
-{
- const char *type_name;
-
- pr_info("sis_ts_detect\n");
- type_name = "sis_i2c_ts";
- strlcpy(info->type, type_name, I2C_NAME_SIZE);
- return 0;
-}
-#endif
-
static const struct i2c_device_id sis_ts_id[] = {
{ SIS_I2C_NAME, 0 },
{ }
};
-
MODULE_DEVICE_TABLE(i2c, sis_ts_id);
static struct i2c_driver sis_ts_driver = {
.driver = {
.name = SIS_I2C_NAME,
+ .owner = THIS_MODULE,
.pm = &sis_ts_pm,
},
.probe = sis_ts_probe,
.remove = sis_ts_remove,
-#ifdef CONFIG_X86
- .class = I2C_CLASS_HWMON,
- .detect = sis_ts_detect,
- .address_list = normal_i2c,
-#endif
- .id_table = sis_ts_id,
+ .id_table = sis_ts_id,
};
+module_i2c_driver(sis_ts_driver);
-static int __init sis_ts_init(void)
-{
- pr_info("sis_ts_init\n");
- sis_wq = create_singlethread_workqueue("sis_wq");
-
- if (!sis_wq)
- return -ENOMEM;
- return i2c_add_driver(&sis_ts_driver);
-}
-
-static void __exit sis_ts_exit(void)
-{
- pr_info("sis_ts_exit\n");
- i2c_del_driver(&sis_ts_driver);
- if (sis_wq)
- destroy_workqueue(sis_wq);
-}
-
-module_init(sis_ts_init);
-module_exit(sis_ts_exit);
MODULE_DESCRIPTION("SiS 9200 Family Touchscreen Driver");
-MODULE_LICENSE("GPL");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/sis_i2c.h b/drivers/input/touchscreen/sis_i2c.h
deleted file mode 100644
index a075158..0000000
--- a/drivers/input/touchscreen/sis_i2c.h
+++ /dev/null
@@ -1,164 +0,0 @@
-/*
- * Touch Screen driver for SiS 9200 family I2C Touch panels
- *
- * Copyright (C) 2015 SiS, Inc.
- *
- * This software is licensed under the terms of the GNU General Public
- * License version 2, as published by the Free Software Foundation, and
- * may be copied, distributed, and modified under those terms.
- *
- * 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.
- *
- * Date: 2015/07/07
- */
-#include <linux/version.h>
-
-#ifndef _LINUX_SIS_I2C_H
-#define _LINUX_SIS_I2C_H
-
-
-#define SIS_I2C_NAME "sis_i2c_ts"
-#define SIS_SLAVE_ADDR 0x5c
-/*10ms*/
-#define TIMER_NS 10000000
-#define MAX_FINGERS 10
-
-/* Check data CRC */
-/*#define _CHECK_CRC*/ /*ON/OFF*/
-
-/* Interrupt modes */
-#define GPIO_IRQ 54
-
-/* Enable if use interrupt case 1 mode. */
-/* Disable if use interrupt case 2 mode. */
-/*#define _INT_MODE_1*/ /*ON/OFF*/
-
-/* Resolution mode */
-/*Constant value*/
-#define SIS_MAX_X 4095
-#define SIS_MAX_Y 4095
-
-#define ONE_BYTE 1
-#define FIVE_BYTE 5
-#define EIGHT_BYTE 8
-#define SIXTEEN_BYTE 16
-#define PACKET_BUFFER_SIZE 128
-
-#define SIS_CMD_NORMAL 0x0
-#define SIS_CMD_SOFTRESET 0x82
-#define SIS_CMD_RECALIBRATE 0x87
-#define SIS_CMD_POWERMODE 0x90
-#define MSK_TOUCHNUM 0x0f
-#define MSK_HAS_CRC 0x10
-#define MSK_DATAFMT 0xe0
-#define MSK_PSTATE 0x0f
-#define MSK_PID 0xf0
-#define RES_FMT 0x00
-#define FIX_FMT 0x40
-
-/* for new i2c format */
-#define TOUCHDOWN 0x3
-#define TOUCHUP 0x0
-#define MAX_BYTE 64
-#define PRESSURE_MAX 255
-
-/*Resolution diagonal */
-#define AREA_LENGTH_LONGER 5792
-/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/
-#define AREA_LENGTH_SHORT 5792
-#define AREA_UNIT (5792/32)
-
-
-#define FORMAT_MODE 1
-
-#define MSK_NOBTN 0
-#define MSK_COMP 1
-#define MSK_BACK 2
-#define MSK_MENU 4
-#define MSK_HOME 8
-
-#define P_BYTECOUNT 0
-#define ALL_IN_ONE_PACKAGE 0x10
-#define IS_TOUCH(x) (x & 0x1)
-#define IS_HIDI2C(x) ((x & 0xF) == 0x06)
-#define IS_AREA(x) ((x >> 4) & 0x1)
-#define IS_PRESSURE(x) ((x >> 5) & 0x1)
-#define IS_SCANTIME(x) ((x >> 6) & 0x1)
-#define NORMAL_LEN_PER_POINT 6
-#define AREA_LEN_PER_POINT 2
-#define PRESSURE_LEN_PER_POINT 1
-
-#define TOUCH_FORMAT 0x1
-#define BUTTON_FORMAT 0x4
-#define HIDI2C_FORMAT 0x6
-#define P_REPORT_ID 2
-#define BUTTON_STATE 3
-#define BUTTON_KEY_COUNT 16
-#define BYTE_BYTECOUNT 2
-#define BYTE_COUNT 1
-#define BYTE_ReportID 1
-#define BYTE_CRC_HIDI2C 0
-#define BYTE_CRC_I2C 2
-#define BYTE_SCANTIME 2
-#define NO_TOUCH_BYTECOUNT 0x3
-
-/* TODO */
-#define TOUCH_POWER_PIN 0
-#define TOUCH_RESET_PIN 1
-
-/* CMD Define */
-#define BUF_ACK_PLACE_L 4
-#define BUF_ACK_PLACE_H 5
-#define BUF_ACK_L 0xEF
-#define BUF_ACK_H 0xBE
-#define BUF_NACK_L 0xAD
-#define BUF_NACK_H 0xDE
-#define BUF_CRC_PLACE 7
-#define MAX_SLOTS 15
-
-struct sis_i2c_rmi_platform_data {
- int (*power)(int on); /* Only valid in first array entry */
-};
-
-struct TypeB_Slot {
- int CheckID;
- int id;
- unsigned short x, y;
- uint16_t Pressure;
- uint16_t Width;
- uint16_t Height;
-};
-
-struct Point {
- int id;
- unsigned short x, y; /*uint16_t ?*/
- uint16_t Pressure;
- uint16_t Width;
- uint16_t Height;
-};
-
-struct sisTP_driver_data {
- int id;
- int fingers;
- struct Point pt[MAX_FINGERS];
-};
-
-struct sis_ts_data {
- int (*power)(int on);
- int use_irq;
- struct i2c_client *client;
- struct input_dev *input_dev;
- struct hrtimer timer;
- struct irq_desc *desc;
- struct work_struct work;
- struct mutex mutex_wq;
- struct sisTP_driver_data *TPInfo;
-};
-
-static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg);
-static int sis_ts_resume(struct i2c_client *client);
-
-#endif /* _LINUX_SIS_I2C_H */
--
1.9.1
^ permalink raw reply related [flat|nested] 5+ messages in thread
* [PATCHv2] Add support for SiS i2c touch driver
@ 2015-09-21 9:37 Yuger
0 siblings, 0 replies; 5+ messages in thread
From: Yuger @ 2015-09-21 9:37 UTC (permalink / raw)
To: Dmitry Torokhov, linux-input; +Cc: yuger.yu, yuger_yu, tammy_tseng
Hi, This patch is to add support for SiS i2c touch panel.
Thanks a lot.
v2: Fixed coding style and changed to threaded IRQ.
Signed-off-by: Yuger <yuger_yu@sis.com>
---
drivers/input/touchscreen/Kconfig | 2 +-
drivers/input/touchscreen/sis_i2c.c | 646 +++++++++++++++---------------------
drivers/input/touchscreen/sis_i2c.h | 164 ---------
3 files changed, 273 insertions(+), 539 deletions(-)
delete mode 100644 drivers/input/touchscreen/sis_i2c.h
diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig
index 3d7a30d..ca8420e 100644
--- a/drivers/input/touchscreen/Kconfig
+++ b/drivers/input/touchscreen/Kconfig
@@ -1029,7 +1029,7 @@ config TOUCHSCREEN_ZFORCE
config TOUCHSCREEN_SIS_I2C
tristate "SiS 9200 family I2C touchscreen driver"
- depends on I2C
+ depends on I2C && CRC_ITU_T
help
Say Y here to enable support for I2C connected SiS touch panels.
diff --git a/drivers/input/touchscreen/sis_i2c.c b/drivers/input/touchscreen/sis_i2c.c
index 22dfc1f..f7b6ac5 100644
--- a/drivers/input/touchscreen/sis_i2c.c
+++ b/drivers/input/touchscreen/sis_i2c.c
@@ -12,20 +12,13 @@
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
- * Date: 2015/07/07
*/
-#include <linux/errno.h>
#include <linux/module.h>
-#include <linux/delay.h>
-#include <linux/hrtimer.h>
#include <linux/i2c.h>
#include <linux/input.h>
#include <linux/interrupt.h>
-#include <linux/io.h>
#include <linux/platform_device.h>
-#include "sis_i2c.h"
-#include <linux/linkage.h>
#include <linux/slab.h>
#include <linux/gpio.h>
#include <linux/uaccess.h>
@@ -34,27 +27,86 @@
#include <linux/input/mt.h> /*For Type-B Slot function*/
#include <linux/crc-itu-t.h> /*For CRC Check*/
-/* Addresses to scan */
-static const unsigned short normal_i2c[] = { SIS_SLAVE_ADDR, I2C_CLIENT_END };
-static struct workqueue_struct *sis_wq;
-struct sis_ts_data *ts_bak;
-static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max);
+#define SIS_I2C_NAME "sis_i2c_ts"
+#define SIS_SLAVE_ADDR 0x5c
+#define MAX_FINGERS 10
+
+/*Resolution mode*/
+/*Constant value*/
+#define SIS_MAX_X 4095
+#define SIS_MAX_Y 4095
+
+#define PACKET_BUFFER_SIZE 128
+
+#define SIS_CMD_NORMAL 0x0
+
+/* for new i2c format */
+#define TOUCHDOWN 0x3
+#define TOUCHUP 0x0
+#define MAX_BYTE 64
+#define PRESSURE_MAX 255
+
+/*Resolution diagonal */
+#define AREA_LENGTH_LONGER 5792
+/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/
+#define AREA_LENGTH_SHORT 5792
+#define AREA_UNIT (5792/32)
+
+#define P_BYTECOUNT 0
+#define ALL_IN_ONE_PACKAGE 0x10
+#define IS_TOUCH(x) (x & 0x1)
+#define IS_HIDI2C(x) ((x & 0xF) == 0x06)
+#define IS_AREA(x) ((x >> 4) & 0x1)
+#define IS_PRESSURE(x) ((x >> 5) & 0x1)
+#define IS_SCANTIME(x) ((x >> 6) & 0x1)
+#define NORMAL_LEN_PER_POINT 6
+#define AREA_LEN_PER_POINT 2
+#define PRESSURE_LEN_PER_POINT 1
+
+#define TOUCH_FORMAT 0x1
+#define HIDI2C_FORMAT 0x6
+#define P_REPORT_ID 2
+#define BYTE_BYTECOUNT 2
+#define BYTE_ReportID 1
+#define BYTE_CRC_HIDI2C 0
+#define BYTE_CRC_I2C 2
+#define BYTE_SCANTIME 2
+
+#define MAX_SLOTS 15
+
+struct sis_slot {
+ int check_id;
+ int id;
+ unsigned short x, y;
+ u16 pressure;
+ u16 width;
+ u16 height;
+};
-static int sis_command_for_read(struct i2c_client *client, int rlength,
- unsigned char *rdata)
-{
- int ret;
- struct i2c_msg msg;
+struct point {
+ int id;
+ unsigned short x, y;
+ u16 pressure;
+ u16 width;
+ u16 height;
+};
- msg.addr = client->addr;
- msg.flags = I2C_M_RD; /*Read*/
- msg.len = rlength;
- msg.buf = rdata;
- ret = i2c_transfer(client->adapter, &msg, 1);
- return ret;
-}
+struct sistp_driver_data {
+ int id;
+ int fingers;
+ struct point pt[MAX_FINGERS];
+};
+
+struct sis_ts_data {
+ struct i2c_client *client;
+ struct input_dev *input_dev;
+ struct sistp_driver_data *tp_info;
+};
-static int sis_cul_unit(uint8_t report_id)
+/* Addresses to scan */
+static void sis_tpinfo_clear(struct sistp_driver_data *tp_info, int max);
+
+static int sis_cul_unit(u8 report_id)
{
int ret = NORMAL_LEN_PER_POINT;
@@ -68,73 +120,76 @@ static int sis_cul_unit(uint8_t report_id)
return ret;
}
-static int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf)
+static int sis_readpacket(struct i2c_client *client, u8 cmd, u8 *buf)
{
- uint8_t tmpbuf[MAX_BYTE] = {0}; /*MAX_BYTE = 64;*/
+ u8 tmpbuf[MAX_BYTE] = {0}; /*MAX_BYTE = 64;*/
int ret;
int touchnum = 0;
int p_count = 0;
- int touc_formate_id = 0;
+ int touch_format_id = 0;
int locate = 0;
bool read_first = true;
/*
- * New i2c format
- * buf[0] = Low 8 bits of byte count value
- * buf[1] = High 8 bits of byte counte value
- * buf[2] = Report ID
- * buf[touch num * 6 + 2 ] = Touch information;
- * 1 touch point has 6 bytes, it could be none if no touch
- * buf[touch num * 6 + 3] = Touch numbers
- *
- * One touch point information include 6 bytes, the order is
- *
- * 1. status = touch down or touch up
- * 2. id = finger id
- * 3. x axis low 8 bits
- * 4. x axis high 8 bits
- * 5. y axis low 8 bits
- * 6. y axis high 8 bits
- * */
+ * New i2c format
+ * buf[0] = Low 8 bits of byte count value
+ * buf[1] = High 8 bits of byte count value
+ * buf[2] = Report ID
+ * buf[touch num * 6 + 2 ] = Touch information;
+ * 1 touch point has 6 bytes, it could be none if no touch
+ * buf[touch num * 6 + 3] = Touch numbers
+ *
+ * One touch point information include 6 bytes, the order is
+ *
+ * 1. status = touch down or touch up
+ * 2. id = finger id
+ * 3. x axis low 8 bits
+ * 4. x axis high 8 bits
+ * 5. y axis low 8 bits
+ * 6. y axis high 8 bits
+ */
do {
if (locate >= PACKET_BUFFER_SIZE) {
- pr_err("sis_ReadPacket: Buf Overflow\n");
+ dev_err(&client->dev, "sis_readpacket: Buf Overflow\n");
return -EPERM;
}
- ret = sis_command_for_read(client, MAX_BYTE, tmpbuf);
+ ret = i2c_master_recv(client, tmpbuf, MAX_BYTE);
if (ret < 0) {
- pr_err("sis_ReadPacket: i2c transfer error\n");
+ dev_err(&client->dev, "sis_readpacket: i2c transfer error\n");
return ret;
}
/*error package length of receiving data*/
else if (tmpbuf[P_BYTECOUNT] > MAX_BYTE) {
- pr_err("sis_ReadPacket: Error Bytecount\n");
+ dev_err(&client->dev, "sis_readpacket: Error Bytecount\n");
return -EPERM;
}
if (read_first) {
/*access NO TOUCH event unless BUTTON NO TOUCH event*/
- if (tmpbuf[P_BYTECOUNT] == 0/*NO_TOUCH_BYTECOUNT*/)
+ if (tmpbuf[P_BYTECOUNT] == 0)
return 0; /*touchnum is 0*/
}
- /*skip parsing data when two devices are registered
- * at the same slave address*/
- /*parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT
- * or P_REPORT_ID is ALL_IN_ONE_PACKAGE*/
- touc_formate_id = tmpbuf[P_REPORT_ID] & 0xf;
- if ((touc_formate_id != TOUCH_FORMAT)
- && (touc_formate_id != HIDI2C_FORMAT)
- && (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) {
- pr_err("sis_ReadPacket: Error Report_ID\n");
+ /*
+ * skip parsing data when two devices are registered
+ * at the same slave address
+ * parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT
+ * or P_REPORT_ID is ALL_IN_ONE_PACKAGE
+ */
+ touch_format_id = tmpbuf[P_REPORT_ID] & 0xf;
+ if ((touch_format_id != TOUCH_FORMAT) &&
+ (touch_format_id != HIDI2C_FORMAT) &&
+ (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) {
+ dev_err(&client->dev, "sis_readpacket: Error Report_ID\n");
return -EPERM;
}
p_count = (int) tmpbuf[P_BYTECOUNT] - 1; /*start from 0*/
if (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE) {
if (IS_TOUCH(tmpbuf[P_REPORT_ID])) {
- p_count -= BYTE_CRC_I2C;/*delete 2 byte crc*/
+ /*delete 2 byte crc*/
+ p_count -= BYTE_CRC_I2C;
} else if (IS_HIDI2C(tmpbuf[P_REPORT_ID])) {
p_count -= BYTE_CRC_HIDI2C;
} else { /*should not be happen*/
- pr_err("sis_ReadPacket: delete crc error\n");
+ dev_err(&client->dev, "sis_readpacket: delete crc error\n");
return -EPERM;
}
if (IS_SCANTIME(tmpbuf[P_REPORT_ID]))
@@ -145,76 +200,49 @@ static int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf)
touchnum = tmpbuf[p_count];
} else {
if (tmpbuf[p_count] != 0) {
- pr_err("sis_ReadPacket: get error package\n");
+ dev_err(&client->dev, "sis_readpacket: get error package\n");
return -EPERM;
}
}
-#ifdef _CHECK_CRC
- /* HID over I2C data foramt and no touch packet without CRC */
- if ((touc_formate_id != HIDI2C_FORMAT) &&
+ if ((touch_format_id != HIDI2C_FORMAT) &&
(tmpbuf[P_BYTECOUNT] > 3)) {
int crc_end = p_count + (IS_SCANTIME(
tmpbuf[P_REPORT_ID]) * 2);
- uint16_t buf_crc = crc_itu_t(
+ u16 buf_crc = crc_itu_t(
0, tmpbuf + 2, crc_end - 1);
int l_package_crc = (IS_SCANTIME(
tmpbuf[P_REPORT_ID]) * 2) + p_count + 1;
- uint16_t package_crc = get_unaligned_le16(
+ u16 package_crc = get_unaligned_le16(
&tmpbuf[l_package_crc]);
if (buf_crc != package_crc) {
- pr_err("sis_ReadPacket: CRC Error\n");
+ dev_err(&client->dev, "sis_readpacket: CRC Error\n");
return -EPERM;
}
}
-#endif
- memcpy(&buf[locate], &tmpbuf[0], 64);
+
+ memcpy(&buf[locate], &tmpbuf[0], MAX_BYTE);
/*Buf_Data [0~63] [64~128]*/
- locate += 64;
+ locate += MAX_BYTE;
read_first = false;
} while (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE &&
tmpbuf[p_count] > 5);
return touchnum;
}
-static void sis_ts_work_func(struct work_struct *work)
+static int sis_parse_i2c_event(u8 *buf, u8 fingers,
+ struct sistp_driver_data *tp_info,
+ int *check_id, struct sis_slot *sisdata)
{
- struct sis_ts_data *ts = container_of(work, struct sis_ts_data, work);
- struct sisTP_driver_data *TPInfo = ts->TPInfo;
- int ret;
int point_unit;
- uint8_t buf[PACKET_BUFFER_SIZE] = {0};
- uint8_t i = 0, fingers = 0;
- uint8_t px = 0, py = 0, pstatus = 0;
- uint8_t p_area = 0;
- uint8_t p_preasure = 0;
- int CheckID[MAX_FINGERS];
- static int Pre_CheckID[MAX_FINGERS];
- struct TypeB_Slot MM_Slot[MAX_FINGERS];
-
- memset(CheckID, 0, sizeof(int)*MAX_FINGERS);
-
- mutex_lock(&ts->mutex_wq);
- /*I2C or SMBUS block data read*/
- ret = sis_ReadPacket(ts->client, SIS_CMD_NORMAL, buf);
- /*Error Number*/
- if (ret < 0)
- goto err_free_allocate;
- /*access NO TOUCH event unless BUTTON NO TOUCH event*/
- else if (ret == 0) {
- fingers = 0;
- sis_tpinfo_clear(TPInfo, MAX_FINGERS);
-
- goto Tye_B_report;
- }
- sis_tpinfo_clear(TPInfo, MAX_FINGERS);
-
- /*Parser and Get the sis9200 data*/
+ u8 i = 0, pstatus = 0;
+ u8 px = 0, py = 0;
+ u8 p_area = 0;
+ u8 p_preasure = 0;
+ /*Parser and Get the sis data*/
point_unit = sis_cul_unit(buf[P_REPORT_ID]);
- fingers = ret;
-
- TPInfo->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers);
+ tp_info->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers);
/*fingers 10 = 0 ~ 9*/
for (i = 0; i < fingers; i++) {
@@ -228,226 +256,176 @@ static void sis_ts_work_func(struct work_struct *work)
+ (i * point_unit);
/*Calc point status*/
}
- px = pstatus + 2; /*Calc point x_coord*/
- py = px + 2; /*Calc point y_coord*/
+ px = pstatus + 2; /*Calc point x_coord*/
+ py = px + 2; /*Calc point y_coord*/
if ((buf[pstatus]) == TOUCHUP) {
- TPInfo->pt[i].Width = 0;
- TPInfo->pt[i].Height = 0;
- TPInfo->pt[i].Pressure = 0;
+ tp_info->pt[i].width = 0;
+ tp_info->pt[i].height = 0;
+ tp_info->pt[i].pressure = 0;
} else if (buf[P_REPORT_ID] == ALL_IN_ONE_PACKAGE
&& (buf[pstatus]) == TOUCHDOWN) {
- TPInfo->pt[i].Width = 1;
- TPInfo->pt[i].Height = 1;
- TPInfo->pt[i].Pressure = 1;
+ tp_info->pt[i].width = 1;
+ tp_info->pt[i].height = 1;
+ tp_info->pt[i].pressure = 1;
} else if ((buf[pstatus]) == TOUCHDOWN) {
p_area = py + 2;
p_preasure = py + 2 + (IS_AREA(buf[P_REPORT_ID]) * 2);
/*area*/
if (IS_AREA(buf[P_REPORT_ID])) {
- TPInfo->pt[i].Width = buf[p_area];
- TPInfo->pt[i].Height = buf[p_area + 1];
+ tp_info->pt[i].width = buf[p_area];
+ tp_info->pt[i].height = buf[p_area + 1];
} else {
- TPInfo->pt[i].Width = 1;
- TPInfo->pt[i].Height = 1;
+ tp_info->pt[i].width = 1;
+ tp_info->pt[i].height = 1;
}
/*pressure*/
if (IS_PRESSURE(buf[P_REPORT_ID]))
- TPInfo->pt[i].Pressure = (buf[p_preasure]);
+ tp_info->pt[i].pressure = (buf[p_preasure]);
else
- TPInfo->pt[i].Pressure = 1;
- } else {
- pr_err("sis_ts_work_func: Error Touch Status\n");
- goto err_free_allocate;
- }
- TPInfo->pt[i].id = (buf[pstatus + 1]);
- TPInfo->pt[i].x = get_unaligned_le16(&buf[px]);
- TPInfo->pt[i].y = get_unaligned_le16(&buf[py]);
-
- CheckID[TPInfo->pt[i].id] = 1;
- MM_Slot[TPInfo->pt[i].id].id = TPInfo->pt[i].id;
- MM_Slot[TPInfo->pt[i].id].Pressure = TPInfo->pt[i].Pressure;
- MM_Slot[TPInfo->pt[i].id].x = TPInfo->pt[i].x;
- MM_Slot[TPInfo->pt[i].id].y = TPInfo->pt[i].y;
- MM_Slot[TPInfo->pt[i].id].Width = TPInfo->pt[i].Width
+ tp_info->pt[i].pressure = 1;
+ } else
+ return -EPERM;
+
+ tp_info->pt[i].id = (buf[pstatus + 1]);
+ tp_info->pt[i].x = get_unaligned_le16(&buf[px]);
+ tp_info->pt[i].y = get_unaligned_le16(&buf[py]);
+
+ check_id[tp_info->pt[i].id] = 1;
+ sisdata[tp_info->pt[i].id].id = tp_info->pt[i].id;
+ sisdata[tp_info->pt[i].id].pressure = tp_info->pt[i].pressure;
+ sisdata[tp_info->pt[i].id].x = tp_info->pt[i].x;
+ sisdata[tp_info->pt[i].id].y = tp_info->pt[i].y;
+ sisdata[tp_info->pt[i].id].width = tp_info->pt[i].width
* AREA_UNIT;
- MM_Slot[TPInfo->pt[i].id].Height = TPInfo->pt[i].Height
+ sisdata[tp_info->pt[i].id].height = tp_info->pt[i].height
* AREA_UNIT;
+ }
+ return 0;
+}
+
+static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id)
+{
+ struct sis_ts_data *ts = dev_id;
+ struct sistp_driver_data *tp_info = ts->tp_info;
+ int ret;
+ u8 buf[PACKET_BUFFER_SIZE] = {0};
+ u8 i = 0, fingers = 0;
+ int check_id[MAX_FINGERS];
+ static int pre_check_id[MAX_FINGERS];
+ struct sis_slot sisdata[MAX_FINGERS];
+
+ memset(check_id, 0, sizeof(int)*MAX_FINGERS);
+ /*I2C or SMBUS block data read*/
+ ret = sis_readpacket(ts->client, SIS_CMD_NORMAL, buf);
+ /*Error Number*/
+ if (ret < 0)
+ goto out;
+ /*access NO TOUCH event unless BUTTON NO TOUCH event*/
+ else if (ret == 0) {
+ fingers = 0;
+ sis_tpinfo_clear(tp_info, MAX_FINGERS);
+ goto type_b_report;
}
-Tye_B_report:
+ sis_tpinfo_clear(tp_info, MAX_FINGERS);
+ fingers = ret;
+ ret = sis_parse_i2c_event(buf, fingers, tp_info, check_id, sisdata);
+ if (ret < 0)
+ goto out;
+
+type_b_report:
for (i = 0; i < MAX_FINGERS; i++) {
- if ((CheckID[i] != Pre_CheckID[i]) && (CheckID[i] != 1))
- CheckID[i] = -1;
+ if ((check_id[i] != pre_check_id[i]) && (check_id[i] != 1))
+ check_id[i] = -1;
}
for (i = 0; i < MAX_FINGERS; i++) {
- if (CheckID[i] == 1) {
+ if (check_id[i] == 1) {
input_mt_slot(ts->input_dev, i+1);
- if (MM_Slot[i].Pressure > 0) {
+ if (sisdata[i].pressure > 0) {
input_mt_report_slot_state(ts->input_dev,
- MT_TOOL_FINGER, true);
+ MT_TOOL_FINGER, true);
input_report_abs(ts->input_dev,
- ABS_MT_PRESSURE, MM_Slot[i].Pressure);
+ ABS_MT_PRESSURE, sisdata[i].pressure);
input_report_abs(ts->input_dev,
- ABS_MT_TOUCH_MAJOR, MM_Slot[i].Width);
+ ABS_MT_TOUCH_MAJOR, sisdata[i].width);
input_report_abs(ts->input_dev,
- ABS_MT_TOUCH_MINOR, MM_Slot[i].Height);
+ ABS_MT_TOUCH_MINOR, sisdata[i].height);
input_report_abs(ts->input_dev,
- ABS_MT_POSITION_X, MM_Slot[i].x);
+ ABS_MT_POSITION_X, sisdata[i].x);
input_report_abs(ts->input_dev,
- ABS_MT_POSITION_Y, MM_Slot[i].y);
+ ABS_MT_POSITION_Y, sisdata[i].y);
} else {
input_mt_report_slot_state(ts->input_dev,
- MT_TOOL_FINGER, false);
- CheckID[i] = 0;
+ MT_TOOL_FINGER, false);
+ check_id[i] = 0;
}
- } else if (CheckID[i] == -1) {
+ } else if (check_id[i] == -1) {
input_mt_slot(ts->input_dev, i+1);
input_mt_report_slot_state(ts->input_dev,
MT_TOOL_FINGER, false);
- CheckID[i] = 0;
+ check_id[i] = 0;
}
- Pre_CheckID[i] = CheckID[i];
+ pre_check_id[i] = check_id[i];
}
input_sync(ts->input_dev);
-err_free_allocate:
-
- if (ts->use_irq) {
-#ifdef _INT_MODE_1 /*case 1 mode*/
- /*TODO: After interrupt status low,
- * read i2c bus data by polling,
- * until interrupt status is high*/
- ret = gpio_get_value(GPIO_IRQ);
- /*interrupt pin is still LOW,
- * read data until interrupt pin is released.*/
- if (!ret)
- hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS),
- HRTIMER_MODE_REL);
- else {
- /*clear for interrupt*/
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(ts->client->irq);
- }
-#else /*case 2 mode*/
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(ts->client->irq);
-#endif
- }
-
- mutex_unlock(&ts->mutex_wq);
+out:
+ return IRQ_HANDLED;
}
-static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max)
+static void sis_tpinfo_clear(struct sistp_driver_data *tp_info, int max)
{
int i = 0;
for (i = 0; i < max; i++) {
- TPInfo->pt[i].id = -1;
- TPInfo->pt[i].x = 0;
- TPInfo->pt[i].y = 0;
- TPInfo->pt[i].Pressure = 0;
- TPInfo->pt[i].Width = 0;
+ tp_info->pt[i].id = -1;
+ tp_info->pt[i].x = 0;
+ tp_info->pt[i].y = 0;
+ tp_info->pt[i].pressure = 0;
+ tp_info->pt[i].width = 0;
}
- TPInfo->id = 0x0;
- TPInfo->fingers = 0;
-}
-
-static enum hrtimer_restart sis_ts_timer_func(struct hrtimer *timer)
-{
- struct sis_ts_data *ts = container_of(timer, struct sis_ts_data, timer);
-
- queue_work(sis_wq, &ts->work);
- if (!ts->use_irq) /*For Polling mode*/
- hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS), HRTIMER_MODE_REL);
- return HRTIMER_NORESTART;
-}
-
-static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id)
-{
- struct sis_ts_data *ts = dev_id;
-
- if (!irqd_irq_disabled(&ts->desc->irq_data))
- disable_irq_nosync(ts->client->irq);
- queue_work(sis_wq, &ts->work);
- return IRQ_HANDLED;
-}
-
-static int initial_irq(void)
-{
- int ret = 0;
-
- /* initialize gpio and interrupt pins */
- /*ex. GPIO_133 for interrupt mode*/
- ret = gpio_request(GPIO_IRQ, "GPIO_54");
- if (ret < 0) {
- /*Set Active Low.
- * Please reference the file include/linux/interrupt.h*/
- pr_err("sis_ts_probe: Failed to gpio_request\n");
- pr_err("sis_ts_probe: Fail : gpio_request was called before this driver call\n");
- }
- /* setting gpio direction here OR boardinfo file*/
- return ret;
+ tp_info->id = 0x0;
+ tp_info->fingers = 0;
}
static int sis_ts_probe(
struct i2c_client *client, const struct i2c_device_id *id)
{
- int ret = 0;
- struct sis_ts_data *ts = NULL;
- struct sis_i2c_rmi_platform_data *pdata = NULL;
-
- pr_info("sis_ts_probe\n");
- ts = kzalloc(sizeof(struct sis_ts_data), GFP_KERNEL);
- if (ts == NULL) {
- ret = -ENOMEM;
- goto err_alloc_data_failed;
- }
- ts->TPInfo = kzalloc(sizeof(struct sisTP_driver_data), GFP_KERNEL);
- if (ts->TPInfo == NULL) {
- ret = -ENOMEM;
- goto err_alloc_data_failed;
+ int err = 0;
+ struct sis_ts_data *ts;
+
+ dev_dbg(&client->dev, "sis_ts_probe\n");
+ ts = devm_kzalloc(&client->dev, sizeof(struct sis_ts_data),
+ GFP_KERNEL);
+ if (!ts)
+ return -ENOMEM;
+ ts->tp_info = devm_kzalloc(&client->dev,
+ sizeof(struct sistp_driver_data),
+ GFP_KERNEL);
+ if (!ts->tp_info) {
+ dev_err(&client->dev, "Failed to allocate memory\n");
+ return -ENOMEM;
}
- ts_bak = ts;
- mutex_init(&ts->mutex_wq);
- /*1. Init Work queue and necessary buffers*/
- INIT_WORK(&ts->work, sis_ts_work_func);
+ /*1. Init necessary buffers*/
ts->client = client;
i2c_set_clientdata(client, ts);
- pdata = client->dev.platform_data;
- if (pdata)
- ts->power = pdata->power;
- if (ts->power) {
- ret = ts->power(1);
- if (ret < 0) {
- pr_err("sis_ts_probe power on failed\n");
- goto err_power_failed;
- }
- }
+
/*2. Allocate input device*/
- ts->input_dev = input_allocate_device();
- if (ts->input_dev == NULL) {
- ret = -ENOMEM;
- pr_err("sis_ts_probe: Failed to allocate input device\n");
+ ts->input_dev = devm_input_allocate_device(&client->dev);
+ if (!ts->input_dev) {
+ err = -ENOMEM;
+ dev_err(&client->dev, "sis_ts_probe: Failed to allocate input device\n");
goto err_input_dev_alloc_failed;
}
- /*This input device name should be the same to IDC file name.*/
ts->input_dev->name = "sis_touch";
set_bit(EV_ABS, ts->input_dev->evbit);
set_bit(EV_KEY, ts->input_dev->evbit);
- set_bit(ABS_MT_POSITION_X, ts->input_dev->absbit);
- set_bit(ABS_MT_POSITION_Y, ts->input_dev->absbit);
- set_bit(ABS_MT_PRESSURE, ts->input_dev->absbit);
- set_bit(ABS_MT_TOUCH_MAJOR, ts->input_dev->absbit);
- set_bit(ABS_MT_TOUCH_MINOR, ts->input_dev->absbit);
-
- input_mt_init_slots(ts->input_dev, MAX_SLOTS, INPUT_MT_DIRECT);
-
input_set_abs_params(ts->input_dev, ABS_MT_PRESSURE,
0, PRESSURE_MAX, 0, 0);
input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR,
@@ -458,170 +436,90 @@ static int sis_ts_probe(
0, SIS_MAX_X, 0, 0);
input_set_abs_params(ts->input_dev, ABS_MT_POSITION_Y,
0, SIS_MAX_Y, 0, 0);
+ input_mt_init_slots(ts->input_dev, MAX_SLOTS, INPUT_MT_DIRECT);
/* add for touch keys */
set_bit(KEY_COMPOSE, ts->input_dev->keybit);
set_bit(KEY_BACK, ts->input_dev->keybit);
set_bit(KEY_MENU, ts->input_dev->keybit);
set_bit(KEY_HOME, ts->input_dev->keybit);
+
/*3. Register input device to core*/
- ret = input_register_device(ts->input_dev);
- if (ret) {
- pr_err("sis_ts_probe: Unable to register %s input device\n",
- ts->input_dev->name);
+ err = input_register_device(ts->input_dev);
+ if (err) {
+ dev_err(&client->dev,
+ "sis_ts_probe: Unable to register %s input device\n",
+ ts->input_dev->name);
goto err_input_register_device_failed;
}
- /*4. irq or timer setup*/
- ret = initial_irq();
- if (ret >= 0) {
- client->irq = gpio_to_irq(GPIO_IRQ);
- ret = request_irq(client->irq, sis_ts_irq_handler,
- IRQF_TRIGGER_FALLING, client->name, ts);
- if (ret == 0)
- ts->use_irq = 1;
- else
- dev_err(&client->dev, "request_irq failed\n");
- }
- ts->desc = irq_to_desc(ts_bak->client->irq);
- hrtimer_init(&ts->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
- ts->timer.function = sis_ts_timer_func;
- if (!ts->use_irq)
- hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL);
- pr_info("sis_ts_probe: Start touchscreen %s in %s mode\n",
- ts->input_dev->name,
- ts->use_irq ? "interrupt" : "polling");
- if (ts->use_irq) {
-#ifdef _INT_MODE_1
- pr_info("sis_ts_probe: interrupt case 1 mode\n");
-#else
- pr_info("sis_ts_probe: interrupt case 2 mode\n");
-#endif
+
+ /*4. irq setup*/
+ err = devm_request_threaded_irq(&client->dev, client->irq, NULL,
+ sis_ts_irq_handler,
+ IRQF_TRIGGER_FALLING, client->name,
+ ts);
+ if (err < 0) {
+ dev_err(&client->dev, "Failed to request touchscreen IRQ\n");
+ goto err_request_threaded_irq;
}
- pr_info("sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR);
+
+ dev_dbg(&client->dev, "sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR);
return 0;
+err_request_threaded_irq:
err_input_register_device_failed:
input_free_device(ts->input_dev);
err_input_dev_alloc_failed:
-err_power_failed:
- kfree(ts->TPInfo);
+ kfree(ts->tp_info);
kfree(ts);
-err_alloc_data_failed:
- return ret;
+ return err;
}
static int sis_ts_remove(struct i2c_client *client)
{
struct sis_ts_data *ts = i2c_get_clientdata(client);
- if (ts->use_irq)
- free_irq(client->irq, ts);
- else
- hrtimer_cancel(&ts->timer);
input_unregister_device(ts->input_dev);
+ input_free_device(ts->input_dev);
+ kfree(ts->tp_info);
kfree(ts);
return 0;
}
-#ifdef CONFIG_PM_SLEEP
-static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg)
+static int __maybe_unused sis_ts_suspend(struct device *dev)
{
- int ret = 0;
- struct sis_ts_data *ts = i2c_get_clientdata(client);
-
- if (ts->use_irq) {
- if (!irqd_irq_disabled(&ts->desc->irq_data))
- disable_irq(client->irq);
- } else
- hrtimer_cancel(&ts->timer);
- flush_workqueue(sis_wq); /*only flush sis_wq*/
-
-
- if (ts->power) {
- ret = ts->power(0);
- if (ret < 0)
- pr_err("sis_ts_suspend power off failed\n");
- }
+ struct i2c_client *client = to_i2c_client(dev);
+ disable_irq(client->irq);
return 0;
}
-static int sis_ts_resume(struct i2c_client *client)
+static int __maybe_unused sis_ts_resume(struct device *dev)
{
- int ret = 0;
- struct sis_ts_data *ts = i2c_get_clientdata(client);
+ struct i2c_client *client = to_i2c_client(dev);
- if (ts->power) {
- ret = ts->power(1);
- if (ret < 0)
- pr_err("sis_ts_resume power on failed\n");
- }
-
- if (ts->use_irq) {
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(client->irq);
- } else
- hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL);
+ enable_irq(client->irq);
return 0;
}
-#endif
static SIMPLE_DEV_PM_OPS(sis_ts_pm, sis_ts_suspend, sis_ts_resume);
-#ifdef CONFIG_X86
-/* Return 0 if detection is successful, -ENODEV otherwise */
-static int sis_ts_detect(struct i2c_client *client,
- struct i2c_board_info *info)
-{
- const char *type_name;
-
- pr_info("sis_ts_detect\n");
- type_name = "sis_i2c_ts";
- strlcpy(info->type, type_name, I2C_NAME_SIZE);
- return 0;
-}
-#endif
-
static const struct i2c_device_id sis_ts_id[] = {
{ SIS_I2C_NAME, 0 },
{ }
};
-
MODULE_DEVICE_TABLE(i2c, sis_ts_id);
static struct i2c_driver sis_ts_driver = {
.driver = {
.name = SIS_I2C_NAME,
+ .owner = THIS_MODULE,
.pm = &sis_ts_pm,
},
.probe = sis_ts_probe,
.remove = sis_ts_remove,
-#ifdef CONFIG_X86
- .class = I2C_CLASS_HWMON,
- .detect = sis_ts_detect,
- .address_list = normal_i2c,
-#endif
- .id_table = sis_ts_id,
+ .id_table = sis_ts_id,
};
+module_i2c_driver(sis_ts_driver);
-static int __init sis_ts_init(void)
-{
- pr_info("sis_ts_init\n");
- sis_wq = create_singlethread_workqueue("sis_wq");
-
- if (!sis_wq)
- return -ENOMEM;
- return i2c_add_driver(&sis_ts_driver);
-}
-
-static void __exit sis_ts_exit(void)
-{
- pr_info("sis_ts_exit\n");
- i2c_del_driver(&sis_ts_driver);
- if (sis_wq)
- destroy_workqueue(sis_wq);
-}
-
-module_init(sis_ts_init);
-module_exit(sis_ts_exit);
MODULE_DESCRIPTION("SiS 9200 Family Touchscreen Driver");
-MODULE_LICENSE("GPL");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/sis_i2c.h b/drivers/input/touchscreen/sis_i2c.h
deleted file mode 100644
index a075158..0000000
--- a/drivers/input/touchscreen/sis_i2c.h
+++ /dev/null
@@ -1,164 +0,0 @@
-/*
- * Touch Screen driver for SiS 9200 family I2C Touch panels
- *
- * Copyright (C) 2015 SiS, Inc.
- *
- * This software is licensed under the terms of the GNU General Public
- * License version 2, as published by the Free Software Foundation, and
- * may be copied, distributed, and modified under those terms.
- *
- * 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.
- *
- * Date: 2015/07/07
- */
-#include <linux/version.h>
-
-#ifndef _LINUX_SIS_I2C_H
-#define _LINUX_SIS_I2C_H
-
-
-#define SIS_I2C_NAME "sis_i2c_ts"
-#define SIS_SLAVE_ADDR 0x5c
-/*10ms*/
-#define TIMER_NS 10000000
-#define MAX_FINGERS 10
-
-/* Check data CRC */
-/*#define _CHECK_CRC*/ /*ON/OFF*/
-
-/* Interrupt modes */
-#define GPIO_IRQ 54
-
-/* Enable if use interrupt case 1 mode. */
-/* Disable if use interrupt case 2 mode. */
-/*#define _INT_MODE_1*/ /*ON/OFF*/
-
-/* Resolution mode */
-/*Constant value*/
-#define SIS_MAX_X 4095
-#define SIS_MAX_Y 4095
-
-#define ONE_BYTE 1
-#define FIVE_BYTE 5
-#define EIGHT_BYTE 8
-#define SIXTEEN_BYTE 16
-#define PACKET_BUFFER_SIZE 128
-
-#define SIS_CMD_NORMAL 0x0
-#define SIS_CMD_SOFTRESET 0x82
-#define SIS_CMD_RECALIBRATE 0x87
-#define SIS_CMD_POWERMODE 0x90
-#define MSK_TOUCHNUM 0x0f
-#define MSK_HAS_CRC 0x10
-#define MSK_DATAFMT 0xe0
-#define MSK_PSTATE 0x0f
-#define MSK_PID 0xf0
-#define RES_FMT 0x00
-#define FIX_FMT 0x40
-
-/* for new i2c format */
-#define TOUCHDOWN 0x3
-#define TOUCHUP 0x0
-#define MAX_BYTE 64
-#define PRESSURE_MAX 255
-
-/*Resolution diagonal */
-#define AREA_LENGTH_LONGER 5792
-/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/
-#define AREA_LENGTH_SHORT 5792
-#define AREA_UNIT (5792/32)
-
-
-#define FORMAT_MODE 1
-
-#define MSK_NOBTN 0
-#define MSK_COMP 1
-#define MSK_BACK 2
-#define MSK_MENU 4
-#define MSK_HOME 8
-
-#define P_BYTECOUNT 0
-#define ALL_IN_ONE_PACKAGE 0x10
-#define IS_TOUCH(x) (x & 0x1)
-#define IS_HIDI2C(x) ((x & 0xF) == 0x06)
-#define IS_AREA(x) ((x >> 4) & 0x1)
-#define IS_PRESSURE(x) ((x >> 5) & 0x1)
-#define IS_SCANTIME(x) ((x >> 6) & 0x1)
-#define NORMAL_LEN_PER_POINT 6
-#define AREA_LEN_PER_POINT 2
-#define PRESSURE_LEN_PER_POINT 1
-
-#define TOUCH_FORMAT 0x1
-#define BUTTON_FORMAT 0x4
-#define HIDI2C_FORMAT 0x6
-#define P_REPORT_ID 2
-#define BUTTON_STATE 3
-#define BUTTON_KEY_COUNT 16
-#define BYTE_BYTECOUNT 2
-#define BYTE_COUNT 1
-#define BYTE_ReportID 1
-#define BYTE_CRC_HIDI2C 0
-#define BYTE_CRC_I2C 2
-#define BYTE_SCANTIME 2
-#define NO_TOUCH_BYTECOUNT 0x3
-
-/* TODO */
-#define TOUCH_POWER_PIN 0
-#define TOUCH_RESET_PIN 1
-
-/* CMD Define */
-#define BUF_ACK_PLACE_L 4
-#define BUF_ACK_PLACE_H 5
-#define BUF_ACK_L 0xEF
-#define BUF_ACK_H 0xBE
-#define BUF_NACK_L 0xAD
-#define BUF_NACK_H 0xDE
-#define BUF_CRC_PLACE 7
-#define MAX_SLOTS 15
-
-struct sis_i2c_rmi_platform_data {
- int (*power)(int on); /* Only valid in first array entry */
-};
-
-struct TypeB_Slot {
- int CheckID;
- int id;
- unsigned short x, y;
- uint16_t Pressure;
- uint16_t Width;
- uint16_t Height;
-};
-
-struct Point {
- int id;
- unsigned short x, y; /*uint16_t ?*/
- uint16_t Pressure;
- uint16_t Width;
- uint16_t Height;
-};
-
-struct sisTP_driver_data {
- int id;
- int fingers;
- struct Point pt[MAX_FINGERS];
-};
-
-struct sis_ts_data {
- int (*power)(int on);
- int use_irq;
- struct i2c_client *client;
- struct input_dev *input_dev;
- struct hrtimer timer;
- struct irq_desc *desc;
- struct work_struct work;
- struct mutex mutex_wq;
- struct sisTP_driver_data *TPInfo;
-};
-
-static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg);
-static int sis_ts_resume(struct i2c_client *client);
-
-#endif /* _LINUX_SIS_I2C_H */
--
1.9.1
^ permalink raw reply related [flat|nested] 5+ messages in thread
* [PATCHv2] Add support for SiS i2c touch driver
@ 2015-10-02 8:06 Yuger
0 siblings, 0 replies; 5+ messages in thread
From: Yuger @ 2015-10-02 8:06 UTC (permalink / raw)
To: dmitry.torokhov, linux-input; +Cc: yuger.yu, yuger_yu, tammy_tseng
Hi, This patch is to add support for SiS i2c touch panel.
Thanks a lot.
v2: Fixed coding style and changed to threaded IRQ.
Signed-off-by: Yuger <yuger_yu@sis.com>
---
drivers/input/touchscreen/Kconfig | 2 +-
drivers/input/touchscreen/sis_i2c.c | 646 +++++++++++++++---------------------
drivers/input/touchscreen/sis_i2c.h | 164 ---------
3 files changed, 273 insertions(+), 539 deletions(-)
delete mode 100644 drivers/input/touchscreen/sis_i2c.h
diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig
index 3d7a30d..ca8420e 100644
--- a/drivers/input/touchscreen/Kconfig
+++ b/drivers/input/touchscreen/Kconfig
@@ -1029,7 +1029,7 @@ config TOUCHSCREEN_ZFORCE
config TOUCHSCREEN_SIS_I2C
tristate "SiS 9200 family I2C touchscreen driver"
- depends on I2C
+ depends on I2C && CRC_ITU_T
help
Say Y here to enable support for I2C connected SiS touch panels.
diff --git a/drivers/input/touchscreen/sis_i2c.c b/drivers/input/touchscreen/sis_i2c.c
index 22dfc1f..f7b6ac5 100644
--- a/drivers/input/touchscreen/sis_i2c.c
+++ b/drivers/input/touchscreen/sis_i2c.c
@@ -12,20 +12,13 @@
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
- * Date: 2015/07/07
*/
-#include <linux/errno.h>
#include <linux/module.h>
-#include <linux/delay.h>
-#include <linux/hrtimer.h>
#include <linux/i2c.h>
#include <linux/input.h>
#include <linux/interrupt.h>
-#include <linux/io.h>
#include <linux/platform_device.h>
-#include "sis_i2c.h"
-#include <linux/linkage.h>
#include <linux/slab.h>
#include <linux/gpio.h>
#include <linux/uaccess.h>
@@ -34,27 +27,86 @@
#include <linux/input/mt.h> /*For Type-B Slot function*/
#include <linux/crc-itu-t.h> /*For CRC Check*/
-/* Addresses to scan */
-static const unsigned short normal_i2c[] = { SIS_SLAVE_ADDR, I2C_CLIENT_END };
-static struct workqueue_struct *sis_wq;
-struct sis_ts_data *ts_bak;
-static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max);
+#define SIS_I2C_NAME "sis_i2c_ts"
+#define SIS_SLAVE_ADDR 0x5c
+#define MAX_FINGERS 10
+
+/*Resolution mode*/
+/*Constant value*/
+#define SIS_MAX_X 4095
+#define SIS_MAX_Y 4095
+
+#define PACKET_BUFFER_SIZE 128
+
+#define SIS_CMD_NORMAL 0x0
+
+/* for new i2c format */
+#define TOUCHDOWN 0x3
+#define TOUCHUP 0x0
+#define MAX_BYTE 64
+#define PRESSURE_MAX 255
+
+/*Resolution diagonal */
+#define AREA_LENGTH_LONGER 5792
+/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/
+#define AREA_LENGTH_SHORT 5792
+#define AREA_UNIT (5792/32)
+
+#define P_BYTECOUNT 0
+#define ALL_IN_ONE_PACKAGE 0x10
+#define IS_TOUCH(x) (x & 0x1)
+#define IS_HIDI2C(x) ((x & 0xF) == 0x06)
+#define IS_AREA(x) ((x >> 4) & 0x1)
+#define IS_PRESSURE(x) ((x >> 5) & 0x1)
+#define IS_SCANTIME(x) ((x >> 6) & 0x1)
+#define NORMAL_LEN_PER_POINT 6
+#define AREA_LEN_PER_POINT 2
+#define PRESSURE_LEN_PER_POINT 1
+
+#define TOUCH_FORMAT 0x1
+#define HIDI2C_FORMAT 0x6
+#define P_REPORT_ID 2
+#define BYTE_BYTECOUNT 2
+#define BYTE_ReportID 1
+#define BYTE_CRC_HIDI2C 0
+#define BYTE_CRC_I2C 2
+#define BYTE_SCANTIME 2
+
+#define MAX_SLOTS 15
+
+struct sis_slot {
+ int check_id;
+ int id;
+ unsigned short x, y;
+ u16 pressure;
+ u16 width;
+ u16 height;
+};
-static int sis_command_for_read(struct i2c_client *client, int rlength,
- unsigned char *rdata)
-{
- int ret;
- struct i2c_msg msg;
+struct point {
+ int id;
+ unsigned short x, y;
+ u16 pressure;
+ u16 width;
+ u16 height;
+};
- msg.addr = client->addr;
- msg.flags = I2C_M_RD; /*Read*/
- msg.len = rlength;
- msg.buf = rdata;
- ret = i2c_transfer(client->adapter, &msg, 1);
- return ret;
-}
+struct sistp_driver_data {
+ int id;
+ int fingers;
+ struct point pt[MAX_FINGERS];
+};
+
+struct sis_ts_data {
+ struct i2c_client *client;
+ struct input_dev *input_dev;
+ struct sistp_driver_data *tp_info;
+};
-static int sis_cul_unit(uint8_t report_id)
+/* Addresses to scan */
+static void sis_tpinfo_clear(struct sistp_driver_data *tp_info, int max);
+
+static int sis_cul_unit(u8 report_id)
{
int ret = NORMAL_LEN_PER_POINT;
@@ -68,73 +120,76 @@ static int sis_cul_unit(uint8_t report_id)
return ret;
}
-static int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf)
+static int sis_readpacket(struct i2c_client *client, u8 cmd, u8 *buf)
{
- uint8_t tmpbuf[MAX_BYTE] = {0}; /*MAX_BYTE = 64;*/
+ u8 tmpbuf[MAX_BYTE] = {0}; /*MAX_BYTE = 64;*/
int ret;
int touchnum = 0;
int p_count = 0;
- int touc_formate_id = 0;
+ int touch_format_id = 0;
int locate = 0;
bool read_first = true;
/*
- * New i2c format
- * buf[0] = Low 8 bits of byte count value
- * buf[1] = High 8 bits of byte counte value
- * buf[2] = Report ID
- * buf[touch num * 6 + 2 ] = Touch information;
- * 1 touch point has 6 bytes, it could be none if no touch
- * buf[touch num * 6 + 3] = Touch numbers
- *
- * One touch point information include 6 bytes, the order is
- *
- * 1. status = touch down or touch up
- * 2. id = finger id
- * 3. x axis low 8 bits
- * 4. x axis high 8 bits
- * 5. y axis low 8 bits
- * 6. y axis high 8 bits
- * */
+ * New i2c format
+ * buf[0] = Low 8 bits of byte count value
+ * buf[1] = High 8 bits of byte count value
+ * buf[2] = Report ID
+ * buf[touch num * 6 + 2 ] = Touch information;
+ * 1 touch point has 6 bytes, it could be none if no touch
+ * buf[touch num * 6 + 3] = Touch numbers
+ *
+ * One touch point information include 6 bytes, the order is
+ *
+ * 1. status = touch down or touch up
+ * 2. id = finger id
+ * 3. x axis low 8 bits
+ * 4. x axis high 8 bits
+ * 5. y axis low 8 bits
+ * 6. y axis high 8 bits
+ */
do {
if (locate >= PACKET_BUFFER_SIZE) {
- pr_err("sis_ReadPacket: Buf Overflow\n");
+ dev_err(&client->dev, "sis_readpacket: Buf Overflow\n");
return -EPERM;
}
- ret = sis_command_for_read(client, MAX_BYTE, tmpbuf);
+ ret = i2c_master_recv(client, tmpbuf, MAX_BYTE);
if (ret < 0) {
- pr_err("sis_ReadPacket: i2c transfer error\n");
+ dev_err(&client->dev, "sis_readpacket: i2c transfer error\n");
return ret;
}
/*error package length of receiving data*/
else if (tmpbuf[P_BYTECOUNT] > MAX_BYTE) {
- pr_err("sis_ReadPacket: Error Bytecount\n");
+ dev_err(&client->dev, "sis_readpacket: Error Bytecount\n");
return -EPERM;
}
if (read_first) {
/*access NO TOUCH event unless BUTTON NO TOUCH event*/
- if (tmpbuf[P_BYTECOUNT] == 0/*NO_TOUCH_BYTECOUNT*/)
+ if (tmpbuf[P_BYTECOUNT] == 0)
return 0; /*touchnum is 0*/
}
- /*skip parsing data when two devices are registered
- * at the same slave address*/
- /*parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT
- * or P_REPORT_ID is ALL_IN_ONE_PACKAGE*/
- touc_formate_id = tmpbuf[P_REPORT_ID] & 0xf;
- if ((touc_formate_id != TOUCH_FORMAT)
- && (touc_formate_id != HIDI2C_FORMAT)
- && (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) {
- pr_err("sis_ReadPacket: Error Report_ID\n");
+ /*
+ * skip parsing data when two devices are registered
+ * at the same slave address
+ * parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT
+ * or P_REPORT_ID is ALL_IN_ONE_PACKAGE
+ */
+ touch_format_id = tmpbuf[P_REPORT_ID] & 0xf;
+ if ((touch_format_id != TOUCH_FORMAT) &&
+ (touch_format_id != HIDI2C_FORMAT) &&
+ (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) {
+ dev_err(&client->dev, "sis_readpacket: Error Report_ID\n");
return -EPERM;
}
p_count = (int) tmpbuf[P_BYTECOUNT] - 1; /*start from 0*/
if (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE) {
if (IS_TOUCH(tmpbuf[P_REPORT_ID])) {
- p_count -= BYTE_CRC_I2C;/*delete 2 byte crc*/
+ /*delete 2 byte crc*/
+ p_count -= BYTE_CRC_I2C;
} else if (IS_HIDI2C(tmpbuf[P_REPORT_ID])) {
p_count -= BYTE_CRC_HIDI2C;
} else { /*should not be happen*/
- pr_err("sis_ReadPacket: delete crc error\n");
+ dev_err(&client->dev, "sis_readpacket: delete crc error\n");
return -EPERM;
}
if (IS_SCANTIME(tmpbuf[P_REPORT_ID]))
@@ -145,76 +200,49 @@ static int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf)
touchnum = tmpbuf[p_count];
} else {
if (tmpbuf[p_count] != 0) {
- pr_err("sis_ReadPacket: get error package\n");
+ dev_err(&client->dev, "sis_readpacket: get error package\n");
return -EPERM;
}
}
-#ifdef _CHECK_CRC
- /* HID over I2C data foramt and no touch packet without CRC */
- if ((touc_formate_id != HIDI2C_FORMAT) &&
+ if ((touch_format_id != HIDI2C_FORMAT) &&
(tmpbuf[P_BYTECOUNT] > 3)) {
int crc_end = p_count + (IS_SCANTIME(
tmpbuf[P_REPORT_ID]) * 2);
- uint16_t buf_crc = crc_itu_t(
+ u16 buf_crc = crc_itu_t(
0, tmpbuf + 2, crc_end - 1);
int l_package_crc = (IS_SCANTIME(
tmpbuf[P_REPORT_ID]) * 2) + p_count + 1;
- uint16_t package_crc = get_unaligned_le16(
+ u16 package_crc = get_unaligned_le16(
&tmpbuf[l_package_crc]);
if (buf_crc != package_crc) {
- pr_err("sis_ReadPacket: CRC Error\n");
+ dev_err(&client->dev, "sis_readpacket: CRC Error\n");
return -EPERM;
}
}
-#endif
- memcpy(&buf[locate], &tmpbuf[0], 64);
+
+ memcpy(&buf[locate], &tmpbuf[0], MAX_BYTE);
/*Buf_Data [0~63] [64~128]*/
- locate += 64;
+ locate += MAX_BYTE;
read_first = false;
} while (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE &&
tmpbuf[p_count] > 5);
return touchnum;
}
-static void sis_ts_work_func(struct work_struct *work)
+static int sis_parse_i2c_event(u8 *buf, u8 fingers,
+ struct sistp_driver_data *tp_info,
+ int *check_id, struct sis_slot *sisdata)
{
- struct sis_ts_data *ts = container_of(work, struct sis_ts_data, work);
- struct sisTP_driver_data *TPInfo = ts->TPInfo;
- int ret;
int point_unit;
- uint8_t buf[PACKET_BUFFER_SIZE] = {0};
- uint8_t i = 0, fingers = 0;
- uint8_t px = 0, py = 0, pstatus = 0;
- uint8_t p_area = 0;
- uint8_t p_preasure = 0;
- int CheckID[MAX_FINGERS];
- static int Pre_CheckID[MAX_FINGERS];
- struct TypeB_Slot MM_Slot[MAX_FINGERS];
-
- memset(CheckID, 0, sizeof(int)*MAX_FINGERS);
-
- mutex_lock(&ts->mutex_wq);
- /*I2C or SMBUS block data read*/
- ret = sis_ReadPacket(ts->client, SIS_CMD_NORMAL, buf);
- /*Error Number*/
- if (ret < 0)
- goto err_free_allocate;
- /*access NO TOUCH event unless BUTTON NO TOUCH event*/
- else if (ret == 0) {
- fingers = 0;
- sis_tpinfo_clear(TPInfo, MAX_FINGERS);
-
- goto Tye_B_report;
- }
- sis_tpinfo_clear(TPInfo, MAX_FINGERS);
-
- /*Parser and Get the sis9200 data*/
+ u8 i = 0, pstatus = 0;
+ u8 px = 0, py = 0;
+ u8 p_area = 0;
+ u8 p_preasure = 0;
+ /*Parser and Get the sis data*/
point_unit = sis_cul_unit(buf[P_REPORT_ID]);
- fingers = ret;
-
- TPInfo->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers);
+ tp_info->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers);
/*fingers 10 = 0 ~ 9*/
for (i = 0; i < fingers; i++) {
@@ -228,226 +256,176 @@ static void sis_ts_work_func(struct work_struct *work)
+ (i * point_unit);
/*Calc point status*/
}
- px = pstatus + 2; /*Calc point x_coord*/
- py = px + 2; /*Calc point y_coord*/
+ px = pstatus + 2; /*Calc point x_coord*/
+ py = px + 2; /*Calc point y_coord*/
if ((buf[pstatus]) == TOUCHUP) {
- TPInfo->pt[i].Width = 0;
- TPInfo->pt[i].Height = 0;
- TPInfo->pt[i].Pressure = 0;
+ tp_info->pt[i].width = 0;
+ tp_info->pt[i].height = 0;
+ tp_info->pt[i].pressure = 0;
} else if (buf[P_REPORT_ID] == ALL_IN_ONE_PACKAGE
&& (buf[pstatus]) == TOUCHDOWN) {
- TPInfo->pt[i].Width = 1;
- TPInfo->pt[i].Height = 1;
- TPInfo->pt[i].Pressure = 1;
+ tp_info->pt[i].width = 1;
+ tp_info->pt[i].height = 1;
+ tp_info->pt[i].pressure = 1;
} else if ((buf[pstatus]) == TOUCHDOWN) {
p_area = py + 2;
p_preasure = py + 2 + (IS_AREA(buf[P_REPORT_ID]) * 2);
/*area*/
if (IS_AREA(buf[P_REPORT_ID])) {
- TPInfo->pt[i].Width = buf[p_area];
- TPInfo->pt[i].Height = buf[p_area + 1];
+ tp_info->pt[i].width = buf[p_area];
+ tp_info->pt[i].height = buf[p_area + 1];
} else {
- TPInfo->pt[i].Width = 1;
- TPInfo->pt[i].Height = 1;
+ tp_info->pt[i].width = 1;
+ tp_info->pt[i].height = 1;
}
/*pressure*/
if (IS_PRESSURE(buf[P_REPORT_ID]))
- TPInfo->pt[i].Pressure = (buf[p_preasure]);
+ tp_info->pt[i].pressure = (buf[p_preasure]);
else
- TPInfo->pt[i].Pressure = 1;
- } else {
- pr_err("sis_ts_work_func: Error Touch Status\n");
- goto err_free_allocate;
- }
- TPInfo->pt[i].id = (buf[pstatus + 1]);
- TPInfo->pt[i].x = get_unaligned_le16(&buf[px]);
- TPInfo->pt[i].y = get_unaligned_le16(&buf[py]);
-
- CheckID[TPInfo->pt[i].id] = 1;
- MM_Slot[TPInfo->pt[i].id].id = TPInfo->pt[i].id;
- MM_Slot[TPInfo->pt[i].id].Pressure = TPInfo->pt[i].Pressure;
- MM_Slot[TPInfo->pt[i].id].x = TPInfo->pt[i].x;
- MM_Slot[TPInfo->pt[i].id].y = TPInfo->pt[i].y;
- MM_Slot[TPInfo->pt[i].id].Width = TPInfo->pt[i].Width
+ tp_info->pt[i].pressure = 1;
+ } else
+ return -EPERM;
+
+ tp_info->pt[i].id = (buf[pstatus + 1]);
+ tp_info->pt[i].x = get_unaligned_le16(&buf[px]);
+ tp_info->pt[i].y = get_unaligned_le16(&buf[py]);
+
+ check_id[tp_info->pt[i].id] = 1;
+ sisdata[tp_info->pt[i].id].id = tp_info->pt[i].id;
+ sisdata[tp_info->pt[i].id].pressure = tp_info->pt[i].pressure;
+ sisdata[tp_info->pt[i].id].x = tp_info->pt[i].x;
+ sisdata[tp_info->pt[i].id].y = tp_info->pt[i].y;
+ sisdata[tp_info->pt[i].id].width = tp_info->pt[i].width
* AREA_UNIT;
- MM_Slot[TPInfo->pt[i].id].Height = TPInfo->pt[i].Height
+ sisdata[tp_info->pt[i].id].height = tp_info->pt[i].height
* AREA_UNIT;
+ }
+ return 0;
+}
+
+static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id)
+{
+ struct sis_ts_data *ts = dev_id;
+ struct sistp_driver_data *tp_info = ts->tp_info;
+ int ret;
+ u8 buf[PACKET_BUFFER_SIZE] = {0};
+ u8 i = 0, fingers = 0;
+ int check_id[MAX_FINGERS];
+ static int pre_check_id[MAX_FINGERS];
+ struct sis_slot sisdata[MAX_FINGERS];
+
+ memset(check_id, 0, sizeof(int)*MAX_FINGERS);
+ /*I2C or SMBUS block data read*/
+ ret = sis_readpacket(ts->client, SIS_CMD_NORMAL, buf);
+ /*Error Number*/
+ if (ret < 0)
+ goto out;
+ /*access NO TOUCH event unless BUTTON NO TOUCH event*/
+ else if (ret == 0) {
+ fingers = 0;
+ sis_tpinfo_clear(tp_info, MAX_FINGERS);
+ goto type_b_report;
}
-Tye_B_report:
+ sis_tpinfo_clear(tp_info, MAX_FINGERS);
+ fingers = ret;
+ ret = sis_parse_i2c_event(buf, fingers, tp_info, check_id, sisdata);
+ if (ret < 0)
+ goto out;
+
+type_b_report:
for (i = 0; i < MAX_FINGERS; i++) {
- if ((CheckID[i] != Pre_CheckID[i]) && (CheckID[i] != 1))
- CheckID[i] = -1;
+ if ((check_id[i] != pre_check_id[i]) && (check_id[i] != 1))
+ check_id[i] = -1;
}
for (i = 0; i < MAX_FINGERS; i++) {
- if (CheckID[i] == 1) {
+ if (check_id[i] == 1) {
input_mt_slot(ts->input_dev, i+1);
- if (MM_Slot[i].Pressure > 0) {
+ if (sisdata[i].pressure > 0) {
input_mt_report_slot_state(ts->input_dev,
- MT_TOOL_FINGER, true);
+ MT_TOOL_FINGER, true);
input_report_abs(ts->input_dev,
- ABS_MT_PRESSURE, MM_Slot[i].Pressure);
+ ABS_MT_PRESSURE, sisdata[i].pressure);
input_report_abs(ts->input_dev,
- ABS_MT_TOUCH_MAJOR, MM_Slot[i].Width);
+ ABS_MT_TOUCH_MAJOR, sisdata[i].width);
input_report_abs(ts->input_dev,
- ABS_MT_TOUCH_MINOR, MM_Slot[i].Height);
+ ABS_MT_TOUCH_MINOR, sisdata[i].height);
input_report_abs(ts->input_dev,
- ABS_MT_POSITION_X, MM_Slot[i].x);
+ ABS_MT_POSITION_X, sisdata[i].x);
input_report_abs(ts->input_dev,
- ABS_MT_POSITION_Y, MM_Slot[i].y);
+ ABS_MT_POSITION_Y, sisdata[i].y);
} else {
input_mt_report_slot_state(ts->input_dev,
- MT_TOOL_FINGER, false);
- CheckID[i] = 0;
+ MT_TOOL_FINGER, false);
+ check_id[i] = 0;
}
- } else if (CheckID[i] == -1) {
+ } else if (check_id[i] == -1) {
input_mt_slot(ts->input_dev, i+1);
input_mt_report_slot_state(ts->input_dev,
MT_TOOL_FINGER, false);
- CheckID[i] = 0;
+ check_id[i] = 0;
}
- Pre_CheckID[i] = CheckID[i];
+ pre_check_id[i] = check_id[i];
}
input_sync(ts->input_dev);
-err_free_allocate:
-
- if (ts->use_irq) {
-#ifdef _INT_MODE_1 /*case 1 mode*/
- /*TODO: After interrupt status low,
- * read i2c bus data by polling,
- * until interrupt status is high*/
- ret = gpio_get_value(GPIO_IRQ);
- /*interrupt pin is still LOW,
- * read data until interrupt pin is released.*/
- if (!ret)
- hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS),
- HRTIMER_MODE_REL);
- else {
- /*clear for interrupt*/
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(ts->client->irq);
- }
-#else /*case 2 mode*/
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(ts->client->irq);
-#endif
- }
-
- mutex_unlock(&ts->mutex_wq);
+out:
+ return IRQ_HANDLED;
}
-static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max)
+static void sis_tpinfo_clear(struct sistp_driver_data *tp_info, int max)
{
int i = 0;
for (i = 0; i < max; i++) {
- TPInfo->pt[i].id = -1;
- TPInfo->pt[i].x = 0;
- TPInfo->pt[i].y = 0;
- TPInfo->pt[i].Pressure = 0;
- TPInfo->pt[i].Width = 0;
+ tp_info->pt[i].id = -1;
+ tp_info->pt[i].x = 0;
+ tp_info->pt[i].y = 0;
+ tp_info->pt[i].pressure = 0;
+ tp_info->pt[i].width = 0;
}
- TPInfo->id = 0x0;
- TPInfo->fingers = 0;
-}
-
-static enum hrtimer_restart sis_ts_timer_func(struct hrtimer *timer)
-{
- struct sis_ts_data *ts = container_of(timer, struct sis_ts_data, timer);
-
- queue_work(sis_wq, &ts->work);
- if (!ts->use_irq) /*For Polling mode*/
- hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS), HRTIMER_MODE_REL);
- return HRTIMER_NORESTART;
-}
-
-static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id)
-{
- struct sis_ts_data *ts = dev_id;
-
- if (!irqd_irq_disabled(&ts->desc->irq_data))
- disable_irq_nosync(ts->client->irq);
- queue_work(sis_wq, &ts->work);
- return IRQ_HANDLED;
-}
-
-static int initial_irq(void)
-{
- int ret = 0;
-
- /* initialize gpio and interrupt pins */
- /*ex. GPIO_133 for interrupt mode*/
- ret = gpio_request(GPIO_IRQ, "GPIO_54");
- if (ret < 0) {
- /*Set Active Low.
- * Please reference the file include/linux/interrupt.h*/
- pr_err("sis_ts_probe: Failed to gpio_request\n");
- pr_err("sis_ts_probe: Fail : gpio_request was called before this driver call\n");
- }
- /* setting gpio direction here OR boardinfo file*/
- return ret;
+ tp_info->id = 0x0;
+ tp_info->fingers = 0;
}
static int sis_ts_probe(
struct i2c_client *client, const struct i2c_device_id *id)
{
- int ret = 0;
- struct sis_ts_data *ts = NULL;
- struct sis_i2c_rmi_platform_data *pdata = NULL;
-
- pr_info("sis_ts_probe\n");
- ts = kzalloc(sizeof(struct sis_ts_data), GFP_KERNEL);
- if (ts == NULL) {
- ret = -ENOMEM;
- goto err_alloc_data_failed;
- }
- ts->TPInfo = kzalloc(sizeof(struct sisTP_driver_data), GFP_KERNEL);
- if (ts->TPInfo == NULL) {
- ret = -ENOMEM;
- goto err_alloc_data_failed;
+ int err = 0;
+ struct sis_ts_data *ts;
+
+ dev_dbg(&client->dev, "sis_ts_probe\n");
+ ts = devm_kzalloc(&client->dev, sizeof(struct sis_ts_data),
+ GFP_KERNEL);
+ if (!ts)
+ return -ENOMEM;
+ ts->tp_info = devm_kzalloc(&client->dev,
+ sizeof(struct sistp_driver_data),
+ GFP_KERNEL);
+ if (!ts->tp_info) {
+ dev_err(&client->dev, "Failed to allocate memory\n");
+ return -ENOMEM;
}
- ts_bak = ts;
- mutex_init(&ts->mutex_wq);
- /*1. Init Work queue and necessary buffers*/
- INIT_WORK(&ts->work, sis_ts_work_func);
+ /*1. Init necessary buffers*/
ts->client = client;
i2c_set_clientdata(client, ts);
- pdata = client->dev.platform_data;
- if (pdata)
- ts->power = pdata->power;
- if (ts->power) {
- ret = ts->power(1);
- if (ret < 0) {
- pr_err("sis_ts_probe power on failed\n");
- goto err_power_failed;
- }
- }
+
/*2. Allocate input device*/
- ts->input_dev = input_allocate_device();
- if (ts->input_dev == NULL) {
- ret = -ENOMEM;
- pr_err("sis_ts_probe: Failed to allocate input device\n");
+ ts->input_dev = devm_input_allocate_device(&client->dev);
+ if (!ts->input_dev) {
+ err = -ENOMEM;
+ dev_err(&client->dev, "sis_ts_probe: Failed to allocate input device\n");
goto err_input_dev_alloc_failed;
}
- /*This input device name should be the same to IDC file name.*/
ts->input_dev->name = "sis_touch";
set_bit(EV_ABS, ts->input_dev->evbit);
set_bit(EV_KEY, ts->input_dev->evbit);
- set_bit(ABS_MT_POSITION_X, ts->input_dev->absbit);
- set_bit(ABS_MT_POSITION_Y, ts->input_dev->absbit);
- set_bit(ABS_MT_PRESSURE, ts->input_dev->absbit);
- set_bit(ABS_MT_TOUCH_MAJOR, ts->input_dev->absbit);
- set_bit(ABS_MT_TOUCH_MINOR, ts->input_dev->absbit);
-
- input_mt_init_slots(ts->input_dev, MAX_SLOTS, INPUT_MT_DIRECT);
-
input_set_abs_params(ts->input_dev, ABS_MT_PRESSURE,
0, PRESSURE_MAX, 0, 0);
input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR,
@@ -458,170 +436,90 @@ static int sis_ts_probe(
0, SIS_MAX_X, 0, 0);
input_set_abs_params(ts->input_dev, ABS_MT_POSITION_Y,
0, SIS_MAX_Y, 0, 0);
+ input_mt_init_slots(ts->input_dev, MAX_SLOTS, INPUT_MT_DIRECT);
/* add for touch keys */
set_bit(KEY_COMPOSE, ts->input_dev->keybit);
set_bit(KEY_BACK, ts->input_dev->keybit);
set_bit(KEY_MENU, ts->input_dev->keybit);
set_bit(KEY_HOME, ts->input_dev->keybit);
+
/*3. Register input device to core*/
- ret = input_register_device(ts->input_dev);
- if (ret) {
- pr_err("sis_ts_probe: Unable to register %s input device\n",
- ts->input_dev->name);
+ err = input_register_device(ts->input_dev);
+ if (err) {
+ dev_err(&client->dev,
+ "sis_ts_probe: Unable to register %s input device\n",
+ ts->input_dev->name);
goto err_input_register_device_failed;
}
- /*4. irq or timer setup*/
- ret = initial_irq();
- if (ret >= 0) {
- client->irq = gpio_to_irq(GPIO_IRQ);
- ret = request_irq(client->irq, sis_ts_irq_handler,
- IRQF_TRIGGER_FALLING, client->name, ts);
- if (ret == 0)
- ts->use_irq = 1;
- else
- dev_err(&client->dev, "request_irq failed\n");
- }
- ts->desc = irq_to_desc(ts_bak->client->irq);
- hrtimer_init(&ts->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
- ts->timer.function = sis_ts_timer_func;
- if (!ts->use_irq)
- hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL);
- pr_info("sis_ts_probe: Start touchscreen %s in %s mode\n",
- ts->input_dev->name,
- ts->use_irq ? "interrupt" : "polling");
- if (ts->use_irq) {
-#ifdef _INT_MODE_1
- pr_info("sis_ts_probe: interrupt case 1 mode\n");
-#else
- pr_info("sis_ts_probe: interrupt case 2 mode\n");
-#endif
+
+ /*4. irq setup*/
+ err = devm_request_threaded_irq(&client->dev, client->irq, NULL,
+ sis_ts_irq_handler,
+ IRQF_TRIGGER_FALLING, client->name,
+ ts);
+ if (err < 0) {
+ dev_err(&client->dev, "Failed to request touchscreen IRQ\n");
+ goto err_request_threaded_irq;
}
- pr_info("sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR);
+
+ dev_dbg(&client->dev, "sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR);
return 0;
+err_request_threaded_irq:
err_input_register_device_failed:
input_free_device(ts->input_dev);
err_input_dev_alloc_failed:
-err_power_failed:
- kfree(ts->TPInfo);
+ kfree(ts->tp_info);
kfree(ts);
-err_alloc_data_failed:
- return ret;
+ return err;
}
static int sis_ts_remove(struct i2c_client *client)
{
struct sis_ts_data *ts = i2c_get_clientdata(client);
- if (ts->use_irq)
- free_irq(client->irq, ts);
- else
- hrtimer_cancel(&ts->timer);
input_unregister_device(ts->input_dev);
+ input_free_device(ts->input_dev);
+ kfree(ts->tp_info);
kfree(ts);
return 0;
}
-#ifdef CONFIG_PM_SLEEP
-static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg)
+static int __maybe_unused sis_ts_suspend(struct device *dev)
{
- int ret = 0;
- struct sis_ts_data *ts = i2c_get_clientdata(client);
-
- if (ts->use_irq) {
- if (!irqd_irq_disabled(&ts->desc->irq_data))
- disable_irq(client->irq);
- } else
- hrtimer_cancel(&ts->timer);
- flush_workqueue(sis_wq); /*only flush sis_wq*/
-
-
- if (ts->power) {
- ret = ts->power(0);
- if (ret < 0)
- pr_err("sis_ts_suspend power off failed\n");
- }
+ struct i2c_client *client = to_i2c_client(dev);
+ disable_irq(client->irq);
return 0;
}
-static int sis_ts_resume(struct i2c_client *client)
+static int __maybe_unused sis_ts_resume(struct device *dev)
{
- int ret = 0;
- struct sis_ts_data *ts = i2c_get_clientdata(client);
+ struct i2c_client *client = to_i2c_client(dev);
- if (ts->power) {
- ret = ts->power(1);
- if (ret < 0)
- pr_err("sis_ts_resume power on failed\n");
- }
-
- if (ts->use_irq) {
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(client->irq);
- } else
- hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL);
+ enable_irq(client->irq);
return 0;
}
-#endif
static SIMPLE_DEV_PM_OPS(sis_ts_pm, sis_ts_suspend, sis_ts_resume);
-#ifdef CONFIG_X86
-/* Return 0 if detection is successful, -ENODEV otherwise */
-static int sis_ts_detect(struct i2c_client *client,
- struct i2c_board_info *info)
-{
- const char *type_name;
-
- pr_info("sis_ts_detect\n");
- type_name = "sis_i2c_ts";
- strlcpy(info->type, type_name, I2C_NAME_SIZE);
- return 0;
-}
-#endif
-
static const struct i2c_device_id sis_ts_id[] = {
{ SIS_I2C_NAME, 0 },
{ }
};
-
MODULE_DEVICE_TABLE(i2c, sis_ts_id);
static struct i2c_driver sis_ts_driver = {
.driver = {
.name = SIS_I2C_NAME,
+ .owner = THIS_MODULE,
.pm = &sis_ts_pm,
},
.probe = sis_ts_probe,
.remove = sis_ts_remove,
-#ifdef CONFIG_X86
- .class = I2C_CLASS_HWMON,
- .detect = sis_ts_detect,
- .address_list = normal_i2c,
-#endif
- .id_table = sis_ts_id,
+ .id_table = sis_ts_id,
};
+module_i2c_driver(sis_ts_driver);
-static int __init sis_ts_init(void)
-{
- pr_info("sis_ts_init\n");
- sis_wq = create_singlethread_workqueue("sis_wq");
-
- if (!sis_wq)
- return -ENOMEM;
- return i2c_add_driver(&sis_ts_driver);
-}
-
-static void __exit sis_ts_exit(void)
-{
- pr_info("sis_ts_exit\n");
- i2c_del_driver(&sis_ts_driver);
- if (sis_wq)
- destroy_workqueue(sis_wq);
-}
-
-module_init(sis_ts_init);
-module_exit(sis_ts_exit);
MODULE_DESCRIPTION("SiS 9200 Family Touchscreen Driver");
-MODULE_LICENSE("GPL");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/sis_i2c.h b/drivers/input/touchscreen/sis_i2c.h
deleted file mode 100644
index a075158..0000000
--- a/drivers/input/touchscreen/sis_i2c.h
+++ /dev/null
@@ -1,164 +0,0 @@
-/*
- * Touch Screen driver for SiS 9200 family I2C Touch panels
- *
- * Copyright (C) 2015 SiS, Inc.
- *
- * This software is licensed under the terms of the GNU General Public
- * License version 2, as published by the Free Software Foundation, and
- * may be copied, distributed, and modified under those terms.
- *
- * 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.
- *
- * Date: 2015/07/07
- */
-#include <linux/version.h>
-
-#ifndef _LINUX_SIS_I2C_H
-#define _LINUX_SIS_I2C_H
-
-
-#define SIS_I2C_NAME "sis_i2c_ts"
-#define SIS_SLAVE_ADDR 0x5c
-/*10ms*/
-#define TIMER_NS 10000000
-#define MAX_FINGERS 10
-
-/* Check data CRC */
-/*#define _CHECK_CRC*/ /*ON/OFF*/
-
-/* Interrupt modes */
-#define GPIO_IRQ 54
-
-/* Enable if use interrupt case 1 mode. */
-/* Disable if use interrupt case 2 mode. */
-/*#define _INT_MODE_1*/ /*ON/OFF*/
-
-/* Resolution mode */
-/*Constant value*/
-#define SIS_MAX_X 4095
-#define SIS_MAX_Y 4095
-
-#define ONE_BYTE 1
-#define FIVE_BYTE 5
-#define EIGHT_BYTE 8
-#define SIXTEEN_BYTE 16
-#define PACKET_BUFFER_SIZE 128
-
-#define SIS_CMD_NORMAL 0x0
-#define SIS_CMD_SOFTRESET 0x82
-#define SIS_CMD_RECALIBRATE 0x87
-#define SIS_CMD_POWERMODE 0x90
-#define MSK_TOUCHNUM 0x0f
-#define MSK_HAS_CRC 0x10
-#define MSK_DATAFMT 0xe0
-#define MSK_PSTATE 0x0f
-#define MSK_PID 0xf0
-#define RES_FMT 0x00
-#define FIX_FMT 0x40
-
-/* for new i2c format */
-#define TOUCHDOWN 0x3
-#define TOUCHUP 0x0
-#define MAX_BYTE 64
-#define PRESSURE_MAX 255
-
-/*Resolution diagonal */
-#define AREA_LENGTH_LONGER 5792
-/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/
-#define AREA_LENGTH_SHORT 5792
-#define AREA_UNIT (5792/32)
-
-
-#define FORMAT_MODE 1
-
-#define MSK_NOBTN 0
-#define MSK_COMP 1
-#define MSK_BACK 2
-#define MSK_MENU 4
-#define MSK_HOME 8
-
-#define P_BYTECOUNT 0
-#define ALL_IN_ONE_PACKAGE 0x10
-#define IS_TOUCH(x) (x & 0x1)
-#define IS_HIDI2C(x) ((x & 0xF) == 0x06)
-#define IS_AREA(x) ((x >> 4) & 0x1)
-#define IS_PRESSURE(x) ((x >> 5) & 0x1)
-#define IS_SCANTIME(x) ((x >> 6) & 0x1)
-#define NORMAL_LEN_PER_POINT 6
-#define AREA_LEN_PER_POINT 2
-#define PRESSURE_LEN_PER_POINT 1
-
-#define TOUCH_FORMAT 0x1
-#define BUTTON_FORMAT 0x4
-#define HIDI2C_FORMAT 0x6
-#define P_REPORT_ID 2
-#define BUTTON_STATE 3
-#define BUTTON_KEY_COUNT 16
-#define BYTE_BYTECOUNT 2
-#define BYTE_COUNT 1
-#define BYTE_ReportID 1
-#define BYTE_CRC_HIDI2C 0
-#define BYTE_CRC_I2C 2
-#define BYTE_SCANTIME 2
-#define NO_TOUCH_BYTECOUNT 0x3
-
-/* TODO */
-#define TOUCH_POWER_PIN 0
-#define TOUCH_RESET_PIN 1
-
-/* CMD Define */
-#define BUF_ACK_PLACE_L 4
-#define BUF_ACK_PLACE_H 5
-#define BUF_ACK_L 0xEF
-#define BUF_ACK_H 0xBE
-#define BUF_NACK_L 0xAD
-#define BUF_NACK_H 0xDE
-#define BUF_CRC_PLACE 7
-#define MAX_SLOTS 15
-
-struct sis_i2c_rmi_platform_data {
- int (*power)(int on); /* Only valid in first array entry */
-};
-
-struct TypeB_Slot {
- int CheckID;
- int id;
- unsigned short x, y;
- uint16_t Pressure;
- uint16_t Width;
- uint16_t Height;
-};
-
-struct Point {
- int id;
- unsigned short x, y; /*uint16_t ?*/
- uint16_t Pressure;
- uint16_t Width;
- uint16_t Height;
-};
-
-struct sisTP_driver_data {
- int id;
- int fingers;
- struct Point pt[MAX_FINGERS];
-};
-
-struct sis_ts_data {
- int (*power)(int on);
- int use_irq;
- struct i2c_client *client;
- struct input_dev *input_dev;
- struct hrtimer timer;
- struct irq_desc *desc;
- struct work_struct work;
- struct mutex mutex_wq;
- struct sisTP_driver_data *TPInfo;
-};
-
-static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg);
-static int sis_ts_resume(struct i2c_client *client);
-
-#endif /* _LINUX_SIS_I2C_H */
--
1.9.1
^ permalink raw reply related [flat|nested] 5+ messages in thread
* [PATCHv2] Add support for SiS i2c touch driver
@ 2015-10-02 8:15 Yuger
2015-10-06 0:39 ` Dmitry Torokhov
0 siblings, 1 reply; 5+ messages in thread
From: Yuger @ 2015-10-02 8:15 UTC (permalink / raw)
To: Dmitry Torokhov; +Cc: linux-input, yuger.yu, yuger_yu, tammy_tseng
Hi, This patch is to add support for SiS i2c touch panel.
Thanks a lot.
v2: Fixed coding style and changed to threaded IRQ.
Signed-off-by: Yuger <yuger_yu@sis.com>
---
drivers/input/touchscreen/Kconfig | 2 +-
drivers/input/touchscreen/sis_i2c.c | 646 +++++++++++++++---------------------
drivers/input/touchscreen/sis_i2c.h | 164 ---------
3 files changed, 273 insertions(+), 539 deletions(-)
delete mode 100644 drivers/input/touchscreen/sis_i2c.h
diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig
index 3d7a30d..ca8420e 100644
--- a/drivers/input/touchscreen/Kconfig
+++ b/drivers/input/touchscreen/Kconfig
@@ -1029,7 +1029,7 @@ config TOUCHSCREEN_ZFORCE
config TOUCHSCREEN_SIS_I2C
tristate "SiS 9200 family I2C touchscreen driver"
- depends on I2C
+ depends on I2C && CRC_ITU_T
help
Say Y here to enable support for I2C connected SiS touch panels.
diff --git a/drivers/input/touchscreen/sis_i2c.c b/drivers/input/touchscreen/sis_i2c.c
index 22dfc1f..f7b6ac5 100644
--- a/drivers/input/touchscreen/sis_i2c.c
+++ b/drivers/input/touchscreen/sis_i2c.c
@@ -12,20 +12,13 @@
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
- * Date: 2015/07/07
*/
-#include <linux/errno.h>
#include <linux/module.h>
-#include <linux/delay.h>
-#include <linux/hrtimer.h>
#include <linux/i2c.h>
#include <linux/input.h>
#include <linux/interrupt.h>
-#include <linux/io.h>
#include <linux/platform_device.h>
-#include "sis_i2c.h"
-#include <linux/linkage.h>
#include <linux/slab.h>
#include <linux/gpio.h>
#include <linux/uaccess.h>
@@ -34,27 +27,86 @@
#include <linux/input/mt.h> /*For Type-B Slot function*/
#include <linux/crc-itu-t.h> /*For CRC Check*/
-/* Addresses to scan */
-static const unsigned short normal_i2c[] = { SIS_SLAVE_ADDR, I2C_CLIENT_END };
-static struct workqueue_struct *sis_wq;
-struct sis_ts_data *ts_bak;
-static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max);
+#define SIS_I2C_NAME "sis_i2c_ts"
+#define SIS_SLAVE_ADDR 0x5c
+#define MAX_FINGERS 10
+
+/*Resolution mode*/
+/*Constant value*/
+#define SIS_MAX_X 4095
+#define SIS_MAX_Y 4095
+
+#define PACKET_BUFFER_SIZE 128
+
+#define SIS_CMD_NORMAL 0x0
+
+/* for new i2c format */
+#define TOUCHDOWN 0x3
+#define TOUCHUP 0x0
+#define MAX_BYTE 64
+#define PRESSURE_MAX 255
+
+/*Resolution diagonal */
+#define AREA_LENGTH_LONGER 5792
+/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/
+#define AREA_LENGTH_SHORT 5792
+#define AREA_UNIT (5792/32)
+
+#define P_BYTECOUNT 0
+#define ALL_IN_ONE_PACKAGE 0x10
+#define IS_TOUCH(x) (x & 0x1)
+#define IS_HIDI2C(x) ((x & 0xF) == 0x06)
+#define IS_AREA(x) ((x >> 4) & 0x1)
+#define IS_PRESSURE(x) ((x >> 5) & 0x1)
+#define IS_SCANTIME(x) ((x >> 6) & 0x1)
+#define NORMAL_LEN_PER_POINT 6
+#define AREA_LEN_PER_POINT 2
+#define PRESSURE_LEN_PER_POINT 1
+
+#define TOUCH_FORMAT 0x1
+#define HIDI2C_FORMAT 0x6
+#define P_REPORT_ID 2
+#define BYTE_BYTECOUNT 2
+#define BYTE_ReportID 1
+#define BYTE_CRC_HIDI2C 0
+#define BYTE_CRC_I2C 2
+#define BYTE_SCANTIME 2
+
+#define MAX_SLOTS 15
+
+struct sis_slot {
+ int check_id;
+ int id;
+ unsigned short x, y;
+ u16 pressure;
+ u16 width;
+ u16 height;
+};
-static int sis_command_for_read(struct i2c_client *client, int rlength,
- unsigned char *rdata)
-{
- int ret;
- struct i2c_msg msg;
+struct point {
+ int id;
+ unsigned short x, y;
+ u16 pressure;
+ u16 width;
+ u16 height;
+};
- msg.addr = client->addr;
- msg.flags = I2C_M_RD; /*Read*/
- msg.len = rlength;
- msg.buf = rdata;
- ret = i2c_transfer(client->adapter, &msg, 1);
- return ret;
-}
+struct sistp_driver_data {
+ int id;
+ int fingers;
+ struct point pt[MAX_FINGERS];
+};
+
+struct sis_ts_data {
+ struct i2c_client *client;
+ struct input_dev *input_dev;
+ struct sistp_driver_data *tp_info;
+};
-static int sis_cul_unit(uint8_t report_id)
+/* Addresses to scan */
+static void sis_tpinfo_clear(struct sistp_driver_data *tp_info, int max);
+
+static int sis_cul_unit(u8 report_id)
{
int ret = NORMAL_LEN_PER_POINT;
@@ -68,73 +120,76 @@ static int sis_cul_unit(uint8_t report_id)
return ret;
}
-static int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf)
+static int sis_readpacket(struct i2c_client *client, u8 cmd, u8 *buf)
{
- uint8_t tmpbuf[MAX_BYTE] = {0}; /*MAX_BYTE = 64;*/
+ u8 tmpbuf[MAX_BYTE] = {0}; /*MAX_BYTE = 64;*/
int ret;
int touchnum = 0;
int p_count = 0;
- int touc_formate_id = 0;
+ int touch_format_id = 0;
int locate = 0;
bool read_first = true;
/*
- * New i2c format
- * buf[0] = Low 8 bits of byte count value
- * buf[1] = High 8 bits of byte counte value
- * buf[2] = Report ID
- * buf[touch num * 6 + 2 ] = Touch information;
- * 1 touch point has 6 bytes, it could be none if no touch
- * buf[touch num * 6 + 3] = Touch numbers
- *
- * One touch point information include 6 bytes, the order is
- *
- * 1. status = touch down or touch up
- * 2. id = finger id
- * 3. x axis low 8 bits
- * 4. x axis high 8 bits
- * 5. y axis low 8 bits
- * 6. y axis high 8 bits
- * */
+ * New i2c format
+ * buf[0] = Low 8 bits of byte count value
+ * buf[1] = High 8 bits of byte count value
+ * buf[2] = Report ID
+ * buf[touch num * 6 + 2 ] = Touch information;
+ * 1 touch point has 6 bytes, it could be none if no touch
+ * buf[touch num * 6 + 3] = Touch numbers
+ *
+ * One touch point information include 6 bytes, the order is
+ *
+ * 1. status = touch down or touch up
+ * 2. id = finger id
+ * 3. x axis low 8 bits
+ * 4. x axis high 8 bits
+ * 5. y axis low 8 bits
+ * 6. y axis high 8 bits
+ */
do {
if (locate >= PACKET_BUFFER_SIZE) {
- pr_err("sis_ReadPacket: Buf Overflow\n");
+ dev_err(&client->dev, "sis_readpacket: Buf Overflow\n");
return -EPERM;
}
- ret = sis_command_for_read(client, MAX_BYTE, tmpbuf);
+ ret = i2c_master_recv(client, tmpbuf, MAX_BYTE);
if (ret < 0) {
- pr_err("sis_ReadPacket: i2c transfer error\n");
+ dev_err(&client->dev, "sis_readpacket: i2c transfer error\n");
return ret;
}
/*error package length of receiving data*/
else if (tmpbuf[P_BYTECOUNT] > MAX_BYTE) {
- pr_err("sis_ReadPacket: Error Bytecount\n");
+ dev_err(&client->dev, "sis_readpacket: Error Bytecount\n");
return -EPERM;
}
if (read_first) {
/*access NO TOUCH event unless BUTTON NO TOUCH event*/
- if (tmpbuf[P_BYTECOUNT] == 0/*NO_TOUCH_BYTECOUNT*/)
+ if (tmpbuf[P_BYTECOUNT] == 0)
return 0; /*touchnum is 0*/
}
- /*skip parsing data when two devices are registered
- * at the same slave address*/
- /*parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT
- * or P_REPORT_ID is ALL_IN_ONE_PACKAGE*/
- touc_formate_id = tmpbuf[P_REPORT_ID] & 0xf;
- if ((touc_formate_id != TOUCH_FORMAT)
- && (touc_formate_id != HIDI2C_FORMAT)
- && (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) {
- pr_err("sis_ReadPacket: Error Report_ID\n");
+ /*
+ * skip parsing data when two devices are registered
+ * at the same slave address
+ * parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT
+ * or P_REPORT_ID is ALL_IN_ONE_PACKAGE
+ */
+ touch_format_id = tmpbuf[P_REPORT_ID] & 0xf;
+ if ((touch_format_id != TOUCH_FORMAT) &&
+ (touch_format_id != HIDI2C_FORMAT) &&
+ (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) {
+ dev_err(&client->dev, "sis_readpacket: Error Report_ID\n");
return -EPERM;
}
p_count = (int) tmpbuf[P_BYTECOUNT] - 1; /*start from 0*/
if (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE) {
if (IS_TOUCH(tmpbuf[P_REPORT_ID])) {
- p_count -= BYTE_CRC_I2C;/*delete 2 byte crc*/
+ /*delete 2 byte crc*/
+ p_count -= BYTE_CRC_I2C;
} else if (IS_HIDI2C(tmpbuf[P_REPORT_ID])) {
p_count -= BYTE_CRC_HIDI2C;
} else { /*should not be happen*/
- pr_err("sis_ReadPacket: delete crc error\n");
+ dev_err(&client->dev, "sis_readpacket: delete crc error\n");
return -EPERM;
}
if (IS_SCANTIME(tmpbuf[P_REPORT_ID]))
@@ -145,76 +200,49 @@ static int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf)
touchnum = tmpbuf[p_count];
} else {
if (tmpbuf[p_count] != 0) {
- pr_err("sis_ReadPacket: get error package\n");
+ dev_err(&client->dev, "sis_readpacket: get error package\n");
return -EPERM;
}
}
-#ifdef _CHECK_CRC
- /* HID over I2C data foramt and no touch packet without CRC */
- if ((touc_formate_id != HIDI2C_FORMAT) &&
+ if ((touch_format_id != HIDI2C_FORMAT) &&
(tmpbuf[P_BYTECOUNT] > 3)) {
int crc_end = p_count + (IS_SCANTIME(
tmpbuf[P_REPORT_ID]) * 2);
- uint16_t buf_crc = crc_itu_t(
+ u16 buf_crc = crc_itu_t(
0, tmpbuf + 2, crc_end - 1);
int l_package_crc = (IS_SCANTIME(
tmpbuf[P_REPORT_ID]) * 2) + p_count + 1;
- uint16_t package_crc = get_unaligned_le16(
+ u16 package_crc = get_unaligned_le16(
&tmpbuf[l_package_crc]);
if (buf_crc != package_crc) {
- pr_err("sis_ReadPacket: CRC Error\n");
+ dev_err(&client->dev, "sis_readpacket: CRC Error\n");
return -EPERM;
}
}
-#endif
- memcpy(&buf[locate], &tmpbuf[0], 64);
+
+ memcpy(&buf[locate], &tmpbuf[0], MAX_BYTE);
/*Buf_Data [0~63] [64~128]*/
- locate += 64;
+ locate += MAX_BYTE;
read_first = false;
} while (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE &&
tmpbuf[p_count] > 5);
return touchnum;
}
-static void sis_ts_work_func(struct work_struct *work)
+static int sis_parse_i2c_event(u8 *buf, u8 fingers,
+ struct sistp_driver_data *tp_info,
+ int *check_id, struct sis_slot *sisdata)
{
- struct sis_ts_data *ts = container_of(work, struct sis_ts_data, work);
- struct sisTP_driver_data *TPInfo = ts->TPInfo;
- int ret;
int point_unit;
- uint8_t buf[PACKET_BUFFER_SIZE] = {0};
- uint8_t i = 0, fingers = 0;
- uint8_t px = 0, py = 0, pstatus = 0;
- uint8_t p_area = 0;
- uint8_t p_preasure = 0;
- int CheckID[MAX_FINGERS];
- static int Pre_CheckID[MAX_FINGERS];
- struct TypeB_Slot MM_Slot[MAX_FINGERS];
-
- memset(CheckID, 0, sizeof(int)*MAX_FINGERS);
-
- mutex_lock(&ts->mutex_wq);
- /*I2C or SMBUS block data read*/
- ret = sis_ReadPacket(ts->client, SIS_CMD_NORMAL, buf);
- /*Error Number*/
- if (ret < 0)
- goto err_free_allocate;
- /*access NO TOUCH event unless BUTTON NO TOUCH event*/
- else if (ret == 0) {
- fingers = 0;
- sis_tpinfo_clear(TPInfo, MAX_FINGERS);
-
- goto Tye_B_report;
- }
- sis_tpinfo_clear(TPInfo, MAX_FINGERS);
-
- /*Parser and Get the sis9200 data*/
+ u8 i = 0, pstatus = 0;
+ u8 px = 0, py = 0;
+ u8 p_area = 0;
+ u8 p_preasure = 0;
+ /*Parser and Get the sis data*/
point_unit = sis_cul_unit(buf[P_REPORT_ID]);
- fingers = ret;
-
- TPInfo->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers);
+ tp_info->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers);
/*fingers 10 = 0 ~ 9*/
for (i = 0; i < fingers; i++) {
@@ -228,226 +256,176 @@ static void sis_ts_work_func(struct work_struct *work)
+ (i * point_unit);
/*Calc point status*/
}
- px = pstatus + 2; /*Calc point x_coord*/
- py = px + 2; /*Calc point y_coord*/
+ px = pstatus + 2; /*Calc point x_coord*/
+ py = px + 2; /*Calc point y_coord*/
if ((buf[pstatus]) == TOUCHUP) {
- TPInfo->pt[i].Width = 0;
- TPInfo->pt[i].Height = 0;
- TPInfo->pt[i].Pressure = 0;
+ tp_info->pt[i].width = 0;
+ tp_info->pt[i].height = 0;
+ tp_info->pt[i].pressure = 0;
} else if (buf[P_REPORT_ID] == ALL_IN_ONE_PACKAGE
&& (buf[pstatus]) == TOUCHDOWN) {
- TPInfo->pt[i].Width = 1;
- TPInfo->pt[i].Height = 1;
- TPInfo->pt[i].Pressure = 1;
+ tp_info->pt[i].width = 1;
+ tp_info->pt[i].height = 1;
+ tp_info->pt[i].pressure = 1;
} else if ((buf[pstatus]) == TOUCHDOWN) {
p_area = py + 2;
p_preasure = py + 2 + (IS_AREA(buf[P_REPORT_ID]) * 2);
/*area*/
if (IS_AREA(buf[P_REPORT_ID])) {
- TPInfo->pt[i].Width = buf[p_area];
- TPInfo->pt[i].Height = buf[p_area + 1];
+ tp_info->pt[i].width = buf[p_area];
+ tp_info->pt[i].height = buf[p_area + 1];
} else {
- TPInfo->pt[i].Width = 1;
- TPInfo->pt[i].Height = 1;
+ tp_info->pt[i].width = 1;
+ tp_info->pt[i].height = 1;
}
/*pressure*/
if (IS_PRESSURE(buf[P_REPORT_ID]))
- TPInfo->pt[i].Pressure = (buf[p_preasure]);
+ tp_info->pt[i].pressure = (buf[p_preasure]);
else
- TPInfo->pt[i].Pressure = 1;
- } else {
- pr_err("sis_ts_work_func: Error Touch Status\n");
- goto err_free_allocate;
- }
- TPInfo->pt[i].id = (buf[pstatus + 1]);
- TPInfo->pt[i].x = get_unaligned_le16(&buf[px]);
- TPInfo->pt[i].y = get_unaligned_le16(&buf[py]);
-
- CheckID[TPInfo->pt[i].id] = 1;
- MM_Slot[TPInfo->pt[i].id].id = TPInfo->pt[i].id;
- MM_Slot[TPInfo->pt[i].id].Pressure = TPInfo->pt[i].Pressure;
- MM_Slot[TPInfo->pt[i].id].x = TPInfo->pt[i].x;
- MM_Slot[TPInfo->pt[i].id].y = TPInfo->pt[i].y;
- MM_Slot[TPInfo->pt[i].id].Width = TPInfo->pt[i].Width
+ tp_info->pt[i].pressure = 1;
+ } else
+ return -EPERM;
+
+ tp_info->pt[i].id = (buf[pstatus + 1]);
+ tp_info->pt[i].x = get_unaligned_le16(&buf[px]);
+ tp_info->pt[i].y = get_unaligned_le16(&buf[py]);
+
+ check_id[tp_info->pt[i].id] = 1;
+ sisdata[tp_info->pt[i].id].id = tp_info->pt[i].id;
+ sisdata[tp_info->pt[i].id].pressure = tp_info->pt[i].pressure;
+ sisdata[tp_info->pt[i].id].x = tp_info->pt[i].x;
+ sisdata[tp_info->pt[i].id].y = tp_info->pt[i].y;
+ sisdata[tp_info->pt[i].id].width = tp_info->pt[i].width
* AREA_UNIT;
- MM_Slot[TPInfo->pt[i].id].Height = TPInfo->pt[i].Height
+ sisdata[tp_info->pt[i].id].height = tp_info->pt[i].height
* AREA_UNIT;
+ }
+ return 0;
+}
+
+static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id)
+{
+ struct sis_ts_data *ts = dev_id;
+ struct sistp_driver_data *tp_info = ts->tp_info;
+ int ret;
+ u8 buf[PACKET_BUFFER_SIZE] = {0};
+ u8 i = 0, fingers = 0;
+ int check_id[MAX_FINGERS];
+ static int pre_check_id[MAX_FINGERS];
+ struct sis_slot sisdata[MAX_FINGERS];
+
+ memset(check_id, 0, sizeof(int)*MAX_FINGERS);
+ /*I2C or SMBUS block data read*/
+ ret = sis_readpacket(ts->client, SIS_CMD_NORMAL, buf);
+ /*Error Number*/
+ if (ret < 0)
+ goto out;
+ /*access NO TOUCH event unless BUTTON NO TOUCH event*/
+ else if (ret == 0) {
+ fingers = 0;
+ sis_tpinfo_clear(tp_info, MAX_FINGERS);
+ goto type_b_report;
}
-Tye_B_report:
+ sis_tpinfo_clear(tp_info, MAX_FINGERS);
+ fingers = ret;
+ ret = sis_parse_i2c_event(buf, fingers, tp_info, check_id, sisdata);
+ if (ret < 0)
+ goto out;
+
+type_b_report:
for (i = 0; i < MAX_FINGERS; i++) {
- if ((CheckID[i] != Pre_CheckID[i]) && (CheckID[i] != 1))
- CheckID[i] = -1;
+ if ((check_id[i] != pre_check_id[i]) && (check_id[i] != 1))
+ check_id[i] = -1;
}
for (i = 0; i < MAX_FINGERS; i++) {
- if (CheckID[i] == 1) {
+ if (check_id[i] == 1) {
input_mt_slot(ts->input_dev, i+1);
- if (MM_Slot[i].Pressure > 0) {
+ if (sisdata[i].pressure > 0) {
input_mt_report_slot_state(ts->input_dev,
- MT_TOOL_FINGER, true);
+ MT_TOOL_FINGER, true);
input_report_abs(ts->input_dev,
- ABS_MT_PRESSURE, MM_Slot[i].Pressure);
+ ABS_MT_PRESSURE, sisdata[i].pressure);
input_report_abs(ts->input_dev,
- ABS_MT_TOUCH_MAJOR, MM_Slot[i].Width);
+ ABS_MT_TOUCH_MAJOR, sisdata[i].width);
input_report_abs(ts->input_dev,
- ABS_MT_TOUCH_MINOR, MM_Slot[i].Height);
+ ABS_MT_TOUCH_MINOR, sisdata[i].height);
input_report_abs(ts->input_dev,
- ABS_MT_POSITION_X, MM_Slot[i].x);
+ ABS_MT_POSITION_X, sisdata[i].x);
input_report_abs(ts->input_dev,
- ABS_MT_POSITION_Y, MM_Slot[i].y);
+ ABS_MT_POSITION_Y, sisdata[i].y);
} else {
input_mt_report_slot_state(ts->input_dev,
- MT_TOOL_FINGER, false);
- CheckID[i] = 0;
+ MT_TOOL_FINGER, false);
+ check_id[i] = 0;
}
- } else if (CheckID[i] == -1) {
+ } else if (check_id[i] == -1) {
input_mt_slot(ts->input_dev, i+1);
input_mt_report_slot_state(ts->input_dev,
MT_TOOL_FINGER, false);
- CheckID[i] = 0;
+ check_id[i] = 0;
}
- Pre_CheckID[i] = CheckID[i];
+ pre_check_id[i] = check_id[i];
}
input_sync(ts->input_dev);
-err_free_allocate:
-
- if (ts->use_irq) {
-#ifdef _INT_MODE_1 /*case 1 mode*/
- /*TODO: After interrupt status low,
- * read i2c bus data by polling,
- * until interrupt status is high*/
- ret = gpio_get_value(GPIO_IRQ);
- /*interrupt pin is still LOW,
- * read data until interrupt pin is released.*/
- if (!ret)
- hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS),
- HRTIMER_MODE_REL);
- else {
- /*clear for interrupt*/
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(ts->client->irq);
- }
-#else /*case 2 mode*/
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(ts->client->irq);
-#endif
- }
-
- mutex_unlock(&ts->mutex_wq);
+out:
+ return IRQ_HANDLED;
}
-static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max)
+static void sis_tpinfo_clear(struct sistp_driver_data *tp_info, int max)
{
int i = 0;
for (i = 0; i < max; i++) {
- TPInfo->pt[i].id = -1;
- TPInfo->pt[i].x = 0;
- TPInfo->pt[i].y = 0;
- TPInfo->pt[i].Pressure = 0;
- TPInfo->pt[i].Width = 0;
+ tp_info->pt[i].id = -1;
+ tp_info->pt[i].x = 0;
+ tp_info->pt[i].y = 0;
+ tp_info->pt[i].pressure = 0;
+ tp_info->pt[i].width = 0;
}
- TPInfo->id = 0x0;
- TPInfo->fingers = 0;
-}
-
-static enum hrtimer_restart sis_ts_timer_func(struct hrtimer *timer)
-{
- struct sis_ts_data *ts = container_of(timer, struct sis_ts_data, timer);
-
- queue_work(sis_wq, &ts->work);
- if (!ts->use_irq) /*For Polling mode*/
- hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS), HRTIMER_MODE_REL);
- return HRTIMER_NORESTART;
-}
-
-static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id)
-{
- struct sis_ts_data *ts = dev_id;
-
- if (!irqd_irq_disabled(&ts->desc->irq_data))
- disable_irq_nosync(ts->client->irq);
- queue_work(sis_wq, &ts->work);
- return IRQ_HANDLED;
-}
-
-static int initial_irq(void)
-{
- int ret = 0;
-
- /* initialize gpio and interrupt pins */
- /*ex. GPIO_133 for interrupt mode*/
- ret = gpio_request(GPIO_IRQ, "GPIO_54");
- if (ret < 0) {
- /*Set Active Low.
- * Please reference the file include/linux/interrupt.h*/
- pr_err("sis_ts_probe: Failed to gpio_request\n");
- pr_err("sis_ts_probe: Fail : gpio_request was called before this driver call\n");
- }
- /* setting gpio direction here OR boardinfo file*/
- return ret;
+ tp_info->id = 0x0;
+ tp_info->fingers = 0;
}
static int sis_ts_probe(
struct i2c_client *client, const struct i2c_device_id *id)
{
- int ret = 0;
- struct sis_ts_data *ts = NULL;
- struct sis_i2c_rmi_platform_data *pdata = NULL;
-
- pr_info("sis_ts_probe\n");
- ts = kzalloc(sizeof(struct sis_ts_data), GFP_KERNEL);
- if (ts == NULL) {
- ret = -ENOMEM;
- goto err_alloc_data_failed;
- }
- ts->TPInfo = kzalloc(sizeof(struct sisTP_driver_data), GFP_KERNEL);
- if (ts->TPInfo == NULL) {
- ret = -ENOMEM;
- goto err_alloc_data_failed;
+ int err = 0;
+ struct sis_ts_data *ts;
+
+ dev_dbg(&client->dev, "sis_ts_probe\n");
+ ts = devm_kzalloc(&client->dev, sizeof(struct sis_ts_data),
+ GFP_KERNEL);
+ if (!ts)
+ return -ENOMEM;
+ ts->tp_info = devm_kzalloc(&client->dev,
+ sizeof(struct sistp_driver_data),
+ GFP_KERNEL);
+ if (!ts->tp_info) {
+ dev_err(&client->dev, "Failed to allocate memory\n");
+ return -ENOMEM;
}
- ts_bak = ts;
- mutex_init(&ts->mutex_wq);
- /*1. Init Work queue and necessary buffers*/
- INIT_WORK(&ts->work, sis_ts_work_func);
+ /*1. Init necessary buffers*/
ts->client = client;
i2c_set_clientdata(client, ts);
- pdata = client->dev.platform_data;
- if (pdata)
- ts->power = pdata->power;
- if (ts->power) {
- ret = ts->power(1);
- if (ret < 0) {
- pr_err("sis_ts_probe power on failed\n");
- goto err_power_failed;
- }
- }
+
/*2. Allocate input device*/
- ts->input_dev = input_allocate_device();
- if (ts->input_dev == NULL) {
- ret = -ENOMEM;
- pr_err("sis_ts_probe: Failed to allocate input device\n");
+ ts->input_dev = devm_input_allocate_device(&client->dev);
+ if (!ts->input_dev) {
+ err = -ENOMEM;
+ dev_err(&client->dev, "sis_ts_probe: Failed to allocate input device\n");
goto err_input_dev_alloc_failed;
}
- /*This input device name should be the same to IDC file name.*/
ts->input_dev->name = "sis_touch";
set_bit(EV_ABS, ts->input_dev->evbit);
set_bit(EV_KEY, ts->input_dev->evbit);
- set_bit(ABS_MT_POSITION_X, ts->input_dev->absbit);
- set_bit(ABS_MT_POSITION_Y, ts->input_dev->absbit);
- set_bit(ABS_MT_PRESSURE, ts->input_dev->absbit);
- set_bit(ABS_MT_TOUCH_MAJOR, ts->input_dev->absbit);
- set_bit(ABS_MT_TOUCH_MINOR, ts->input_dev->absbit);
-
- input_mt_init_slots(ts->input_dev, MAX_SLOTS, INPUT_MT_DIRECT);
-
input_set_abs_params(ts->input_dev, ABS_MT_PRESSURE,
0, PRESSURE_MAX, 0, 0);
input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR,
@@ -458,170 +436,90 @@ static int sis_ts_probe(
0, SIS_MAX_X, 0, 0);
input_set_abs_params(ts->input_dev, ABS_MT_POSITION_Y,
0, SIS_MAX_Y, 0, 0);
+ input_mt_init_slots(ts->input_dev, MAX_SLOTS, INPUT_MT_DIRECT);
/* add for touch keys */
set_bit(KEY_COMPOSE, ts->input_dev->keybit);
set_bit(KEY_BACK, ts->input_dev->keybit);
set_bit(KEY_MENU, ts->input_dev->keybit);
set_bit(KEY_HOME, ts->input_dev->keybit);
+
/*3. Register input device to core*/
- ret = input_register_device(ts->input_dev);
- if (ret) {
- pr_err("sis_ts_probe: Unable to register %s input device\n",
- ts->input_dev->name);
+ err = input_register_device(ts->input_dev);
+ if (err) {
+ dev_err(&client->dev,
+ "sis_ts_probe: Unable to register %s input device\n",
+ ts->input_dev->name);
goto err_input_register_device_failed;
}
- /*4. irq or timer setup*/
- ret = initial_irq();
- if (ret >= 0) {
- client->irq = gpio_to_irq(GPIO_IRQ);
- ret = request_irq(client->irq, sis_ts_irq_handler,
- IRQF_TRIGGER_FALLING, client->name, ts);
- if (ret == 0)
- ts->use_irq = 1;
- else
- dev_err(&client->dev, "request_irq failed\n");
- }
- ts->desc = irq_to_desc(ts_bak->client->irq);
- hrtimer_init(&ts->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
- ts->timer.function = sis_ts_timer_func;
- if (!ts->use_irq)
- hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL);
- pr_info("sis_ts_probe: Start touchscreen %s in %s mode\n",
- ts->input_dev->name,
- ts->use_irq ? "interrupt" : "polling");
- if (ts->use_irq) {
-#ifdef _INT_MODE_1
- pr_info("sis_ts_probe: interrupt case 1 mode\n");
-#else
- pr_info("sis_ts_probe: interrupt case 2 mode\n");
-#endif
+
+ /*4. irq setup*/
+ err = devm_request_threaded_irq(&client->dev, client->irq, NULL,
+ sis_ts_irq_handler,
+ IRQF_TRIGGER_FALLING, client->name,
+ ts);
+ if (err < 0) {
+ dev_err(&client->dev, "Failed to request touchscreen IRQ\n");
+ goto err_request_threaded_irq;
}
- pr_info("sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR);
+
+ dev_dbg(&client->dev, "sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR);
return 0;
+err_request_threaded_irq:
err_input_register_device_failed:
input_free_device(ts->input_dev);
err_input_dev_alloc_failed:
-err_power_failed:
- kfree(ts->TPInfo);
+ kfree(ts->tp_info);
kfree(ts);
-err_alloc_data_failed:
- return ret;
+ return err;
}
static int sis_ts_remove(struct i2c_client *client)
{
struct sis_ts_data *ts = i2c_get_clientdata(client);
- if (ts->use_irq)
- free_irq(client->irq, ts);
- else
- hrtimer_cancel(&ts->timer);
input_unregister_device(ts->input_dev);
+ input_free_device(ts->input_dev);
+ kfree(ts->tp_info);
kfree(ts);
return 0;
}
-#ifdef CONFIG_PM_SLEEP
-static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg)
+static int __maybe_unused sis_ts_suspend(struct device *dev)
{
- int ret = 0;
- struct sis_ts_data *ts = i2c_get_clientdata(client);
-
- if (ts->use_irq) {
- if (!irqd_irq_disabled(&ts->desc->irq_data))
- disable_irq(client->irq);
- } else
- hrtimer_cancel(&ts->timer);
- flush_workqueue(sis_wq); /*only flush sis_wq*/
-
-
- if (ts->power) {
- ret = ts->power(0);
- if (ret < 0)
- pr_err("sis_ts_suspend power off failed\n");
- }
+ struct i2c_client *client = to_i2c_client(dev);
+ disable_irq(client->irq);
return 0;
}
-static int sis_ts_resume(struct i2c_client *client)
+static int __maybe_unused sis_ts_resume(struct device *dev)
{
- int ret = 0;
- struct sis_ts_data *ts = i2c_get_clientdata(client);
+ struct i2c_client *client = to_i2c_client(dev);
- if (ts->power) {
- ret = ts->power(1);
- if (ret < 0)
- pr_err("sis_ts_resume power on failed\n");
- }
-
- if (ts->use_irq) {
- if (irqd_irq_disabled(&ts->desc->irq_data))
- enable_irq(client->irq);
- } else
- hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL);
+ enable_irq(client->irq);
return 0;
}
-#endif
static SIMPLE_DEV_PM_OPS(sis_ts_pm, sis_ts_suspend, sis_ts_resume);
-#ifdef CONFIG_X86
-/* Return 0 if detection is successful, -ENODEV otherwise */
-static int sis_ts_detect(struct i2c_client *client,
- struct i2c_board_info *info)
-{
- const char *type_name;
-
- pr_info("sis_ts_detect\n");
- type_name = "sis_i2c_ts";
- strlcpy(info->type, type_name, I2C_NAME_SIZE);
- return 0;
-}
-#endif
-
static const struct i2c_device_id sis_ts_id[] = {
{ SIS_I2C_NAME, 0 },
{ }
};
-
MODULE_DEVICE_TABLE(i2c, sis_ts_id);
static struct i2c_driver sis_ts_driver = {
.driver = {
.name = SIS_I2C_NAME,
+ .owner = THIS_MODULE,
.pm = &sis_ts_pm,
},
.probe = sis_ts_probe,
.remove = sis_ts_remove,
-#ifdef CONFIG_X86
- .class = I2C_CLASS_HWMON,
- .detect = sis_ts_detect,
- .address_list = normal_i2c,
-#endif
- .id_table = sis_ts_id,
+ .id_table = sis_ts_id,
};
+module_i2c_driver(sis_ts_driver);
-static int __init sis_ts_init(void)
-{
- pr_info("sis_ts_init\n");
- sis_wq = create_singlethread_workqueue("sis_wq");
-
- if (!sis_wq)
- return -ENOMEM;
- return i2c_add_driver(&sis_ts_driver);
-}
-
-static void __exit sis_ts_exit(void)
-{
- pr_info("sis_ts_exit\n");
- i2c_del_driver(&sis_ts_driver);
- if (sis_wq)
- destroy_workqueue(sis_wq);
-}
-
-module_init(sis_ts_init);
-module_exit(sis_ts_exit);
MODULE_DESCRIPTION("SiS 9200 Family Touchscreen Driver");
-MODULE_LICENSE("GPL");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/sis_i2c.h b/drivers/input/touchscreen/sis_i2c.h
deleted file mode 100644
index a075158..0000000
--- a/drivers/input/touchscreen/sis_i2c.h
+++ /dev/null
@@ -1,164 +0,0 @@
-/*
- * Touch Screen driver for SiS 9200 family I2C Touch panels
- *
- * Copyright (C) 2015 SiS, Inc.
- *
- * This software is licensed under the terms of the GNU General Public
- * License version 2, as published by the Free Software Foundation, and
- * may be copied, distributed, and modified under those terms.
- *
- * 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.
- *
- * Date: 2015/07/07
- */
-#include <linux/version.h>
-
-#ifndef _LINUX_SIS_I2C_H
-#define _LINUX_SIS_I2C_H
-
-
-#define SIS_I2C_NAME "sis_i2c_ts"
-#define SIS_SLAVE_ADDR 0x5c
-/*10ms*/
-#define TIMER_NS 10000000
-#define MAX_FINGERS 10
-
-/* Check data CRC */
-/*#define _CHECK_CRC*/ /*ON/OFF*/
-
-/* Interrupt modes */
-#define GPIO_IRQ 54
-
-/* Enable if use interrupt case 1 mode. */
-/* Disable if use interrupt case 2 mode. */
-/*#define _INT_MODE_1*/ /*ON/OFF*/
-
-/* Resolution mode */
-/*Constant value*/
-#define SIS_MAX_X 4095
-#define SIS_MAX_Y 4095
-
-#define ONE_BYTE 1
-#define FIVE_BYTE 5
-#define EIGHT_BYTE 8
-#define SIXTEEN_BYTE 16
-#define PACKET_BUFFER_SIZE 128
-
-#define SIS_CMD_NORMAL 0x0
-#define SIS_CMD_SOFTRESET 0x82
-#define SIS_CMD_RECALIBRATE 0x87
-#define SIS_CMD_POWERMODE 0x90
-#define MSK_TOUCHNUM 0x0f
-#define MSK_HAS_CRC 0x10
-#define MSK_DATAFMT 0xe0
-#define MSK_PSTATE 0x0f
-#define MSK_PID 0xf0
-#define RES_FMT 0x00
-#define FIX_FMT 0x40
-
-/* for new i2c format */
-#define TOUCHDOWN 0x3
-#define TOUCHUP 0x0
-#define MAX_BYTE 64
-#define PRESSURE_MAX 255
-
-/*Resolution diagonal */
-#define AREA_LENGTH_LONGER 5792
-/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/
-#define AREA_LENGTH_SHORT 5792
-#define AREA_UNIT (5792/32)
-
-
-#define FORMAT_MODE 1
-
-#define MSK_NOBTN 0
-#define MSK_COMP 1
-#define MSK_BACK 2
-#define MSK_MENU 4
-#define MSK_HOME 8
-
-#define P_BYTECOUNT 0
-#define ALL_IN_ONE_PACKAGE 0x10
-#define IS_TOUCH(x) (x & 0x1)
-#define IS_HIDI2C(x) ((x & 0xF) == 0x06)
-#define IS_AREA(x) ((x >> 4) & 0x1)
-#define IS_PRESSURE(x) ((x >> 5) & 0x1)
-#define IS_SCANTIME(x) ((x >> 6) & 0x1)
-#define NORMAL_LEN_PER_POINT 6
-#define AREA_LEN_PER_POINT 2
-#define PRESSURE_LEN_PER_POINT 1
-
-#define TOUCH_FORMAT 0x1
-#define BUTTON_FORMAT 0x4
-#define HIDI2C_FORMAT 0x6
-#define P_REPORT_ID 2
-#define BUTTON_STATE 3
-#define BUTTON_KEY_COUNT 16
-#define BYTE_BYTECOUNT 2
-#define BYTE_COUNT 1
-#define BYTE_ReportID 1
-#define BYTE_CRC_HIDI2C 0
-#define BYTE_CRC_I2C 2
-#define BYTE_SCANTIME 2
-#define NO_TOUCH_BYTECOUNT 0x3
-
-/* TODO */
-#define TOUCH_POWER_PIN 0
-#define TOUCH_RESET_PIN 1
-
-/* CMD Define */
-#define BUF_ACK_PLACE_L 4
-#define BUF_ACK_PLACE_H 5
-#define BUF_ACK_L 0xEF
-#define BUF_ACK_H 0xBE
-#define BUF_NACK_L 0xAD
-#define BUF_NACK_H 0xDE
-#define BUF_CRC_PLACE 7
-#define MAX_SLOTS 15
-
-struct sis_i2c_rmi_platform_data {
- int (*power)(int on); /* Only valid in first array entry */
-};
-
-struct TypeB_Slot {
- int CheckID;
- int id;
- unsigned short x, y;
- uint16_t Pressure;
- uint16_t Width;
- uint16_t Height;
-};
-
-struct Point {
- int id;
- unsigned short x, y; /*uint16_t ?*/
- uint16_t Pressure;
- uint16_t Width;
- uint16_t Height;
-};
-
-struct sisTP_driver_data {
- int id;
- int fingers;
- struct Point pt[MAX_FINGERS];
-};
-
-struct sis_ts_data {
- int (*power)(int on);
- int use_irq;
- struct i2c_client *client;
- struct input_dev *input_dev;
- struct hrtimer timer;
- struct irq_desc *desc;
- struct work_struct work;
- struct mutex mutex_wq;
- struct sisTP_driver_data *TPInfo;
-};
-
-static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg);
-static int sis_ts_resume(struct i2c_client *client);
-
-#endif /* _LINUX_SIS_I2C_H */
--
1.9.1
^ permalink raw reply related [flat|nested] 5+ messages in thread
* Re: [PATCHv2] Add support for SiS i2c touch driver
2015-10-02 8:15 [PATCHv2] Add support for SiS i2c touch driver Yuger
@ 2015-10-06 0:39 ` Dmitry Torokhov
0 siblings, 0 replies; 5+ messages in thread
From: Dmitry Torokhov @ 2015-10-06 0:39 UTC (permalink / raw)
To: Yuger; +Cc: linux-input, yuger.yu, tammy_tseng
Hi Yuger,
On Fri, Oct 02, 2015 at 04:15:15PM +0800, Yuger wrote:
> Hi, This patch is to add support for SiS i2c touch panel.
> Thanks a lot.
>
> v2: Fixed coding style and changed to threaded IRQ.
>
> Signed-off-by: Yuger <yuger_yu@sis.com>
Please use your full name on the sign-offs.
Also, it seems that the changes are in the right direction, but until
the driver is accepted into the kernel you should not send incremental
patches, but rather re-send the whole driver as a brand new patch.
Thanks!
> ---
> drivers/input/touchscreen/Kconfig | 2 +-
> drivers/input/touchscreen/sis_i2c.c | 646 +++++++++++++++---------------------
> drivers/input/touchscreen/sis_i2c.h | 164 ---------
> 3 files changed, 273 insertions(+), 539 deletions(-)
> delete mode 100644 drivers/input/touchscreen/sis_i2c.h
>
> diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig
> index 3d7a30d..ca8420e 100644
> --- a/drivers/input/touchscreen/Kconfig
> +++ b/drivers/input/touchscreen/Kconfig
> @@ -1029,7 +1029,7 @@ config TOUCHSCREEN_ZFORCE
>
> config TOUCHSCREEN_SIS_I2C
> tristate "SiS 9200 family I2C touchscreen driver"
> - depends on I2C
> + depends on I2C && CRC_ITU_T
> help
> Say Y here to enable support for I2C connected SiS touch panels.
>
> diff --git a/drivers/input/touchscreen/sis_i2c.c b/drivers/input/touchscreen/sis_i2c.c
> index 22dfc1f..f7b6ac5 100644
> --- a/drivers/input/touchscreen/sis_i2c.c
> +++ b/drivers/input/touchscreen/sis_i2c.c
> @@ -12,20 +12,13 @@
> * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
> * GNU General Public License for more details.
> *
> - * Date: 2015/07/07
> */
>
> -#include <linux/errno.h>
> #include <linux/module.h>
> -#include <linux/delay.h>
> -#include <linux/hrtimer.h>
> #include <linux/i2c.h>
> #include <linux/input.h>
> #include <linux/interrupt.h>
> -#include <linux/io.h>
> #include <linux/platform_device.h>
> -#include "sis_i2c.h"
> -#include <linux/linkage.h>
> #include <linux/slab.h>
> #include <linux/gpio.h>
> #include <linux/uaccess.h>
> @@ -34,27 +27,86 @@
> #include <linux/input/mt.h> /*For Type-B Slot function*/
> #include <linux/crc-itu-t.h> /*For CRC Check*/
>
> -/* Addresses to scan */
> -static const unsigned short normal_i2c[] = { SIS_SLAVE_ADDR, I2C_CLIENT_END };
> -static struct workqueue_struct *sis_wq;
> -struct sis_ts_data *ts_bak;
> -static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max);
> +#define SIS_I2C_NAME "sis_i2c_ts"
> +#define SIS_SLAVE_ADDR 0x5c
> +#define MAX_FINGERS 10
> +
> +/*Resolution mode*/
> +/*Constant value*/
> +#define SIS_MAX_X 4095
> +#define SIS_MAX_Y 4095
> +
> +#define PACKET_BUFFER_SIZE 128
> +
> +#define SIS_CMD_NORMAL 0x0
> +
> +/* for new i2c format */
> +#define TOUCHDOWN 0x3
> +#define TOUCHUP 0x0
> +#define MAX_BYTE 64
> +#define PRESSURE_MAX 255
> +
> +/*Resolution diagonal */
> +#define AREA_LENGTH_LONGER 5792
> +/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/
> +#define AREA_LENGTH_SHORT 5792
> +#define AREA_UNIT (5792/32)
> +
> +#define P_BYTECOUNT 0
> +#define ALL_IN_ONE_PACKAGE 0x10
> +#define IS_TOUCH(x) (x & 0x1)
> +#define IS_HIDI2C(x) ((x & 0xF) == 0x06)
> +#define IS_AREA(x) ((x >> 4) & 0x1)
> +#define IS_PRESSURE(x) ((x >> 5) & 0x1)
> +#define IS_SCANTIME(x) ((x >> 6) & 0x1)
> +#define NORMAL_LEN_PER_POINT 6
> +#define AREA_LEN_PER_POINT 2
> +#define PRESSURE_LEN_PER_POINT 1
> +
> +#define TOUCH_FORMAT 0x1
> +#define HIDI2C_FORMAT 0x6
> +#define P_REPORT_ID 2
> +#define BYTE_BYTECOUNT 2
> +#define BYTE_ReportID 1
> +#define BYTE_CRC_HIDI2C 0
> +#define BYTE_CRC_I2C 2
> +#define BYTE_SCANTIME 2
> +
> +#define MAX_SLOTS 15
> +
> +struct sis_slot {
> + int check_id;
> + int id;
> + unsigned short x, y;
> + u16 pressure;
> + u16 width;
> + u16 height;
> +};
>
> -static int sis_command_for_read(struct i2c_client *client, int rlength,
> - unsigned char *rdata)
> -{
> - int ret;
> - struct i2c_msg msg;
> +struct point {
> + int id;
> + unsigned short x, y;
> + u16 pressure;
> + u16 width;
> + u16 height;
> +};
>
> - msg.addr = client->addr;
> - msg.flags = I2C_M_RD; /*Read*/
> - msg.len = rlength;
> - msg.buf = rdata;
> - ret = i2c_transfer(client->adapter, &msg, 1);
> - return ret;
> -}
> +struct sistp_driver_data {
> + int id;
> + int fingers;
> + struct point pt[MAX_FINGERS];
> +};
> +
> +struct sis_ts_data {
> + struct i2c_client *client;
> + struct input_dev *input_dev;
> + struct sistp_driver_data *tp_info;
> +};
>
> -static int sis_cul_unit(uint8_t report_id)
> +/* Addresses to scan */
> +static void sis_tpinfo_clear(struct sistp_driver_data *tp_info, int max);
> +
> +static int sis_cul_unit(u8 report_id)
> {
> int ret = NORMAL_LEN_PER_POINT;
>
> @@ -68,73 +120,76 @@ static int sis_cul_unit(uint8_t report_id)
> return ret;
> }
>
> -static int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf)
> +static int sis_readpacket(struct i2c_client *client, u8 cmd, u8 *buf)
> {
> - uint8_t tmpbuf[MAX_BYTE] = {0}; /*MAX_BYTE = 64;*/
> + u8 tmpbuf[MAX_BYTE] = {0}; /*MAX_BYTE = 64;*/
> int ret;
> int touchnum = 0;
> int p_count = 0;
> - int touc_formate_id = 0;
> + int touch_format_id = 0;
> int locate = 0;
> bool read_first = true;
> /*
> - * New i2c format
> - * buf[0] = Low 8 bits of byte count value
> - * buf[1] = High 8 bits of byte counte value
> - * buf[2] = Report ID
> - * buf[touch num * 6 + 2 ] = Touch information;
> - * 1 touch point has 6 bytes, it could be none if no touch
> - * buf[touch num * 6 + 3] = Touch numbers
> - *
> - * One touch point information include 6 bytes, the order is
> - *
> - * 1. status = touch down or touch up
> - * 2. id = finger id
> - * 3. x axis low 8 bits
> - * 4. x axis high 8 bits
> - * 5. y axis low 8 bits
> - * 6. y axis high 8 bits
> - * */
> + * New i2c format
> + * buf[0] = Low 8 bits of byte count value
> + * buf[1] = High 8 bits of byte count value
> + * buf[2] = Report ID
> + * buf[touch num * 6 + 2 ] = Touch information;
> + * 1 touch point has 6 bytes, it could be none if no touch
> + * buf[touch num * 6 + 3] = Touch numbers
> + *
> + * One touch point information include 6 bytes, the order is
> + *
> + * 1. status = touch down or touch up
> + * 2. id = finger id
> + * 3. x axis low 8 bits
> + * 4. x axis high 8 bits
> + * 5. y axis low 8 bits
> + * 6. y axis high 8 bits
> + */
> do {
> if (locate >= PACKET_BUFFER_SIZE) {
> - pr_err("sis_ReadPacket: Buf Overflow\n");
> + dev_err(&client->dev, "sis_readpacket: Buf Overflow\n");
> return -EPERM;
> }
> - ret = sis_command_for_read(client, MAX_BYTE, tmpbuf);
> + ret = i2c_master_recv(client, tmpbuf, MAX_BYTE);
>
> if (ret < 0) {
> - pr_err("sis_ReadPacket: i2c transfer error\n");
> + dev_err(&client->dev, "sis_readpacket: i2c transfer error\n");
> return ret;
> }
> /*error package length of receiving data*/
> else if (tmpbuf[P_BYTECOUNT] > MAX_BYTE) {
> - pr_err("sis_ReadPacket: Error Bytecount\n");
> + dev_err(&client->dev, "sis_readpacket: Error Bytecount\n");
> return -EPERM;
> }
> if (read_first) {
> /*access NO TOUCH event unless BUTTON NO TOUCH event*/
> - if (tmpbuf[P_BYTECOUNT] == 0/*NO_TOUCH_BYTECOUNT*/)
> + if (tmpbuf[P_BYTECOUNT] == 0)
> return 0; /*touchnum is 0*/
> }
> - /*skip parsing data when two devices are registered
> - * at the same slave address*/
> - /*parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT
> - * or P_REPORT_ID is ALL_IN_ONE_PACKAGE*/
> - touc_formate_id = tmpbuf[P_REPORT_ID] & 0xf;
> - if ((touc_formate_id != TOUCH_FORMAT)
> - && (touc_formate_id != HIDI2C_FORMAT)
> - && (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) {
> - pr_err("sis_ReadPacket: Error Report_ID\n");
> + /*
> + * skip parsing data when two devices are registered
> + * at the same slave address
> + * parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT
> + * or P_REPORT_ID is ALL_IN_ONE_PACKAGE
> + */
> + touch_format_id = tmpbuf[P_REPORT_ID] & 0xf;
> + if ((touch_format_id != TOUCH_FORMAT) &&
> + (touch_format_id != HIDI2C_FORMAT) &&
> + (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) {
> + dev_err(&client->dev, "sis_readpacket: Error Report_ID\n");
> return -EPERM;
> }
> p_count = (int) tmpbuf[P_BYTECOUNT] - 1; /*start from 0*/
> if (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE) {
> if (IS_TOUCH(tmpbuf[P_REPORT_ID])) {
> - p_count -= BYTE_CRC_I2C;/*delete 2 byte crc*/
> + /*delete 2 byte crc*/
> + p_count -= BYTE_CRC_I2C;
> } else if (IS_HIDI2C(tmpbuf[P_REPORT_ID])) {
> p_count -= BYTE_CRC_HIDI2C;
> } else { /*should not be happen*/
> - pr_err("sis_ReadPacket: delete crc error\n");
> + dev_err(&client->dev, "sis_readpacket: delete crc error\n");
> return -EPERM;
> }
> if (IS_SCANTIME(tmpbuf[P_REPORT_ID]))
> @@ -145,76 +200,49 @@ static int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf)
> touchnum = tmpbuf[p_count];
> } else {
> if (tmpbuf[p_count] != 0) {
> - pr_err("sis_ReadPacket: get error package\n");
> + dev_err(&client->dev, "sis_readpacket: get error package\n");
> return -EPERM;
> }
> }
>
> -#ifdef _CHECK_CRC
> - /* HID over I2C data foramt and no touch packet without CRC */
> - if ((touc_formate_id != HIDI2C_FORMAT) &&
> + if ((touch_format_id != HIDI2C_FORMAT) &&
> (tmpbuf[P_BYTECOUNT] > 3)) {
> int crc_end = p_count + (IS_SCANTIME(
> tmpbuf[P_REPORT_ID]) * 2);
> - uint16_t buf_crc = crc_itu_t(
> + u16 buf_crc = crc_itu_t(
> 0, tmpbuf + 2, crc_end - 1);
> int l_package_crc = (IS_SCANTIME(
> tmpbuf[P_REPORT_ID]) * 2) + p_count + 1;
> - uint16_t package_crc = get_unaligned_le16(
> + u16 package_crc = get_unaligned_le16(
> &tmpbuf[l_package_crc]);
>
> if (buf_crc != package_crc) {
> - pr_err("sis_ReadPacket: CRC Error\n");
> + dev_err(&client->dev, "sis_readpacket: CRC Error\n");
> return -EPERM;
> }
> }
> -#endif
> - memcpy(&buf[locate], &tmpbuf[0], 64);
> +
> + memcpy(&buf[locate], &tmpbuf[0], MAX_BYTE);
> /*Buf_Data [0~63] [64~128]*/
> - locate += 64;
> + locate += MAX_BYTE;
> read_first = false;
> } while (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE &&
> tmpbuf[p_count] > 5);
> return touchnum;
> }
>
> -static void sis_ts_work_func(struct work_struct *work)
> +static int sis_parse_i2c_event(u8 *buf, u8 fingers,
> + struct sistp_driver_data *tp_info,
> + int *check_id, struct sis_slot *sisdata)
> {
> - struct sis_ts_data *ts = container_of(work, struct sis_ts_data, work);
> - struct sisTP_driver_data *TPInfo = ts->TPInfo;
> - int ret;
> int point_unit;
> - uint8_t buf[PACKET_BUFFER_SIZE] = {0};
> - uint8_t i = 0, fingers = 0;
> - uint8_t px = 0, py = 0, pstatus = 0;
> - uint8_t p_area = 0;
> - uint8_t p_preasure = 0;
> - int CheckID[MAX_FINGERS];
> - static int Pre_CheckID[MAX_FINGERS];
> - struct TypeB_Slot MM_Slot[MAX_FINGERS];
> -
> - memset(CheckID, 0, sizeof(int)*MAX_FINGERS);
> -
> - mutex_lock(&ts->mutex_wq);
> - /*I2C or SMBUS block data read*/
> - ret = sis_ReadPacket(ts->client, SIS_CMD_NORMAL, buf);
> - /*Error Number*/
> - if (ret < 0)
> - goto err_free_allocate;
> - /*access NO TOUCH event unless BUTTON NO TOUCH event*/
> - else if (ret == 0) {
> - fingers = 0;
> - sis_tpinfo_clear(TPInfo, MAX_FINGERS);
> -
> - goto Tye_B_report;
> - }
> - sis_tpinfo_clear(TPInfo, MAX_FINGERS);
> -
> - /*Parser and Get the sis9200 data*/
> + u8 i = 0, pstatus = 0;
> + u8 px = 0, py = 0;
> + u8 p_area = 0;
> + u8 p_preasure = 0;
> + /*Parser and Get the sis data*/
> point_unit = sis_cul_unit(buf[P_REPORT_ID]);
> - fingers = ret;
> -
> - TPInfo->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers);
> + tp_info->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers);
>
> /*fingers 10 = 0 ~ 9*/
> for (i = 0; i < fingers; i++) {
> @@ -228,226 +256,176 @@ static void sis_ts_work_func(struct work_struct *work)
> + (i * point_unit);
> /*Calc point status*/
> }
> - px = pstatus + 2; /*Calc point x_coord*/
> - py = px + 2; /*Calc point y_coord*/
> + px = pstatus + 2; /*Calc point x_coord*/
> + py = px + 2; /*Calc point y_coord*/
> if ((buf[pstatus]) == TOUCHUP) {
> - TPInfo->pt[i].Width = 0;
> - TPInfo->pt[i].Height = 0;
> - TPInfo->pt[i].Pressure = 0;
> + tp_info->pt[i].width = 0;
> + tp_info->pt[i].height = 0;
> + tp_info->pt[i].pressure = 0;
> } else if (buf[P_REPORT_ID] == ALL_IN_ONE_PACKAGE
> && (buf[pstatus]) == TOUCHDOWN) {
> - TPInfo->pt[i].Width = 1;
> - TPInfo->pt[i].Height = 1;
> - TPInfo->pt[i].Pressure = 1;
> + tp_info->pt[i].width = 1;
> + tp_info->pt[i].height = 1;
> + tp_info->pt[i].pressure = 1;
> } else if ((buf[pstatus]) == TOUCHDOWN) {
> p_area = py + 2;
> p_preasure = py + 2 + (IS_AREA(buf[P_REPORT_ID]) * 2);
> /*area*/
> if (IS_AREA(buf[P_REPORT_ID])) {
> - TPInfo->pt[i].Width = buf[p_area];
> - TPInfo->pt[i].Height = buf[p_area + 1];
> + tp_info->pt[i].width = buf[p_area];
> + tp_info->pt[i].height = buf[p_area + 1];
> } else {
> - TPInfo->pt[i].Width = 1;
> - TPInfo->pt[i].Height = 1;
> + tp_info->pt[i].width = 1;
> + tp_info->pt[i].height = 1;
> }
> /*pressure*/
> if (IS_PRESSURE(buf[P_REPORT_ID]))
> - TPInfo->pt[i].Pressure = (buf[p_preasure]);
> + tp_info->pt[i].pressure = (buf[p_preasure]);
> else
> - TPInfo->pt[i].Pressure = 1;
> - } else {
> - pr_err("sis_ts_work_func: Error Touch Status\n");
> - goto err_free_allocate;
> - }
> - TPInfo->pt[i].id = (buf[pstatus + 1]);
> - TPInfo->pt[i].x = get_unaligned_le16(&buf[px]);
> - TPInfo->pt[i].y = get_unaligned_le16(&buf[py]);
> -
> - CheckID[TPInfo->pt[i].id] = 1;
> - MM_Slot[TPInfo->pt[i].id].id = TPInfo->pt[i].id;
> - MM_Slot[TPInfo->pt[i].id].Pressure = TPInfo->pt[i].Pressure;
> - MM_Slot[TPInfo->pt[i].id].x = TPInfo->pt[i].x;
> - MM_Slot[TPInfo->pt[i].id].y = TPInfo->pt[i].y;
> - MM_Slot[TPInfo->pt[i].id].Width = TPInfo->pt[i].Width
> + tp_info->pt[i].pressure = 1;
> + } else
> + return -EPERM;
> +
> + tp_info->pt[i].id = (buf[pstatus + 1]);
> + tp_info->pt[i].x = get_unaligned_le16(&buf[px]);
> + tp_info->pt[i].y = get_unaligned_le16(&buf[py]);
> +
> + check_id[tp_info->pt[i].id] = 1;
> + sisdata[tp_info->pt[i].id].id = tp_info->pt[i].id;
> + sisdata[tp_info->pt[i].id].pressure = tp_info->pt[i].pressure;
> + sisdata[tp_info->pt[i].id].x = tp_info->pt[i].x;
> + sisdata[tp_info->pt[i].id].y = tp_info->pt[i].y;
> + sisdata[tp_info->pt[i].id].width = tp_info->pt[i].width
> * AREA_UNIT;
> - MM_Slot[TPInfo->pt[i].id].Height = TPInfo->pt[i].Height
> + sisdata[tp_info->pt[i].id].height = tp_info->pt[i].height
> * AREA_UNIT;
> + }
> + return 0;
> +}
> +
> +static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id)
> +{
> + struct sis_ts_data *ts = dev_id;
> + struct sistp_driver_data *tp_info = ts->tp_info;
> + int ret;
> + u8 buf[PACKET_BUFFER_SIZE] = {0};
> + u8 i = 0, fingers = 0;
> + int check_id[MAX_FINGERS];
> + static int pre_check_id[MAX_FINGERS];
> + struct sis_slot sisdata[MAX_FINGERS];
> +
> + memset(check_id, 0, sizeof(int)*MAX_FINGERS);
>
> + /*I2C or SMBUS block data read*/
> + ret = sis_readpacket(ts->client, SIS_CMD_NORMAL, buf);
> + /*Error Number*/
> + if (ret < 0)
> + goto out;
> + /*access NO TOUCH event unless BUTTON NO TOUCH event*/
> + else if (ret == 0) {
> + fingers = 0;
> + sis_tpinfo_clear(tp_info, MAX_FINGERS);
> + goto type_b_report;
> }
>
> -Tye_B_report:
> + sis_tpinfo_clear(tp_info, MAX_FINGERS);
> + fingers = ret;
>
> + ret = sis_parse_i2c_event(buf, fingers, tp_info, check_id, sisdata);
> + if (ret < 0)
> + goto out;
> +
> +type_b_report:
> for (i = 0; i < MAX_FINGERS; i++) {
> - if ((CheckID[i] != Pre_CheckID[i]) && (CheckID[i] != 1))
> - CheckID[i] = -1;
> + if ((check_id[i] != pre_check_id[i]) && (check_id[i] != 1))
> + check_id[i] = -1;
> }
>
> for (i = 0; i < MAX_FINGERS; i++) {
> - if (CheckID[i] == 1) {
> + if (check_id[i] == 1) {
> input_mt_slot(ts->input_dev, i+1);
> - if (MM_Slot[i].Pressure > 0) {
> + if (sisdata[i].pressure > 0) {
> input_mt_report_slot_state(ts->input_dev,
> - MT_TOOL_FINGER, true);
> + MT_TOOL_FINGER, true);
> input_report_abs(ts->input_dev,
> - ABS_MT_PRESSURE, MM_Slot[i].Pressure);
> + ABS_MT_PRESSURE, sisdata[i].pressure);
> input_report_abs(ts->input_dev,
> - ABS_MT_TOUCH_MAJOR, MM_Slot[i].Width);
> + ABS_MT_TOUCH_MAJOR, sisdata[i].width);
> input_report_abs(ts->input_dev,
> - ABS_MT_TOUCH_MINOR, MM_Slot[i].Height);
> + ABS_MT_TOUCH_MINOR, sisdata[i].height);
> input_report_abs(ts->input_dev,
> - ABS_MT_POSITION_X, MM_Slot[i].x);
> + ABS_MT_POSITION_X, sisdata[i].x);
> input_report_abs(ts->input_dev,
> - ABS_MT_POSITION_Y, MM_Slot[i].y);
> + ABS_MT_POSITION_Y, sisdata[i].y);
> } else {
> input_mt_report_slot_state(ts->input_dev,
> - MT_TOOL_FINGER, false);
> - CheckID[i] = 0;
> + MT_TOOL_FINGER, false);
> + check_id[i] = 0;
> }
> - } else if (CheckID[i] == -1) {
> + } else if (check_id[i] == -1) {
> input_mt_slot(ts->input_dev, i+1);
> input_mt_report_slot_state(ts->input_dev,
> MT_TOOL_FINGER, false);
> - CheckID[i] = 0;
> + check_id[i] = 0;
> }
> - Pre_CheckID[i] = CheckID[i];
> + pre_check_id[i] = check_id[i];
> }
>
> input_sync(ts->input_dev);
>
> -err_free_allocate:
> -
> - if (ts->use_irq) {
> -#ifdef _INT_MODE_1 /*case 1 mode*/
> - /*TODO: After interrupt status low,
> - * read i2c bus data by polling,
> - * until interrupt status is high*/
> - ret = gpio_get_value(GPIO_IRQ);
> - /*interrupt pin is still LOW,
> - * read data until interrupt pin is released.*/
> - if (!ret)
> - hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS),
> - HRTIMER_MODE_REL);
> - else {
> - /*clear for interrupt*/
> - if (irqd_irq_disabled(&ts->desc->irq_data))
> - enable_irq(ts->client->irq);
> - }
> -#else /*case 2 mode*/
> - if (irqd_irq_disabled(&ts->desc->irq_data))
> - enable_irq(ts->client->irq);
> -#endif
> - }
> -
> - mutex_unlock(&ts->mutex_wq);
> +out:
> + return IRQ_HANDLED;
> }
>
> -static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max)
> +static void sis_tpinfo_clear(struct sistp_driver_data *tp_info, int max)
> {
> int i = 0;
>
> for (i = 0; i < max; i++) {
> - TPInfo->pt[i].id = -1;
> - TPInfo->pt[i].x = 0;
> - TPInfo->pt[i].y = 0;
> - TPInfo->pt[i].Pressure = 0;
> - TPInfo->pt[i].Width = 0;
> + tp_info->pt[i].id = -1;
> + tp_info->pt[i].x = 0;
> + tp_info->pt[i].y = 0;
> + tp_info->pt[i].pressure = 0;
> + tp_info->pt[i].width = 0;
> }
> - TPInfo->id = 0x0;
> - TPInfo->fingers = 0;
> -}
> -
> -static enum hrtimer_restart sis_ts_timer_func(struct hrtimer *timer)
> -{
> - struct sis_ts_data *ts = container_of(timer, struct sis_ts_data, timer);
> -
> - queue_work(sis_wq, &ts->work);
> - if (!ts->use_irq) /*For Polling mode*/
> - hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS), HRTIMER_MODE_REL);
> - return HRTIMER_NORESTART;
> -}
> -
> -static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id)
> -{
> - struct sis_ts_data *ts = dev_id;
> -
> - if (!irqd_irq_disabled(&ts->desc->irq_data))
> - disable_irq_nosync(ts->client->irq);
> - queue_work(sis_wq, &ts->work);
> - return IRQ_HANDLED;
> -}
> -
> -static int initial_irq(void)
> -{
> - int ret = 0;
> -
> - /* initialize gpio and interrupt pins */
> - /*ex. GPIO_133 for interrupt mode*/
> - ret = gpio_request(GPIO_IRQ, "GPIO_54");
> - if (ret < 0) {
> - /*Set Active Low.
> - * Please reference the file include/linux/interrupt.h*/
> - pr_err("sis_ts_probe: Failed to gpio_request\n");
> - pr_err("sis_ts_probe: Fail : gpio_request was called before this driver call\n");
> - }
> - /* setting gpio direction here OR boardinfo file*/
> - return ret;
> + tp_info->id = 0x0;
> + tp_info->fingers = 0;
> }
>
> static int sis_ts_probe(
> struct i2c_client *client, const struct i2c_device_id *id)
> {
> - int ret = 0;
> - struct sis_ts_data *ts = NULL;
> - struct sis_i2c_rmi_platform_data *pdata = NULL;
> -
> - pr_info("sis_ts_probe\n");
> - ts = kzalloc(sizeof(struct sis_ts_data), GFP_KERNEL);
> - if (ts == NULL) {
> - ret = -ENOMEM;
> - goto err_alloc_data_failed;
> - }
> - ts->TPInfo = kzalloc(sizeof(struct sisTP_driver_data), GFP_KERNEL);
> - if (ts->TPInfo == NULL) {
> - ret = -ENOMEM;
> - goto err_alloc_data_failed;
> + int err = 0;
> + struct sis_ts_data *ts;
> +
> + dev_dbg(&client->dev, "sis_ts_probe\n");
> + ts = devm_kzalloc(&client->dev, sizeof(struct sis_ts_data),
> + GFP_KERNEL);
> + if (!ts)
> + return -ENOMEM;
> + ts->tp_info = devm_kzalloc(&client->dev,
> + sizeof(struct sistp_driver_data),
> + GFP_KERNEL);
> + if (!ts->tp_info) {
> + dev_err(&client->dev, "Failed to allocate memory\n");
> + return -ENOMEM;
> }
> - ts_bak = ts;
>
> - mutex_init(&ts->mutex_wq);
> - /*1. Init Work queue and necessary buffers*/
> - INIT_WORK(&ts->work, sis_ts_work_func);
> + /*1. Init necessary buffers*/
> ts->client = client;
> i2c_set_clientdata(client, ts);
> - pdata = client->dev.platform_data;
> - if (pdata)
> - ts->power = pdata->power;
> - if (ts->power) {
> - ret = ts->power(1);
> - if (ret < 0) {
> - pr_err("sis_ts_probe power on failed\n");
> - goto err_power_failed;
> - }
> - }
> +
> /*2. Allocate input device*/
> - ts->input_dev = input_allocate_device();
> - if (ts->input_dev == NULL) {
> - ret = -ENOMEM;
> - pr_err("sis_ts_probe: Failed to allocate input device\n");
> + ts->input_dev = devm_input_allocate_device(&client->dev);
> + if (!ts->input_dev) {
> + err = -ENOMEM;
> + dev_err(&client->dev, "sis_ts_probe: Failed to allocate input device\n");
> goto err_input_dev_alloc_failed;
> }
> - /*This input device name should be the same to IDC file name.*/
> ts->input_dev->name = "sis_touch";
>
> set_bit(EV_ABS, ts->input_dev->evbit);
> set_bit(EV_KEY, ts->input_dev->evbit);
> - set_bit(ABS_MT_POSITION_X, ts->input_dev->absbit);
> - set_bit(ABS_MT_POSITION_Y, ts->input_dev->absbit);
> - set_bit(ABS_MT_PRESSURE, ts->input_dev->absbit);
> - set_bit(ABS_MT_TOUCH_MAJOR, ts->input_dev->absbit);
> - set_bit(ABS_MT_TOUCH_MINOR, ts->input_dev->absbit);
> -
> - input_mt_init_slots(ts->input_dev, MAX_SLOTS, INPUT_MT_DIRECT);
> -
> input_set_abs_params(ts->input_dev, ABS_MT_PRESSURE,
> 0, PRESSURE_MAX, 0, 0);
> input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR,
> @@ -458,170 +436,90 @@ static int sis_ts_probe(
> 0, SIS_MAX_X, 0, 0);
> input_set_abs_params(ts->input_dev, ABS_MT_POSITION_Y,
> 0, SIS_MAX_Y, 0, 0);
> + input_mt_init_slots(ts->input_dev, MAX_SLOTS, INPUT_MT_DIRECT);
>
> /* add for touch keys */
> set_bit(KEY_COMPOSE, ts->input_dev->keybit);
> set_bit(KEY_BACK, ts->input_dev->keybit);
> set_bit(KEY_MENU, ts->input_dev->keybit);
> set_bit(KEY_HOME, ts->input_dev->keybit);
> +
> /*3. Register input device to core*/
> - ret = input_register_device(ts->input_dev);
> - if (ret) {
> - pr_err("sis_ts_probe: Unable to register %s input device\n",
> - ts->input_dev->name);
> + err = input_register_device(ts->input_dev);
> + if (err) {
> + dev_err(&client->dev,
> + "sis_ts_probe: Unable to register %s input device\n",
> + ts->input_dev->name);
> goto err_input_register_device_failed;
> }
> - /*4. irq or timer setup*/
> - ret = initial_irq();
> - if (ret >= 0) {
> - client->irq = gpio_to_irq(GPIO_IRQ);
> - ret = request_irq(client->irq, sis_ts_irq_handler,
> - IRQF_TRIGGER_FALLING, client->name, ts);
> - if (ret == 0)
> - ts->use_irq = 1;
> - else
> - dev_err(&client->dev, "request_irq failed\n");
> - }
> - ts->desc = irq_to_desc(ts_bak->client->irq);
> - hrtimer_init(&ts->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
> - ts->timer.function = sis_ts_timer_func;
> - if (!ts->use_irq)
> - hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL);
> - pr_info("sis_ts_probe: Start touchscreen %s in %s mode\n",
> - ts->input_dev->name,
> - ts->use_irq ? "interrupt" : "polling");
> - if (ts->use_irq) {
> -#ifdef _INT_MODE_1
> - pr_info("sis_ts_probe: interrupt case 1 mode\n");
> -#else
> - pr_info("sis_ts_probe: interrupt case 2 mode\n");
> -#endif
> +
> + /*4. irq setup*/
> + err = devm_request_threaded_irq(&client->dev, client->irq, NULL,
> + sis_ts_irq_handler,
> + IRQF_TRIGGER_FALLING, client->name,
> + ts);
> + if (err < 0) {
> + dev_err(&client->dev, "Failed to request touchscreen IRQ\n");
> + goto err_request_threaded_irq;
> }
> - pr_info("sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR);
> +
> + dev_dbg(&client->dev, "sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR);
> return 0;
> +err_request_threaded_irq:
> err_input_register_device_failed:
> input_free_device(ts->input_dev);
> err_input_dev_alloc_failed:
> -err_power_failed:
> - kfree(ts->TPInfo);
> + kfree(ts->tp_info);
> kfree(ts);
> -err_alloc_data_failed:
> - return ret;
> + return err;
> }
>
> static int sis_ts_remove(struct i2c_client *client)
> {
> struct sis_ts_data *ts = i2c_get_clientdata(client);
>
> - if (ts->use_irq)
> - free_irq(client->irq, ts);
> - else
> - hrtimer_cancel(&ts->timer);
> input_unregister_device(ts->input_dev);
> + input_free_device(ts->input_dev);
> + kfree(ts->tp_info);
> kfree(ts);
> return 0;
> }
>
> -#ifdef CONFIG_PM_SLEEP
> -static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg)
> +static int __maybe_unused sis_ts_suspend(struct device *dev)
> {
> - int ret = 0;
> - struct sis_ts_data *ts = i2c_get_clientdata(client);
> -
> - if (ts->use_irq) {
> - if (!irqd_irq_disabled(&ts->desc->irq_data))
> - disable_irq(client->irq);
> - } else
> - hrtimer_cancel(&ts->timer);
> - flush_workqueue(sis_wq); /*only flush sis_wq*/
> -
> -
> - if (ts->power) {
> - ret = ts->power(0);
> - if (ret < 0)
> - pr_err("sis_ts_suspend power off failed\n");
> - }
> + struct i2c_client *client = to_i2c_client(dev);
>
> + disable_irq(client->irq);
> return 0;
> }
>
> -static int sis_ts_resume(struct i2c_client *client)
> +static int __maybe_unused sis_ts_resume(struct device *dev)
> {
> - int ret = 0;
> - struct sis_ts_data *ts = i2c_get_clientdata(client);
> + struct i2c_client *client = to_i2c_client(dev);
>
> - if (ts->power) {
> - ret = ts->power(1);
> - if (ret < 0)
> - pr_err("sis_ts_resume power on failed\n");
> - }
> -
> - if (ts->use_irq) {
> - if (irqd_irq_disabled(&ts->desc->irq_data))
> - enable_irq(client->irq);
> - } else
> - hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL);
> + enable_irq(client->irq);
> return 0;
> }
> -#endif
>
> static SIMPLE_DEV_PM_OPS(sis_ts_pm, sis_ts_suspend, sis_ts_resume);
>
> -#ifdef CONFIG_X86
> -/* Return 0 if detection is successful, -ENODEV otherwise */
> -static int sis_ts_detect(struct i2c_client *client,
> - struct i2c_board_info *info)
> -{
> - const char *type_name;
> -
> - pr_info("sis_ts_detect\n");
> - type_name = "sis_i2c_ts";
> - strlcpy(info->type, type_name, I2C_NAME_SIZE);
> - return 0;
> -}
> -#endif
> -
> static const struct i2c_device_id sis_ts_id[] = {
> { SIS_I2C_NAME, 0 },
> { }
> };
> -
> MODULE_DEVICE_TABLE(i2c, sis_ts_id);
>
> static struct i2c_driver sis_ts_driver = {
> .driver = {
> .name = SIS_I2C_NAME,
> + .owner = THIS_MODULE,
> .pm = &sis_ts_pm,
> },
> .probe = sis_ts_probe,
> .remove = sis_ts_remove,
> -#ifdef CONFIG_X86
> - .class = I2C_CLASS_HWMON,
> - .detect = sis_ts_detect,
> - .address_list = normal_i2c,
> -#endif
> - .id_table = sis_ts_id,
> + .id_table = sis_ts_id,
> };
> +module_i2c_driver(sis_ts_driver);
>
> -static int __init sis_ts_init(void)
> -{
> - pr_info("sis_ts_init\n");
> - sis_wq = create_singlethread_workqueue("sis_wq");
> -
> - if (!sis_wq)
> - return -ENOMEM;
> - return i2c_add_driver(&sis_ts_driver);
> -}
> -
> -static void __exit sis_ts_exit(void)
> -{
> - pr_info("sis_ts_exit\n");
> - i2c_del_driver(&sis_ts_driver);
> - if (sis_wq)
> - destroy_workqueue(sis_wq);
> -}
> -
> -module_init(sis_ts_init);
> -module_exit(sis_ts_exit);
> MODULE_DESCRIPTION("SiS 9200 Family Touchscreen Driver");
> -MODULE_LICENSE("GPL");
> +MODULE_LICENSE("GPL v2");
> diff --git a/drivers/input/touchscreen/sis_i2c.h b/drivers/input/touchscreen/sis_i2c.h
> deleted file mode 100644
> index a075158..0000000
> --- a/drivers/input/touchscreen/sis_i2c.h
> +++ /dev/null
> @@ -1,164 +0,0 @@
> -/*
> - * Touch Screen driver for SiS 9200 family I2C Touch panels
> - *
> - * Copyright (C) 2015 SiS, Inc.
> - *
> - * This software is licensed under the terms of the GNU General Public
> - * License version 2, as published by the Free Software Foundation, and
> - * may be copied, distributed, and modified under those terms.
> - *
> - * 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.
> - *
> - * Date: 2015/07/07
> - */
> -#include <linux/version.h>
> -
> -#ifndef _LINUX_SIS_I2C_H
> -#define _LINUX_SIS_I2C_H
> -
> -
> -#define SIS_I2C_NAME "sis_i2c_ts"
> -#define SIS_SLAVE_ADDR 0x5c
> -/*10ms*/
> -#define TIMER_NS 10000000
> -#define MAX_FINGERS 10
> -
> -/* Check data CRC */
> -/*#define _CHECK_CRC*/ /*ON/OFF*/
> -
> -/* Interrupt modes */
> -#define GPIO_IRQ 54
> -
> -/* Enable if use interrupt case 1 mode. */
> -/* Disable if use interrupt case 2 mode. */
> -/*#define _INT_MODE_1*/ /*ON/OFF*/
> -
> -/* Resolution mode */
> -/*Constant value*/
> -#define SIS_MAX_X 4095
> -#define SIS_MAX_Y 4095
> -
> -#define ONE_BYTE 1
> -#define FIVE_BYTE 5
> -#define EIGHT_BYTE 8
> -#define SIXTEEN_BYTE 16
> -#define PACKET_BUFFER_SIZE 128
> -
> -#define SIS_CMD_NORMAL 0x0
> -#define SIS_CMD_SOFTRESET 0x82
> -#define SIS_CMD_RECALIBRATE 0x87
> -#define SIS_CMD_POWERMODE 0x90
> -#define MSK_TOUCHNUM 0x0f
> -#define MSK_HAS_CRC 0x10
> -#define MSK_DATAFMT 0xe0
> -#define MSK_PSTATE 0x0f
> -#define MSK_PID 0xf0
> -#define RES_FMT 0x00
> -#define FIX_FMT 0x40
> -
> -/* for new i2c format */
> -#define TOUCHDOWN 0x3
> -#define TOUCHUP 0x0
> -#define MAX_BYTE 64
> -#define PRESSURE_MAX 255
> -
> -/*Resolution diagonal */
> -#define AREA_LENGTH_LONGER 5792
> -/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/
> -#define AREA_LENGTH_SHORT 5792
> -#define AREA_UNIT (5792/32)
> -
> -
> -#define FORMAT_MODE 1
> -
> -#define MSK_NOBTN 0
> -#define MSK_COMP 1
> -#define MSK_BACK 2
> -#define MSK_MENU 4
> -#define MSK_HOME 8
> -
> -#define P_BYTECOUNT 0
> -#define ALL_IN_ONE_PACKAGE 0x10
> -#define IS_TOUCH(x) (x & 0x1)
> -#define IS_HIDI2C(x) ((x & 0xF) == 0x06)
> -#define IS_AREA(x) ((x >> 4) & 0x1)
> -#define IS_PRESSURE(x) ((x >> 5) & 0x1)
> -#define IS_SCANTIME(x) ((x >> 6) & 0x1)
> -#define NORMAL_LEN_PER_POINT 6
> -#define AREA_LEN_PER_POINT 2
> -#define PRESSURE_LEN_PER_POINT 1
> -
> -#define TOUCH_FORMAT 0x1
> -#define BUTTON_FORMAT 0x4
> -#define HIDI2C_FORMAT 0x6
> -#define P_REPORT_ID 2
> -#define BUTTON_STATE 3
> -#define BUTTON_KEY_COUNT 16
> -#define BYTE_BYTECOUNT 2
> -#define BYTE_COUNT 1
> -#define BYTE_ReportID 1
> -#define BYTE_CRC_HIDI2C 0
> -#define BYTE_CRC_I2C 2
> -#define BYTE_SCANTIME 2
> -#define NO_TOUCH_BYTECOUNT 0x3
> -
> -/* TODO */
> -#define TOUCH_POWER_PIN 0
> -#define TOUCH_RESET_PIN 1
> -
> -/* CMD Define */
> -#define BUF_ACK_PLACE_L 4
> -#define BUF_ACK_PLACE_H 5
> -#define BUF_ACK_L 0xEF
> -#define BUF_ACK_H 0xBE
> -#define BUF_NACK_L 0xAD
> -#define BUF_NACK_H 0xDE
> -#define BUF_CRC_PLACE 7
> -#define MAX_SLOTS 15
> -
> -struct sis_i2c_rmi_platform_data {
> - int (*power)(int on); /* Only valid in first array entry */
> -};
> -
> -struct TypeB_Slot {
> - int CheckID;
> - int id;
> - unsigned short x, y;
> - uint16_t Pressure;
> - uint16_t Width;
> - uint16_t Height;
> -};
> -
> -struct Point {
> - int id;
> - unsigned short x, y; /*uint16_t ?*/
> - uint16_t Pressure;
> - uint16_t Width;
> - uint16_t Height;
> -};
> -
> -struct sisTP_driver_data {
> - int id;
> - int fingers;
> - struct Point pt[MAX_FINGERS];
> -};
> -
> -struct sis_ts_data {
> - int (*power)(int on);
> - int use_irq;
> - struct i2c_client *client;
> - struct input_dev *input_dev;
> - struct hrtimer timer;
> - struct irq_desc *desc;
> - struct work_struct work;
> - struct mutex mutex_wq;
> - struct sisTP_driver_data *TPInfo;
> -};
> -
> -static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg);
> -static int sis_ts_resume(struct i2c_client *client);
> -
> -#endif /* _LINUX_SIS_I2C_H */
> --
> 1.9.1
>
--
Dmitry
^ permalink raw reply [flat|nested] 5+ messages in thread
end of thread, other threads:[~2015-10-06 0:40 UTC | newest]
Thread overview: 5+ messages (download: mbox.gz follow: Atom feed
-- links below jump to the message on this page --
2015-10-02 8:15 [PATCHv2] Add support for SiS i2c touch driver Yuger
2015-10-06 0:39 ` Dmitry Torokhov
-- strict thread matches above, loose matches on Subject: below --
2015-10-02 8:06 Yuger
2015-09-21 9:37 Yuger
2015-08-29 9:25 Yuger
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).