diff mbox

[PATCHv2] Add support for SiS i2c touch driver

Message ID 1443773715-31404-1-git-send-email-yuger_yu@sis.com (mailing list archive)
State New, archived
Headers show

Commit Message

Yuger Oct. 2, 2015, 8:15 a.m. UTC
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

Comments

Dmitry Torokhov Oct. 6, 2015, 12:39 a.m. UTC | #1
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
>
diff mbox

Patch

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 */