diff mbox series

Input: add new touchpad driver for Zinitix IC

Message ID 20201112204037.502fbae0@zinitix-H370AORUSGAMING3 (mailing list archive)
State New, archived
Headers show
Series Input: add new touchpad driver for Zinitix IC | expand

Commit Message

KwangDeok Son Nov. 12, 2020, 11:40 a.m. UTC
Add new touchpad driver for Zinitix IC
Supports five fingers multi-touch and firmware updates.
It communicates with the device via an I2C bus.

Signed-off-by : KwangDeok Son <kdson@zinitix.com>

Comments

Dmitry Torokhov Nov. 13, 2020, 2:07 a.m. UTC | #1
Hi KwangDeok,

On Thu, Nov 12, 2020 at 08:40:37PM +0900, KwangDeok Son wrote:
> Add new touchpad driver for Zinitix IC
> Supports five fingers multi-touch and firmware updates.
> It communicates with the device via an I2C bus.
> 
> Signed-off-by : KwangDeok Son <kdson@zinitix.com>

Please run the patch through ./scripts/checkpatch.pl and fix warnings
from the tool.

> @@ -0,0 +1,1524 @@
> +/*
> + * Zinitics I2C Touchpad driver
> + *
> + * Copyright (c) 2020 ZINITIX Co.,Ltd
> + *
> + * Author: KwangDeok Son <kdson@zinitix.com>
> + *
> + * Based on elan driver:
> + * Copyright (c) 2011-2013 ELAN Microelectronics Corp.
> + * copyright (c) 2011-2012 Cypress Semiconductor, Inc.
> + * copyright (c) 2011-2012 Google, Inc.
> + *
> + * This program is free software; you can redistribute it and/or modify it
> + * under the terms of the GNU General Public License version 2 as published
> + * by the Free Software Foundation.

Please drop GPL notice, use SPDX tag instead.

> + *
> + * Trademarks are the property of their respective owners.
> + */
> +
> +#include <linux/acpi.h>
> +#include <linux/device.h>
> +#include <linux/init.h>
> +#include <linux/module.h>
> +#include <linux/slab.h>
> +#include <linux/kernel.h>
> +#include <linux/sched.h>

Please double-check that all includes are actually needed.

> +#include <linux/input.h>
> +#include <linux/uaccess.h>
> +#include <linux/jiffies.h>
> +#include <linux/completion.h>
> +#include <linux/of.h>
> +#include <asm/unaligned.h>

asm includes should go after linux ones.

> +
> +#include <linux/delay.h>
> +#include <linux/firmware.h>
> +#include <linux/i2c.h>
> +#include <linux/input/mt.h>
> +#include <linux/interrupt.h>
> +#include <linux/irq.h>
> +#include <linux/regulator/consumer.h>
> +#include "zinitix_i2c.h"

We are not going to share any definitions with other modules, so put all
the constants in this file and drop the .h one.

> +int zinitix_i2c_write_reg(struct i2c_client *client, u16 reg, u16 value)
> +{
> +        int errno = 0;
> +        u8 buf[22] = {0x80, 0x01, 0x14, 0x00, 0x06, 0x00, };

Please add a #define for 22 constant.

> +
> +	buf[6] = reg & 0xFF;
> +	buf[7] = (reg>>8)&0xFF;
> +	buf[8] = value & 0xFF;;
> +	buf[9] = (value>>8)&0xFF;;
> +		

We have cpu_to_le16 and put_unaligned_le16 for this.

> +	errno = zinitix_i2c_write_buf(client, buf, 22);

sizeof(buf) instead of 22

> +
> +	return errno;
> +}
> +
> +int zinitix_i2c_write_data(struct i2c_client *client, u16 reg, 
> +                                const u8* value, u16 size)
> +{
> +        int errno = 0;
> +        u8 buf[22] = {0x80, 0x01, 0x14, 0x00, 0x06, 0x00, };
> +	buf[5] = size & 0xFF;
> +	buf[6] = reg & 0xFF;
> +	buf[7] = (reg>>8)&0xFF;
> +	memcpy(&buf[8], value, size);

Need to make sure we are not overwriting the buffer.

> +	errno = zinitix_i2c_write_buf(client, buf, 22);	
> +
> +	return errno;
> +}
> +
> +int zinitix_i2c_write_fwdata(struct i2c_client *client, u16 reg, 
> +                                const u8* value, u16 size)
> +{
> +        int errno = 0;
> +        u8 buf[22] = {0x80, 0x01, 0x14, 0x00, 0x06, 0x00, };
> +	buf[5] = size & 0xFF;
> +	
> +	memcpy(&buf[6], value, size);

Need to make sure we are not overwriting the buffer.

> +	
> +	errno = zinitix_i2c_write_buf(client, buf, 22);	
> +	
> +	return errno;
> +}
> +
> +u16 zinitix_i2c_read_reg(struct i2c_client *client, u16 reg, u16* value)
> +{
> +	u16 retval = 0;
> +	u8 outBuf[26] = {0x94, 0x1, 0x26, 0x3, 0x96, 0x1, 0x14, 0, 0x6, 0x1, };
> +	u8 inBuf[8] = {0, };
> +	
> +	//Sample

I prefer C-style comments.

> +	outBuf[10] = reg & 0xFF;
> +	outBuf[11] = (reg>>8)&0xFF;
> +	//Send
> +	retval = (u16)zinitix_i2c_write_buf(client, outBuf, 26);

Error handling?

> +	//Recv
> +	outBuf[2] = 0x16;
> +	outBuf[3] = 0x02;
> +	retval = (u16)zinitix_i2c_read_buf(client, outBuf,6, inBuf, 8);
> +	if (retval < 0) {

?? You are casing to u16 and then checking for negative value?

> +		dev_err(&client->dev, "reading cmd (0x%04x) fail.\n", reg);
> +		return retval;
> +	}
> +
> +	*value = (inBuf[6]&0xFF) | ((inBuf[7]<<8)&0xFF00);

le16_to_cpup(). Elsewhere too.

> +
> +static int get_descriptor(struct i2c_client *client, u8* val)
> +{
> +        struct touchpad_data *data = i2c_get_clientdata(client);
> +        int error;
> +        //Get HID Descriptor
> +        error = zinitix_i2c_read(client, ZINITIX_GET_DESC, 
> +                                val, ZINITIX_DESC_LENGTH);

Is this truly HID descriptor? Is device compatible with I2C HID
spec/Microsoft Precision point protocol? If so this driver is not needed
at all and we can use i2c-hid + hid-multitouch to handle the device.

> +
> +const struct zinitix_transport_ops zinitix_i2c_ops = {
> +	.initialize		= zinitix_i2c_initialize,
> +	.sleep_control		= zinitix_sleep_control,
> +	.reset		        = zinitix_reset,
> +	.get_max		= zinitix_i2c_get_max,
> +	.get_num_channel        = zinitix_i2c_get_num_channel,
> +	.prepare_fw_update	= zinitix_i2c_prepare_fw_update,
> +	.write_fw_block		= zinitix_i2c_write_fw_block,
> +	.read_fw_block		= zinitix_i2c_read_fw_block,
> +	.finish_fw_update	= zinitix_i2c_finish_fw_update,
> +	.get_report		= zinitix_i2c_get_report,
> +};

Are you planning on adding additional transports (such as SMB)? If not,
then this indirection is not needed.

Thanks.
diff mbox series

Patch

diff --git a/drivers/input/mouse/Kconfig b/drivers/input/mouse/Kconfig
index d8b6a5dab190..effd1b019b02 100644
--- a/drivers/input/mouse/Kconfig
+++ b/drivers/input/mouse/Kconfig
@@ -457,4 +457,15 @@  config MOUSE_NAVPOINT_PXA27x
 	  To compile this driver as a module, choose M here: the
 	  module will be called navpoint.
 
+config MOUSE_ZINITIX_I2C
+	tristate "ZINITIX I2C Touchpad support"
+	depends on I2C
+	help
+	  This driver adds support for Zinitix I2C Touchpad.
+
+	  Say Y here if you have a Zinitix I2C Touchpad.
+
+	  To compile this driver as a module, choose M here: the module will be
+	  called zinitix_i2c.
+
 endif
diff --git a/drivers/input/mouse/Makefile b/drivers/input/mouse/Makefile
index e49f08565076..b0329e21a079 100644
--- a/drivers/input/mouse/Makefile
+++ b/drivers/input/mouse/Makefile
@@ -24,6 +24,7 @@  obj-$(CONFIG_MOUSE_SERIAL)		+= sermouse.o
 obj-$(CONFIG_MOUSE_SYNAPTICS_I2C)	+= synaptics_i2c.o
 obj-$(CONFIG_MOUSE_SYNAPTICS_USB)	+= synaptics_usb.o
 obj-$(CONFIG_MOUSE_VSXXXAA)		+= vsxxxaa.o
+obj-$(CONFIG_MOUSE_ZINITIX)		+= zinitix_i2c.o
 
 cyapatp-objs := cyapa.o cyapa_gen3.o cyapa_gen5.o cyapa_gen6.o
 psmouse-objs := psmouse-base.o synaptics.o focaltech.o
diff --git a/drivers/input/mouse/zinitix_i2c.c b/drivers/input/mouse/zinitix_i2c.c
index e69de29bb2d1..33cd28ca1ee7 100755
--- a/drivers/input/mouse/zinitix_i2c.c
+++ b/drivers/input/mouse/zinitix_i2c.c
@@ -0,0 +1,1524 @@ 
+/*
+ * Zinitics I2C Touchpad driver
+ *
+ * Copyright (c) 2020 ZINITIX Co.,Ltd
+ *
+ * Author: KwangDeok Son <kdson@zinitix.com>
+ *
+ * Based on elan driver:
+ * Copyright (c) 2011-2013 ELAN Microelectronics Corp.
+ * copyright (c) 2011-2012 Cypress Semiconductor, Inc.
+ * copyright (c) 2011-2012 Google, Inc.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License version 2 as published
+ * by the Free Software Foundation.
+ *
+ * Trademarks are the property of their respective owners.
+ */
+
+#include <linux/acpi.h>
+#include <linux/device.h>
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/kernel.h>
+#include <linux/sched.h>
+#include <linux/input.h>
+#include <linux/uaccess.h>
+#include <linux/jiffies.h>
+#include <linux/completion.h>
+#include <linux/of.h>
+#include <asm/unaligned.h>
+
+#include <linux/delay.h>
+#include <linux/firmware.h>
+#include <linux/i2c.h>
+#include <linux/input/mt.h>
+#include <linux/interrupt.h>
+#include <linux/irq.h>
+#include <linux/regulator/consumer.h>
+#include "zinitix_i2c.h"
+
+static int zinitix_i2c_read(struct i2c_client *client, u16 reg, 
+                                u8 *val, u16 len)
+{
+	__le16 buf[] = {
+		cpu_to_le16(reg),
+	};
+	struct i2c_msg msgs[] = {
+		{
+			.addr = client->addr,
+			.flags = client->flags & I2C_M_TEN,
+			.len = sizeof(buf),
+			.buf = (u8 *)buf,
+		},
+		{
+			.addr = client->addr,
+			.flags = (client->flags & I2C_M_TEN) | I2C_M_RD,
+			.len = len,
+			.buf = val,
+		}
+	};
+	int ret;
+	ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
+
+	return ret == ARRAY_SIZE(msgs) ? 0 : (ret < 0 ? ret : -EIO);
+}
+
+static int zinitix_i2c_write(struct i2c_client *client, u16 reg, u16 cmd)
+{
+	__le16 buf[] = {
+		cpu_to_le16(reg),
+		cpu_to_le16(cmd),
+	};
+	struct i2c_msg msg = {
+		.addr = client->addr,
+		.flags = client->flags & I2C_M_TEN,
+		.len = sizeof(buf),
+		.buf = (u8 *)buf,
+	};
+	int ret;
+
+	ret = i2c_transfer(client->adapter, &msg, 1);
+	if (ret != 1) {
+		if (ret >= 0)
+			ret = -EIO;
+		dev_err(&client->dev, "writing cmd (0x%04x) failed: %d\n", 
+                        reg, ret);
+		return ret;
+	}
+
+	return 0;
+}
+
+static int zinitix_i2c_read_buf(struct i2c_client *client, u8* buf, 
+				u16 bufsize, u8 *val, u16 len)
+{
+	struct i2c_msg msgs[] = {
+		{
+			.addr = client->addr,
+			.flags = client->flags & I2C_M_TEN,
+			.len = bufsize,
+			.buf = buf,
+		},
+		{
+			.addr = client->addr,
+			.flags = (client->flags & I2C_M_TEN) | I2C_M_RD,
+			.len = len,
+			.buf = val,
+		}
+	};
+	int ret;
+	ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
+
+	return ret == ARRAY_SIZE(msgs) ? 0 : (ret < 0 ? ret : -EIO);
+}
+
+static int zinitix_i2c_write_buf(struct i2c_client *client, u8* buf, 
+                                u8 bufsize)
+{
+	struct i2c_msg msg = {
+		.addr = client->addr,
+		.flags = client->flags & I2C_M_TEN,
+		.len = bufsize,
+		.buf = buf,
+	};
+	int ret;
+
+	ret = i2c_transfer(client->adapter, &msg, 1);
+	if (ret != 1) {
+		if (ret >= 0)
+			ret = -EIO;
+		dev_err(&client->dev, "writing cmd (%s) failed: %d\n",
+			buf, ret);
+		return ret;
+	}
+
+	return 0;
+}
+
+int zinitix_i2c_write_reg(struct i2c_client *client, u16 reg, u16 value)
+{
+        int errno = 0;
+        u8 buf[22] = {0x80, 0x01, 0x14, 0x00, 0x06, 0x00, };
+
+	buf[6] = reg & 0xFF;
+	buf[7] = (reg>>8)&0xFF;
+	buf[8] = value & 0xFF;;
+	buf[9] = (value>>8)&0xFF;;
+		
+	errno = zinitix_i2c_write_buf(client, buf, 22);
+
+	return errno;
+}
+
+int zinitix_i2c_write_data(struct i2c_client *client, u16 reg, 
+                                const u8* value, u16 size)
+{
+        int errno = 0;
+        u8 buf[22] = {0x80, 0x01, 0x14, 0x00, 0x06, 0x00, };
+	buf[5] = size & 0xFF;
+	buf[6] = reg & 0xFF;
+	buf[7] = (reg>>8)&0xFF;
+	memcpy(&buf[8], value, size);
+		
+	errno = zinitix_i2c_write_buf(client, buf, 22);	
+
+	return errno;
+}
+
+int zinitix_i2c_write_fwdata(struct i2c_client *client, u16 reg, 
+                                const u8* value, u16 size)
+{
+        int errno = 0;
+        u8 buf[22] = {0x80, 0x01, 0x14, 0x00, 0x06, 0x00, };
+	buf[5] = size & 0xFF;
+	
+	memcpy(&buf[6], value, size);
+	
+	errno = zinitix_i2c_write_buf(client, buf, 22);	
+	
+	return errno;
+}
+
+u16 zinitix_i2c_read_reg(struct i2c_client *client, u16 reg, u16* value)
+{
+	u16 retval = 0;
+	u8 outBuf[26] = {0x94, 0x1, 0x26, 0x3, 0x96, 0x1, 0x14, 0, 0x6, 0x1, };
+	u8 inBuf[8] = {0, };
+	
+	//Sample
+	outBuf[10] = reg & 0xFF;
+	outBuf[11] = (reg>>8)&0xFF;
+	//Send
+	retval = (u16)zinitix_i2c_write_buf(client, outBuf, 26);
+	//Recv
+	outBuf[2] = 0x16;
+	outBuf[3] = 0x02;
+	retval = (u16)zinitix_i2c_read_buf(client, outBuf,6, inBuf, 8);
+	if (retval < 0) {
+		dev_err(&client->dev, "reading cmd (0x%04x) fail.\n", reg);
+		return retval;
+	}
+
+	*value = (inBuf[6]&0xFF) | ((inBuf[7]<<8)&0xFF00);
+
+        return retval;
+}
+
+u16 zinitix_i2c_read_data(struct i2c_client *client, u16 reg, u8* verify_data)
+{
+	u16 retval = 0;
+	u8 outBuf[26] = {0x94, 0x1, 0x26, 0x3, 0x96, 0x1, 0x14, 0, 0x6, 0x1, };
+	u8 inBuf[20] = {0, };
+	
+	//Sample
+	outBuf[10] = reg & 0xFF;
+	outBuf[11] = (reg>>8)&0xFF;
+	//Send
+	retval = (u16)zinitix_i2c_write_buf(client, outBuf, 26);
+	//Recv
+	outBuf[2] = 0x16;
+	outBuf[3] = 0x02;
+	retval = (u16)zinitix_i2c_read_buf(client, outBuf,6, inBuf, 20);
+	if (retval < 0) {
+		dev_err(&client->dev, "reading cmd (0x%04x) fail.\n", reg);
+		return retval;
+	}
+
+	memcpy(verify_data, &inBuf[4], SECTOR_SZ);
+	
+        return retval;
+}
+
+static int zinitix_sleep_control(struct i2c_client *client, u16 mode)
+{
+	int error;
+
+		error = zinitix_i2c_write(client, ZINITIX_STANDARD_CMD, mode);
+		if (error)
+			dev_err(&client->dev, "device wake up failed: %d\n", 
+                                                                        error);
+                else
+        		msleep(100); /* Wait for the device to control */
+        
+	return error;
+}
+
+static int zinitix_reset(struct i2c_client *client)
+{
+        int error;
+        u8 val[12];
+
+        error = zinitix_i2c_write(client, ZINITIX_STANDARD_CMD, ZINITIX_RESET);
+		if (error)
+			dev_err(&client->dev, "device reset failed: %d\n", 
+                                                                        error);
+        else{
+                msleep(100);    /* Wait for the device to reset */
+
+                /* get reset acknowledgement 0000 */
+                error = i2c_master_recv(client, val, 12);
+                if (error < 0) {
+                        dev_err(&client->dev, 
+                                "failed read reset response: %d\n", error);
+                        return -EIO;
+                }
+        }
+
+        return 0;
+}
+
+static int get_descriptor(struct i2c_client *client, u8* val)
+{
+        struct touchpad_data *data = i2c_get_clientdata(client);
+        int error;
+        //Get HID Descriptor
+        error = zinitix_i2c_read(client, ZINITIX_GET_DESC, 
+                                val, ZINITIX_DESC_LENGTH);
+	if (error)
+		dev_err(&client->dev, "can't get descriptor: %d\n", error);
+        else
+        	data->chip_code = (u16)(val[16] + (val[17]<<8));
+
+        return error;
+}
+
+static int get_report_descriptor(struct i2c_client *client)
+{
+        int error = 0;
+        u8 val[ZINITIX_REPORT_DESC_LENGTH] = {0,};
+        struct touchpad_data *data = i2c_get_clientdata(client);
+        
+        //Get HID Report Descriptor
+	error = zinitix_i2c_read(client, ZINITIX_GET_REPORT_DESC, 
+                                val, sizeof(val));
+
+        //Get infomation to parse desc
+        data->phy_x = *((u16*)&val[ZINITIX_PHY_X_OFFSET]);
+        data->phy_y = *((u16*)&val[ZINITIX_PHY_Y_OFFSET]);
+        return error;
+	
+}
+
+static int set_report(struct i2c_client *client, u8 mode, u8 data)
+{
+        int error;
+        u8 buf[10] = {0x94, 0x01, 0x34, 0x03, 0x96, 0x01, 0x04, 0x00,};	
+        
+        buf[2] = 0x30 | (mode & 0x0F);
+        buf[8] = mode;
+        buf[9] = data;
+        
+        error = zinitix_i2c_write_buf(client, buf, 10);
+        
+        if (error)
+		dev_err(&client->dev, "set report desc fail: %d\n", error);
+
+        return error;
+}
+
+static int get_mode(struct i2c_client *client, int* data)
+{
+        int error;
+        u8 val[4];
+        u8 buf[6] = {0x94, 0x01, 0x32, 0x04, 0x96, 0x01 };
+        error = zinitix_i2c_read_buf(client, buf,6, val, 4);
+        if(error)
+                dev_err(&client->dev, "### Get Mode : %d", (int)val[3]);
+        else 
+                *data = val[3];
+        return error;
+}
+
+static int zinitix_i2c_initialize(struct i2c_client *client)
+{
+	int error, mode;
+	u8 val[512];
+	
+	//Sleep
+	error = zinitix_sleep_control(client, ZINITIX_SLEEP);
+	if (error) 
+		return error;
+	//Get HID Descriptor
+        error = get_descriptor(client, val);
+	if (error) 
+		return error;
+	//HID_CMD_WAKEUP
+        error = zinitix_sleep_control(client, ZINITIX_WAKE_UP);
+	if (error) 
+		return error;
+	//HID_CMD_RESET
+	error = zinitix_reset(client);
+	if (error)
+		return error;
+        //Get HID Report Descriptor
+        error = get_report_descriptor(client);
+        if (error) 
+		return error;
+	//Get Mode
+	error = get_mode(client, &mode);
+        if (error) 
+		return error;
+	//CMD
+        error = set_report(client, REPORT_SWITCH, SWITCH_BOTH);
+        if (error) 
+		return error;
+        error = set_report(client, REPORT_INPUT, INPUT_PTP);
+        if (error) 
+		return error;
+	error = set_report(client, REPORT_LATENCY, LATENCY_NORMAL);
+        if (error) 
+		return error;
+	return 0;
+}
+
+static int zinitix_i2c_get_max(struct i2c_client *client,
+			    unsigned int *max_x, unsigned int *max_y)
+{
+	int error;
+
+	error = zinitix_i2c_read_reg(client, ZINITIX_MAX_X_REG, (u16*)max_x);
+	if (error) {
+		dev_err(&client->dev, "failed to get X dimension: %d\n", error);
+		return error;
+	}
+
+	error = zinitix_i2c_read_reg(client, ZINITIX_MAX_Y_REG, (u16*)max_y);
+	if (error) {
+		dev_err(&client->dev, "failed to get Y dimension: %d\n", error);
+		return error;
+	}
+
+	return 0;
+}
+
+static int zinitix_i2c_get_num_channel(struct i2c_client *client,
+				   unsigned short *chennel_x,
+				   unsigned short *chennel_y)
+{
+	int error;
+
+        error = zinitix_i2c_read_reg(client, ZINITIX_CH_X_REG, chennel_x);
+        if (error) {
+		dev_err(&client->dev, "failed to get CH X: %d\n", error);
+		return error;
+	}
+
+        error = zinitix_i2c_read_reg(client, ZINITIX_CH_Y_REG, chennel_y);
+	if (error) {
+		dev_err(&client->dev, "failed to get CH Y: %d\n", error);
+		return error;
+	}
+
+	return 0;
+}
+
+static int zinitix_i2c_prepare_fw_update(struct i2c_client *client)
+{
+	u16 u16_lsb, u16_msb;
+	u16 Bootloader_ver;
+	u16 ver_major, ver_minor, ver_rel;
+        u32 info_checksum;
+	u32 core_checksum;
+	int error = 0;
+
+	error = zinitix_i2c_read_reg(client, REG_FWVERSION_MAJOR, &ver_major);
+	error = zinitix_i2c_read_reg(client, REG_FWVERSION_MINOR, &ver_minor);
+	error = zinitix_i2c_read_reg(client, REG_FWVERSION_RELEASE, &ver_rel);
+
+	//get Checksum
+	error = zinitix_i2c_read_reg(client, 0x00E4, &u16_lsb);
+	error = zinitix_i2c_read_reg(client, 0x00E5, &u16_msb);
+	info_checksum = (u16_msb<<16) | u16_lsb;
+	
+	error = zinitix_i2c_read_reg(client, 0x00E6, &u16_lsb);
+	error = zinitix_i2c_read_reg(client, 0x00E7, &u16_msb);
+	core_checksum = (u16_msb<<16) | u16_lsb;
+
+	error = zinitix_i2c_write_reg(client, FWUPGRADE_MODE, 0x0001);
+	error = zinitix_i2c_read_reg(client, REG_FWVERSION_RELEASE, 
+                                        &Bootloader_ver);
+
+	error = zinitix_i2c_write_reg(client, FWUPGRADE_MODE, 0x0002);
+	error = zinitix_i2c_read_reg(client, REG_FWVERSION_RELEASE, 
+                                        &Bootloader_ver);
+
+	//init download
+	zinitix_i2c_write_reg(client, VENDOR_CMD_ENABLE, 0x0001);
+	msleep(10);
+	
+	zinitix_i2c_write_reg(client, INIT_NVM, 0x0001);
+	msleep(10);
+	
+	zinitix_i2c_write_reg(client, DISABLE_NVM_WP, 0x0001);
+	msleep(10);
+	
+	zinitix_i2c_write_reg(client, FWUPGRADE_INIT, 0x0000);
+	
+	return 0;
+}
+
+static int zinitix_i2c_read_fw_block(struct i2c_client *client,
+				   u8 *page, int idx)
+{
+	struct device *dev = &client->dev;
+	int ret, error;
+
+	ret = zinitix_i2c_read_data(client, FWUPGRADE_READ, page);
+	if (ret != 0) {
+		dev_err(dev, "Failed to read page %d: %d\n", idx, error);
+		return error;
+	}
+
+	return 0;
+}
+
+static int zinitix_i2c_write_fw_block(struct i2c_client *client,
+				   const u8 *page, u16 checksum, int idx)
+{
+	struct device *dev = &client->dev;
+	int ret, error;
+
+	ret = zinitix_i2c_write_fwdata(client, FWUPGRADE_PGM, page, 
+                                        checksum);
+	if (ret != 0) {
+		dev_err(dev, "Failed to write page %d: %d\n", idx, error);
+		return error;
+	}
+
+	return 0;
+}
+
+static int zinitix_i2c_finish_fw_update(struct i2c_client *client,
+				     struct completion *completion)
+{
+	struct device *dev = &client->dev;
+	int error;
+	u16 ver_major, ver_minor, ver_rel;
+	u16 retry_cnt = 100;
+	u16 checksum = 0, temp = 0, value = 0;
+
+	enable_irq(client->irq);
+
+	error = zinitix_i2c_write_reg(client, HW_RESET, 0);
+	if (error) {
+		dev_err(dev, "device reset failed: %d\n", error);
+	}
+	
+	msleep(1500);
+	
+	disable_irq(client->irq);
+
+	if (error){
+		dev_err(dev, "zinitix_i2c_finish_fw_update Fail :%d", error);
+		return error;
+	}
+		
+	//Touchpad Mode Enter
+	error = zinitix_i2c_read_reg(client, 0x10, &value);
+	if (error) {
+		dev_err(dev, "zinitix_i2c_read_reg reg: 0x10 err: %d\n", error);
+		return error;
+	}
+	msleep(10);
+
+	error = zinitix_i2c_read_reg(client, REG_FWVERSION_MAJOR, &ver_major);
+	error = zinitix_i2c_read_reg(client, REG_FWVERSION_MINOR, &ver_minor);
+	error = zinitix_i2c_read_reg(client, REG_FWVERSION_RELEASE, &ver_rel);
+	error = zinitix_i2c_read_reg(client, REG_FWCHECKSUM, &checksum);
+	error = zinitix_i2c_write_reg(client, 0x00F0, 0x2000);
+	error = zinitix_i2c_write_reg(client, 0x00F0, 0x2000);
+	if (error) {
+		dev_err(dev, "write[0x00F0][0x2000] err: %d\n", error);
+		return error;
+	}
+
+	while(retry_cnt-- > 0)
+	{
+		error = zinitix_i2c_write_reg(client, 0x00F0, 0x2000); 
+		if (error) {
+			dev_err(dev, "write[0x00F0],[0x2000] err: %d\n", error);
+			return error;
+		}
+		error = zinitix_i2c_read_reg(client, 0x00F0, &temp);
+		if (error) {
+			dev_err(dev, "read[0x00F0] err: %d\n", error);
+			return error;
+		}
+		if(temp == 0x2000)
+			break;
+	}
+
+	zinitix_i2c_write_reg(client, 0x13F0, 0x0001);
+
+	if(retry_cnt > 0)
+	{
+		const u8 DataBuf[2] = {0xDA, 0xCA};
+		zinitix_i2c_write_data(client, 0x0006, DataBuf, 0x0002);
+		msleep(50);
+		retry_cnt = 100;
+		while(retry_cnt-- > 0)
+		{
+			error = zinitix_i2c_read_reg(client, 0x0018, &temp);
+			if (error) {
+				dev_err(dev, "read 0x0018, err: %d\n", error);
+				return error;
+			}
+			if(temp == 0xFFFE)
+				break;
+			msleep(10);
+		}
+
+		if(retry_cnt > 0)
+		{
+                        //save_cal_data
+			zinitix_i2c_write_reg(client, 0x0008, 0x0000);
+			msleep(500);
+                        //Interrupt Enable
+			zinitix_i2c_write_reg(client, 0x00F0, 0x880F);	
+			zinitix_i2c_write_reg(client, 0x00F0, 0x880F);	
+
+			retry_cnt = 100;
+			while(retry_cnt-- > 0)
+			{
+				zinitix_i2c_write_reg(client, 0x00F0, 0x880F); 
+				zinitix_i2c_read_reg(client, 0x00F0, &temp);
+				if(temp == 0x880F)
+					break;			
+			}
+
+			if(retry_cnt > 0)
+			{
+				zinitix_i2c_read_reg(client, 0x0018, &temp);
+				dev_err(dev, "HW_calibration done(0x%X)\n", temp);
+			}
+		}
+	}
+
+	zinitix_i2c_write_reg(client, 0x13F0, 0x0000);	//NVM Write Disable
+	
+	return 0;
+}
+
+static int zinitix_i2c_get_report(struct i2c_client *client, u8 *report)
+{
+	int len;
+	len = i2c_master_recv(client, report, ZINITIX_I2C_REPORT_LEN);
+	if (len < 0) {
+		dev_err(&client->dev, "failed to read report data: %d\n", len);
+		return len;
+	}
+
+	if (len != ZINITIX_I2C_REPORT_LEN) {
+		dev_err(&client->dev,
+			"wrong report length (%d vs %d expected)\n",
+			len, ZINITIX_I2C_REPORT_LEN);
+		return -EIO;
+	}
+	
+	return 0;
+}
+
+const struct zinitix_transport_ops zinitix_i2c_ops = {
+	.initialize		= zinitix_i2c_initialize,
+	.sleep_control		= zinitix_sleep_control,
+	.reset		        = zinitix_reset,
+	.get_max		= zinitix_i2c_get_max,
+	.get_num_channel        = zinitix_i2c_get_num_channel,
+	.prepare_fw_update	= zinitix_i2c_prepare_fw_update,
+	.write_fw_block		= zinitix_i2c_write_fw_block,
+	.read_fw_block		= zinitix_i2c_read_fw_block,
+	.finish_fw_update	= zinitix_i2c_finish_fw_update,
+	.get_report		= zinitix_i2c_get_report,
+};
+
+static int zinitix_enable_power(struct touchpad_data *data)
+{
+	int repeat = ZINITIX_RETRY_COUNT;
+	int error = regulator_enable(data->vcc);
+
+	if (error) {
+		dev_err(&data->client->dev,
+			"failed to enable regulator: %d\n", error);
+		return error;
+	}
+
+	do {
+		error = data->ops->sleep_control(data->client, true);
+		if (error >= 0)
+			return 0;
+
+		msleep(30);
+	} while (--repeat > 0);
+
+	dev_err(&data->client->dev, "failed to enable power: %d\n", error);
+	return error;
+}
+
+static int zinitix_disable_power(struct touchpad_data *data)
+{
+	int repeat = ZINITIX_RETRY_COUNT;
+	int error = 0;
+
+	do {
+		error = data->ops->sleep_control(data->client, false);
+		if (!error) {
+			error = regulator_disable(data->vcc);
+			if (error) {
+				dev_err(&data->client->dev,
+					"failed to disable regulator: %d\n",
+					error);
+				/* Attempt to power the chip back up */
+				data->ops->sleep_control(data->client, true);
+				break;
+			}
+
+			return 0;
+		}
+
+		msleep(30);
+	} while (--repeat > 0);
+
+	dev_err(&data->client->dev, "failed to disable power: %d\n", error);
+	return error;
+}
+
+static int zinitix_sleep(struct touchpad_data *data)
+{
+	int repeat = ZINITIX_RETRY_COUNT;
+	int error;
+	do {
+		error = data->ops->sleep_control(data->client, true);
+		if (!error)
+			return 0;
+
+		msleep(30);
+	} while (--repeat > 0);
+
+	return error;
+}
+
+static int zinitix_initialize(struct touchpad_data *data)
+{
+        struct i2c_client *client = data->client;
+	int repeat = ZINITIX_RETRY_COUNT;
+	int error;
+	do {
+                error = data->ops->initialize(client);
+		if (!error)
+			return 0;
+
+		dev_err(&client->dev, "device initialize failed: %d\n", error);
+		msleep(30);
+	} while (--repeat > 0);
+
+	return error;
+}
+
+static unsigned int zinitix_get_resolution(u16 val)
+{
+        return (val * 10 + 300) * 10 / 254;
+}
+
+static int zinitix_query_device_parameters(struct touchpad_data *data)
+{
+	unsigned short ch_x, ch_y;
+	int error;
+
+	error = data->ops->get_max(data->client, &data->max_x, &data->max_y);
+	if (error)
+		return error;
+	
+	error = data->ops->get_num_channel(data->client, &ch_x, &ch_y);
+	if (error)
+		return error;
+	
+	data->width_x = data->max_x / ch_x;
+	data->width_y = data->max_y / ch_y;
+
+	data->x_res = zinitix_get_resolution(data->max_x / data->phy_x);
+	data->y_res = zinitix_get_resolution(data->max_y / data->phy_y);
+
+	//pressure level
+	data->pressure_adjustment = 0x0011;
+	return 0;
+}
+
+/*
+ **********************************************************
+ * firmware update
+ **********************************************************
+ */
+static int zinitix_read_fw_block(struct touchpad_data *data, 
+					u8 *page, int idx)
+{
+	int error;
+	int retry = ZINITIX_RETRY_COUNT;
+	do {
+		error = data->ops->read_fw_block(data->client, page, idx);
+		if (!error)
+                        return 0;
+
+		dev_dbg(&data->client->dev,
+			"retrying read page %d (error: %d)\n", idx, error);	
+		
+	} while (--retry > 0);
+
+	return error;
+}
+
+static int zinitix_write_fw_block(struct touchpad_data *data,
+			       const u8 *page, u16 checksum, int idx)
+{
+	int error;
+        int retry = ZINITIX_RETRY_COUNT;
+
+	do {
+		error = data->ops->write_fw_block(data->client, page, 
+                                                        checksum, idx);
+		if (!error)
+			return 0;	
+
+		dev_dbg(&data->client->dev,
+		"retrying write page %d (error: %d)\n", idx, error);
+	} while (--retry > 0);
+
+	return error;
+}
+
+static int get_fw_sizeinfo(const struct firmware *fw, struct fw_info* info)
+{
+	union nvm_binary_info *bin_info = (union nvm_binary_info *)&fw->data[0];
+
+	info->info_size = (u32)TO_LITTLE_ENDIAN(bin_info->val.info_size[1],
+						bin_info->val.info_size[2],
+						bin_info->val.info_size[3]);
+	info->core_size = (u32)TO_LITTLE_ENDIAN(bin_info->val.core_size[1],
+						bin_info->val.core_size[2],
+						bin_info->val.core_size[3]);
+	info->cust_size = (u32)TO_LITTLE_ENDIAN(bin_info->val.custom_size[1],
+						bin_info->val.custom_size[2],
+						bin_info->val.custom_size[3]);
+	info->regi_size = (u32)TO_LITTLE_ENDIAN(bin_info->val.register_size[1],
+						bin_info->val.register_size[2],
+						bin_info->val.register_size[3]);
+
+	info->end_address = info->info_size + info->core_size + 
+                                        info->cust_size + info->regi_size;
+	info->start_address = info->info_size + info->core_size;
+	return 0;
+}
+
+static int zinitix_flash_erase(struct i2c_client *client, int flash_addr)
+{
+	u8 data[4] = {0x00, 0x00, 0x00, 0x00};
+	int i = 0;
+
+	for(i=flash_addr; i<32; i++)
+	{
+		data[2] = i;
+		zinitix_i2c_write_data(client, FWUPGRADE_BLOCK_ERASE, data, 4);
+		msleep(60);
+	}
+
+	data[0] = 1;
+	for(i=1; i<4; i++)
+	{
+		data[2] = i;
+		zinitix_i2c_write_data(client, FWUPGRADE_BLOCK_ERASE, data, 4);
+		msleep(60);
+	}
+	
+	return 0;
+}
+
+static int __zinitix_update_firmware(struct touchpad_data *data,
+				  const struct firmware *fw)
+{
+	struct i2c_client *client = data->client;
+	struct device *dev = &client->dev;
+	int i, error, page_size;
+	int fw_addr;
+	struct fw_info flash;
+
+	page_size  = 1024; 
+	error = data->ops->prepare_fw_update(client);
+	if (error)
+        {
+                dev_err(dev, "prepare fw upadate err:%d\n", error);
+                return error;
+        }
+		
+	//get firmware info
+	get_fw_sizeinfo(fw, &flash);
+	zinitix_flash_erase(client, flash.start_address);
+        
+	//write firmware
+	fw_addr = (flash.info_size + flash.core_size) / 1024;
+
+	zinitix_i2c_write_reg(client, FWUPGRADE_INIT, 0x0000);
+	zinitix_i2c_write_reg(client, FWUPGRADE_START_PAGE, fw_addr);
+	for (fw_addr = flash.start_address; fw_addr < flash.end_address; ) 
+	{	
+		for(i = 0; i < page_size / SECTOR_SZ; i++)
+		{	
+			error = zinitix_write_fw_block(data, &fw->data[fw_addr],
+                                                         SECTOR_SZ, i);
+			if (error) {
+				dev_err(dev, "fw write %d err:%d\n", i, error);
+				return error;
+			}
+			
+			fw_addr += SECTOR_SZ;
+		}
+		msleep(20);
+	}
+
+	fw_addr = (flash.info_size + flash.core_size) / 1024;
+	zinitix_i2c_write_reg(client, FWUPGRADE_INIT, 0x0000); 
+	zinitix_i2c_write_reg(client, FWUPGRADE_START_PAGE, fw_addr); 
+	msleep(10);
+	
+	//verify
+        fw_addr = flash.start_address;
+        for(; fw_addr < flash.end_address; )
+        {
+                u8 verify[16] = {0,};
+                for(i = 0; i < page_size / SECTOR_SZ; i++)
+                {
+                        zinitix_read_fw_block(data, verify, i);
+                        if (error)
+                        {
+                                dev_err(dev, "err verify read : %d\n", error);
+                                return error;                
+                        }
+
+                        if(memcmp(&fw->data[fw_addr], verify, SECTOR_SZ))
+                        {
+                                dev_err(dev, "err verify cmp : %d\n", error);
+                                return error;                
+                        }
+
+                        fw_addr += SECTOR_SZ;
+                }
+        }//verify success
+	
+        //complete fw update
+        error = data->ops->finish_fw_update(client, &data->fw_completion);
+        if (error)
+        {
+                dev_err(dev, "err finish_fw_update: %d\n", error);
+                return error;
+        }
+
+	return 0;
+}
+
+static int zinitix_update_firmware(struct touchpad_data *data,
+				const struct firmware *fw)
+{
+	int retval = 0;
+	struct i2c_client *client = data->client;
+
+	disable_irq(client->irq);
+	data->in_fw_update = true;
+	zinitix_i2c_write_reg(client, 0xff, 0x01);
+	retval = __zinitix_update_firmware(data, fw);
+	if (retval) {
+		dev_err(&client->dev, "fw update failed: %d\n", retval);
+		data->ops->reset(client);
+	} else {
+		/* Reinitialize TP after fw is updated */
+		zinitix_initialize(data);
+		dev_err(&client->dev, "fw update Success!!!: %d\n", retval);
+	}
+
+	data->in_fw_update = false;
+	enable_irq(client->irq);
+
+	return retval;
+}
+
+//probe or init
+static int zinitix_check_update_firmware(struct device *dev)
+{
+	int retval = 0;
+	int error = 0;
+	char *fw_name;
+	union nvm_binary_info *fw_info;
+	const struct firmware *fw;
+	u16 fw_ver = 0;
+	u16 dev_ver = 0;
+	
+	struct i2c_client *client = to_i2c_client(dev);
+
+	fw_name = kasprintf(GFP_KERNEL, ZINITIX_FW_NAME);
+	if (!fw_name) {
+		dev_err(dev, "failed to allocate memory for firmware name\n");
+		return -ENOMEM;
+	}
+
+	
+	//1. Check FW Bin file
+	error = request_firmware(&fw, fw_name, dev);	//linux Kernel API
+	kfree(fw_name);
+	if (error) {
+		dev_err(dev, "failed to request firmware: %d\n", error);
+		return error;
+	}
+
+	//2. Check FW version
+	fw_info = (union nvm_binary_info*)&fw[0];
+	fw_ver = fw_info->val.minor_ver;
+	error = zinitix_i2c_read_reg(client, REG_FWVERSION_MINOR, &dev_ver);	
+	
+	if(dev_ver <= fw_ver){ //3. Current Version < New Version
+		dev_info(dev, "check FW[0x%X : 0x%X] boot!\n", fw_ver, dev_ver);
+	}else{
+		dev_info(dev, "checked No Firmware in boot Sequence T_T\n");
+	}
+
+	release_firmware(fw);
+	return retval;
+}
+
+/*
+ *********
+ * SYSFS
+ */
+static ssize_t zinitix_sysfs_update_fw(struct device *dev,
+				    struct device_attribute *attr,
+				    const char *buf, size_t count)
+{
+	struct touchpad_data *data = dev_get_drvdata(dev);
+	const struct firmware *fw;
+	char *fw_name;
+	int error;
+	
+	fw_name = kasprintf(GFP_KERNEL, ZINITIX_FW_NAME);
+	if (!fw_name) {
+		dev_err(dev, "failed to allocate memory for firmware name\n");
+		return -ENOMEM;
+	}
+
+	error = request_firmware(&fw, fw_name, dev);	//linux Kernel API
+	kfree(fw_name);
+	if (error) {
+		dev_err(dev, "failed to request firmware: %d\n", error);
+		return error;
+	}
+
+	error = mutex_lock_interruptible(&data->sysfs_mutex);
+	if (error)
+		goto out_release_fw;
+
+	error = zinitix_update_firmware(data, fw);
+	
+	mutex_unlock(&data->sysfs_mutex);
+
+out_release_fw:
+	release_firmware(fw);
+	return error ?: count;
+}
+
+static ssize_t zinitix_sysfs_send_data(struct device *dev,
+				    struct device_attribute *attr,
+				    const char *buf, size_t count)
+{
+	struct i2c_client *client = to_i2c_client(dev);
+	struct touchpad_data *data = i2c_get_clientdata(client);
+	u16 cmd, reg_addr, reg_val;
+	int error, nsize = 0;
+	cmd = (buf[0]&0x00FF) | (buf[1]<<8 & 0xFF00);
+	reg_addr = (buf[2]&0x00FF) | (buf[3]<<8 & 0xFF00);
+
+	switch(cmd)
+	{
+	case WRITE_REG:
+		reg_val = (buf[4]&0x00FF) | (buf[5]<<8 & 0xFF00);
+		zinitix_i2c_write_reg(client, reg_addr, reg_val);
+        break;
+
+	case READ_REG:
+		nsize = count + 2;
+		if(nsize >= 512)
+			nsize = 512;
+		memset(data->userbuffer, 0, nsize);
+		zinitix_i2c_read_reg(client, reg_addr, &reg_val);
+		data->userbuffer[0] = reg_val & 0xFF;
+		data->userbuffer[1] = (reg_val>>8) & 0xFF;
+		data->ready_userbuffer = true;
+		data->recv_data_size = count;
+        break;
+	
+	case VENDOR_COMMAND_READ:
+		nsize = count + 2;
+		memset(data->userbuffer, 0, nsize);
+		zinitix_i2c_read_data(client, reg_addr,data->userbuffer);
+		data->ready_userbuffer = true;
+		data->recv_data_size = count;
+        break;
+
+	case VENDOR_COMMAND_WRITE:
+		zinitix_i2c_write_data(client, reg_addr, 
+                                        &buf[sizeof(u16)*2], count);
+		data->ready_userbuffer = true;
+		data->recv_data_size = count;
+        break;
+
+	case FIRMWARE_WRITE:
+		zinitix_write_fw_block(data, &buf[2], SECTOR_SZ, 0);
+        break;
+
+	case DEVICE_INIT:
+		error = data->ops->initialize(client);
+		if (error) {
+			dev_err(&client->dev, "dev init failed: %d\n", error);
+			return error;
+		}
+        break;
+
+	default:
+		break;
+	}
+	
+	return count;
+}
+
+static ssize_t zinitix_sysfs_recv_data(struct device *dev,
+					struct device_attribute *attr,
+					char *buf)
+{
+	struct i2c_client *client = to_i2c_client(dev);
+	struct touchpad_data *data = i2c_get_clientdata(client);
+	int size = 0;
+
+	u16 cmd = (buf[0]&0x00FF) | (buf[1]<<8 & 0xFF00);
+
+	switch(cmd)
+	{
+        case GET_INFO_CHIPID:
+                        memcpy(buf, &data->chip_code, sizeof(u16));
+        break;
+
+        default:
+        break;
+	}
+
+	size = data->recv_data_size;
+	data->userbuffer[size]='\0';
+	
+	memcpy(buf, data->userbuffer, size);
+	
+	data->ready_userbuffer = false;
+	return size;
+}
+
+static DEVICE_ATTR(update_fw, S_IWUSR, NULL, zinitix_sysfs_update_fw);
+static DEVICE_ATTR(send_data, S_IRWXU, NULL, zinitix_sysfs_send_data);
+static DEVICE_ATTR(recv_data, S_IRWXU, zinitix_sysfs_recv_data, NULL);
+
+static struct attribute *zinitix_sysfs_entries[] = {
+	&dev_attr_update_fw.attr,
+	&dev_attr_send_data.attr,
+	&dev_attr_recv_data.attr,
+	NULL,
+};
+
+static const struct attribute_group zinitix_sysfs_group = {
+	.attrs = zinitix_sysfs_entries,
+};
+
+static const struct attribute_group *zinitix_sysfs_groups[] = {
+	&zinitix_sysfs_group,
+	NULL
+};
+
+/*
+ **************
+ * Zinitix isr
+ */
+
+static void zinitix_report_contact(struct touchpad_data *data, int contact_num, 
+                                bool contact_valid, u8 *finger_data)
+{
+	struct input_dev *input = data->input;
+	unsigned int pos_x, pos_y;
+	unsigned int mk_x, mk_y;
+	unsigned int area_x, area_y, major, minor;
+	
+	if (contact_valid) {
+		pos_x = finger_data[0] | finger_data[1] << 8;
+		pos_y = finger_data[2] | finger_data[3] << 8;
+
+		mk_x = mk_y = 0x2;	//임의값으로 테스트 후 제거 
+
+		if (pos_x > data->max_x || pos_y > data->max_y) {
+			dev_dbg(input->dev.parent,
+				"[%d] x=%d y=%d over max (%d, %d)",
+				contact_num, pos_x, pos_y,
+				data->max_x, data->max_y);
+			return;
+		}
+		
+		area_x = mk_x * (data->width_x - ZINITIX_FWIDTH_REDUCE);
+		area_y = mk_y * (data->width_y - ZINITIX_FWIDTH_REDUCE);
+
+		major = max(area_x, area_y);
+		minor = min(area_x, area_y);
+		
+		input_mt_slot(input, contact_num);
+		input_mt_report_slot_state(input, MT_TOOL_FINGER, true);
+		input_report_abs(input, ABS_MT_POSITION_X, pos_x);
+		input_report_abs(input, ABS_MT_POSITION_Y, pos_y);
+		input_report_abs(input, ABS_MT_PRESSURE, ZINITIX_TP_PRESS);
+		input_report_abs(input, ABS_TOOL_WIDTH, mk_x);
+		input_report_abs(input, ABS_MT_TOUCH_MAJOR, major);
+		input_report_abs(input, ABS_MT_TOUCH_MINOR, minor);
+	} else {
+		input_mt_slot(input, contact_num);
+		input_mt_report_slot_state(input, MT_TOOL_FINGER, false);
+	}
+}
+
+static void zinitix_report_absolute(struct touchpad_data *data, u8 *packet, 
+                                bool lastPacket)
+{
+	struct input_dev *input = data->input;
+	u8 *finger_data = &packet[ZINITIX_FINGER_DATA_OFFSET];
+	u8 btn = packet[ZINITIX_BUTTON_OFFSET];
+	int contact_id;
+	struct zinitix_contact_status *contact_info;
+	bool contact_valid = true;
+	
+	contact_info = (struct zinitix_contact_status*)&packet[3];
+
+        if(contact_info->confidence)
+                contact_valid = contact_info->tip;
+        else
+                contact_valid = false;
+
+	contact_id =  (packet[3]>>2) + 1;
+	zinitix_report_contact(data, contact_id, contact_valid, finger_data);
+	
+	if(true == lastPacket)
+	{
+		input_report_key(input, BTN_LEFT, (btn) & 0x01);
+		input_report_abs(input, ABS_DISTANCE, false);
+		input_mt_report_pointer_emulation(input, true);
+		input_sync(input);
+	}
+}
+
+static irqreturn_t zinitix_isr(int irq, void *dev_id)
+{
+	struct touchpad_data *data = dev_id;
+	struct device *dev = &data->client->dev;
+	int error;
+	int isrCnt;
+	u8 report[ZINITIX_MAX_REPORT_LEN];
+	bool lastPacket = false;
+	
+	if (data->in_fw_update) {
+		complete(&data->fw_completion);
+		goto out;
+	}
+	
+	do{
+		error = data->ops->get_report(data->client, report);
+		if (error)
+			goto out;
+		if (report[ZINITIX_REPORT_ID_OFFSET] == ZINITIX_REPORT_ID){
+			if(report[10] > 0)
+				isrCnt = report[10];
+
+			isrCnt--;
+
+			if(isrCnt <= 0)
+				lastPacket = true;
+
+			zinitix_report_absolute(data, report, lastPacket);
+		}
+		else{
+			dev_err(dev, "Exception (ID : 0x%x)!!\n",
+                                        report[ZINITIX_REPORT_ID_OFFSET]);
+			goto out;
+		}
+		
+	}while(isrCnt > 0);
+out:
+	return IRQ_HANDLED;
+}
+
+/*
+ ***************
+ * Zinitix init
+ */
+static int zinitix_setup_input_device(struct touchpad_data *data)
+{
+	struct device *dev = &data->client->dev;
+	struct input_dev *input;
+	unsigned int max_width = max(data->width_x, data->width_y);
+	unsigned int min_width = min(data->width_x, data->width_y);
+	int error;
+        int finger_width = 15;
+
+	input = devm_input_allocate_device(dev);
+	if (!input)
+		return -ENOMEM;
+
+	input->name = "Zinitix Touchpad";
+	input->id.bustype = BUS_I2C;
+	input->id.vendor = ZINITIX_VENDOR_ID;
+	input->id.product = data->product_id;
+	input_set_drvdata(input, data);
+
+	error = input_mt_init_slots(input, ZINITIX_MAX_FINGERS,
+				    INPUT_MT_POINTER | INPUT_MT_DROP_UNUSED);
+	if (error) {
+		dev_err(dev, "failed to initialize MT slots: %d\n", error);
+		return error;
+	}
+
+	__set_bit(EV_ABS, input->evbit);
+	__set_bit(INPUT_PROP_POINTER, input->propbit);
+	__set_bit(INPUT_PROP_BUTTONPAD, input->propbit);
+	__set_bit(BTN_LEFT, input->keybit);
+
+	/* Set up ST parameters */
+	input_set_abs_params(input, ABS_X, 0, data->max_x, 0, 0);
+	input_set_abs_params(input, ABS_Y, 0, data->max_y, 0, 0);
+	input_abs_set_res(input, ABS_X, data->x_res);
+	input_abs_set_res(input, ABS_Y, data->y_res);
+	input_set_abs_params(input, ABS_PRESSURE, 0, ZINITIX_TP_PRESS, 0, 0);
+	input_set_abs_params(input, ABS_TOOL_WIDTH, 0, finger_width, 0, 0);
+	input_set_abs_params(input, ABS_DISTANCE, 0, 1, 0, 0);
+
+	/* And MT parameters */
+	input_set_abs_params(input, ABS_MT_POSITION_X, 0, data->max_x, 0, 0);
+	input_set_abs_params(input, ABS_MT_POSITION_Y, 0, data->max_y, 0, 0);
+	input_abs_set_res(input, ABS_MT_POSITION_X, data->x_res);
+	input_abs_set_res(input, ABS_MT_POSITION_Y, data->y_res);
+	input_set_abs_params(input, ABS_MT_PRESSURE, 0, ZINITIX_TP_PRESS, 0, 0);
+	
+        input_set_abs_params(input, ABS_MT_TOUCH_MAJOR, 0, 
+                            finger_width * max_width, 0, 0);
+	
+        input_set_abs_params(input, ABS_MT_TOUCH_MINOR, 0, 
+                            finger_width * min_width, 0, 0);
+
+	data->input = input;
+
+	return 0;
+}
+
+static void zinitix_disable_regulator(void *_data)
+{
+	struct touchpad_data *data = _data;
+	regulator_disable(data->vcc);
+}
+
+static void zinitix_remove_sysfs_groups(void *_data)
+{
+	struct touchpad_data *data = _data;
+	sysfs_remove_groups(&data->client->dev.kobj, zinitix_sysfs_groups);
+}
+
+static int zinitix_touchpad_probe(struct i2c_client *client,
+		      const struct i2c_device_id *dev_id)
+{
+	const struct zinitix_transport_ops *transport_ops;
+	struct device *dev = &client->dev;
+	struct touchpad_data *data;
+	unsigned long irqflags;
+	int error;
+	if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
+		transport_ops = &zinitix_i2c_ops;
+	} else {
+		dev_err(dev, "not a supported I2C/SMBus adapter\n");
+		return -EIO;
+	}
+	data = devm_kzalloc(dev, sizeof(struct touchpad_data), GFP_KERNEL);
+	if (!data)
+		return -ENOMEM;
+	i2c_set_clientdata(client, data);
+
+	data->ops = transport_ops;
+	data->client = client;
+	data->userbuffer = kmalloc(1024, GFP_KERNEL);
+
+	init_completion(&data->fw_completion);
+	mutex_init(&data->sysfs_mutex);
+	data->vcc = devm_regulator_get(dev, "vcc");
+	if (IS_ERR(data->vcc)) {
+		error = PTR_ERR(data->vcc);
+		if (error != -EPROBE_DEFER)
+			dev_err(dev, "Failed to get 'vcc' regulator: %d\n", 
+				error);
+		return error;
+	}
+	error = regulator_enable(data->vcc);
+	if (error) {
+		dev_err(dev, "Failed to enable regulator: %d\n", error);
+		return error;
+	}
+	error = devm_add_action(dev, zinitix_disable_regulator, data);
+	if (error) {
+		regulator_disable(data->vcc);
+		dev_err(dev, "Failed to add disable regulator action: %d\n",
+			error);
+		return error;
+	}
+	/* Initialize the touchpad. */
+	error = zinitix_initialize(data);
+	if (error)
+		return error;
+	error = zinitix_check_update_firmware(dev);
+
+	error = zinitix_query_device_parameters(data);
+	if (error)     
+                dev_err(&client->dev, "query_device_parameters Fail!!!");
+		
+	error = zinitix_setup_input_device(data);
+	if (error)
+		return error;
+	irqflags = irq_get_trigger_type(client->irq);
+	if (!irqflags)
+		irqflags = IRQF_TRIGGER_FALLING;
+
+	error = devm_request_threaded_irq(dev, client->irq, NULL, zinitix_isr,
+					  irqflags | IRQF_ONESHOT,
+					  client->name, data);
+	if (error) {
+		dev_err(dev, "cannot register irq=%d\n", client->irq);
+		return error;
+	}
+	error = sysfs_create_groups(&dev->kobj, zinitix_sysfs_groups);
+	if (error) {
+		dev_err(dev, "failed to create sysfs attributes: %d\n", error);
+		return error;
+	}
+	error = devm_add_action(dev, zinitix_remove_sysfs_groups, data);
+	if (error) {
+		zinitix_remove_sysfs_groups(data);
+		dev_err(dev, "Failed to add sysfs cleanup action: %d\n",
+			error);
+		return error;
+	}
+	error = input_register_device(data->input);
+	if (error) {
+		dev_err(dev, "failed to register input device: %d\n", error);
+		return error;
+	}
+	if (!dev->of_node)
+		device_init_wakeup(dev, true);
+	return 0;
+}
+
+static int __maybe_unused zinitix_touchpad_suspend(struct device *dev)
+{
+	struct i2c_client *client = to_i2c_client(dev);
+	struct touchpad_data *data = i2c_get_clientdata(client);
+	int ret;
+
+	ret = mutex_lock_interruptible(&data->sysfs_mutex);
+	if (ret)
+		return ret;
+
+	disable_irq(client->irq);
+
+	if (device_may_wakeup(dev)) {
+		ret = zinitix_sleep(data);
+		/* Enable wake from IRQ */
+		data->irq_wake = (enable_irq_wake(client->irq) == 0);
+	} else {
+		ret = zinitix_disable_power(data);
+	}
+
+	mutex_unlock(&data->sysfs_mutex);
+	return ret;
+}
+
+static int __maybe_unused zinitix_touchpad_resume(struct device *dev)
+{
+	struct i2c_client *client = to_i2c_client(dev);
+	struct touchpad_data *data = i2c_get_clientdata(client);
+	int error;
+
+	if (device_may_wakeup(dev) && data->irq_wake) {
+		disable_irq_wake(client->irq);
+		data->irq_wake = false;
+	}
+
+	error = zinitix_enable_power(data);
+	if (error) {
+		dev_err(dev, "power up when resuming failed: %d\n", error);
+		goto err;
+	}
+
+	error = zinitix_initialize(data);
+	if (error)
+		dev_err(dev, "initialize when resuming failed: %d\n", error);
+
+err:
+	enable_irq(data->client->irq);
+	return error;
+}
+
+static SIMPLE_DEV_PM_OPS(zinitix_pm_ops, 
+                         zinitix_touchpad_suspend, zinitix_touchpad_resume);
+
+static const struct i2c_device_id zinitix_touchpad_id[] = {
+	{ ZINITIX_TOUCHPAD_DRIVER_NAME, 0 },
+	{ },
+};
+MODULE_DEVICE_TABLE(i2c, zinitix_touchpad_id);
+
+#ifdef CONFIG_ACPI
+static const struct acpi_device_id zinitix_acpi_id[] = {
+        {"ZNT0002", 0 },
+        {"ZNT0003", 0 },
+        {"ZNT0004", 0 },
+        {"ZNT0005", 0 },
+        {"ZNT0006", 0 },
+        {"ZNT0007", 0 },
+        {"ZNT0008", 0 },
+        {"ZNT0009", 0 },
+        {"ZNT000A", 0 },
+        {"ACPI0C50", 0 },
+        {"PNP0C50", 0 },
+        { },
+};
+MODULE_DEVICE_TABLE(acpi, zinitix_acpi_id);
+#endif
+
+#ifdef CONFIG_OF
+static const struct of_device_id zinitix_of_match[] = {
+	{ .compatible = "zinitix,znttp" },
+	{ /* sentinel */ }
+};
+MODULE_DEVICE_TABLE(of, zinitix_of_match);
+#endif
+
+static struct i2c_driver zinitix_touchpad_driver = {
+	.driver = {
+		.name	                = ZINITIX_TOUCHPAD_DRIVER_NAME,
+		.pm	                = &zinitix_pm_ops,
+		.acpi_match_table       = ACPI_PTR(zinitix_acpi_id),
+		.of_match_table         = of_match_ptr(zinitix_of_match),
+		.probe_type             = PROBE_PREFER_ASYNCHRONOUS,
+	},
+	.probe		                = zinitix_touchpad_probe,
+	.id_table	                = zinitix_touchpad_id,
+};
+
+module_i2c_driver(zinitix_touchpad_driver);
+
+MODULE_AUTHOR("<kdson@zinitix.com>");
+MODULE_DESCRIPTION("ZINITIX I2C Touchpad driver");
+MODULE_LICENSE("GPL");
+MODULE_VERSION(ZINITIX_DRIVER_VERSION);
+
+
diff --git a/drivers/input/mouse/zinitix_i2c.h b/drivers/input/mouse/zinitix_i2c.h
index e69de29bb2d1..c33dcdcaab00 100755
--- a/drivers/input/mouse/zinitix_i2c.h
+++ b/drivers/input/mouse/zinitix_i2c.h
@@ -0,0 +1,255 @@ 
+/*
+ * ZINITIX I2C Touchpad driver
+ *
+ * Copyright (c) 2020 ZINITIX Co.,Ltd
+ *
+ * Author: KwangDeok Son <kdson@zinitix.com>
+ *
+ * Based on cyapa driver:
+ * copyright (c) 2011-2013 ELAN Microelectronics Corp.
+ * copyright (c) 2011-2012 Cypress Semiconductor, Inc.
+ * copyright (c) 2011-2012 Google, Inc.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License version 2 as published
+ * by the Free Software Foundation.
+ *
+ * Trademarks are the property of their respective owners.
+ */
+
+#ifndef _ZINITIX_I2C_H
+#define _ZINITIX_I2C_H
+
+#include <linux/types.h>
+
+#define ZINITIX_TOUCHPAD_DRIVER_NAME	"zinitix_i2c_touchpad"
+#define ZINITIX_DRIVER_VERSION  	"1.0.0"
+#define ZINITIX_VENDOR_ID		0x14E5
+
+#define ZINITIX_TP_PRESS	        128
+
+#define ZINITIX_FWIDTH_REDUCE	        90
+#define ZINITIX_RETRY_COUNT	        3
+
+#define ZINITIX_MAX_FINGERS		5
+#define ZINITIX_REPORT_ID		0x01
+#define ZINITIX_REPORT_ID_OFFSET	2
+#define ZINITIX_FINGER_DATA_OFFSET	4
+#define ZINITIX_BUTTON_OFFSET           11
+#define ZINITIX_MAX_REPORT_LEN	        12
+
+
+#define ZINITIX_PTP_MODE		0x0001
+#define ZINITIX_DISABLE_POWER		0x0001
+
+#define ZINITIX_FW_NAME		"zinitix_i2c_tp_fw.bin"
+
+/* Zinitix i2c commands */
+#define ZINITIX_MAX_X_REG		0x00C1	//Long dist
+#define ZINITIX_MAX_Y_REG		0x00C0	//short dist
+#define ZINITIX_CH_X_REG		0x0065
+#define ZINITIX_CH_Y_REG		0x0164
+#define ZINITIX_GET_DESC		0x000E
+#define ZINITIX_GET_REPORT_DESC		0x001E
+#define ZINITIX_REPORT_DESC_LENGTH	0x013E
+#define ZINITIX_PHY_X_OFFSET            0x009F
+#define ZINITIX_PHY_Y_OFFSET            0x00A9
+
+#define ZINITIX_STANDARD_CMD		0x0194
+#define ZINITIX_RESET			0x0100
+#define ZINITIX_WAKE_UP			0x0800
+#define ZINITIX_SLEEP			0x0801
+#define ZINITIX_I2C_POWER_CMD		0x0307
+
+#define ZINITIX_I2C_INF_LENGTH		2
+#define ZINITIX_I2C_REPORT_LEN		12
+#define ZINITIX_DESC_LENGTH		30
+
+
+#define WRITE_REG   			0x0000
+#define READ_REG    			0x0001
+#define VENDOR_COMMAND_READ		0x0002
+#define VENDOR_COMMAND_WRITE	        0x0003
+#define FIRMWARE_WRITE			0x0004
+#define DEVICE_INIT			0x0005
+#define GET_INFO_CHIPID 		0x0006
+
+#define REPORT_INPUT                    0x04
+#define REPORT_SWITCH                   0x09
+#define REPORT_LATENCY                  0x0A
+
+
+#define INPUT_MOUSE                     0x00
+#define INPUT_PTP                       0x03
+
+#define SWITCH_NONE                     0x00
+#define SWITCH_BUTTON                   0x01
+#define SWITCH_SURFACE                  0x02
+#define SWITCH_BOTH                     0x03
+
+#define LATENCY_NORMAL                  0x00
+#define LATENCY_HIGH                    0x01
+
+struct i2c_client;
+struct completion;
+
+enum tp_mode {
+	IAP_MODE = 1,
+	MAIN_MODE
+};
+
+struct zinitix_contact_status {
+	u8 tip : 1;
+	u8 confidence : 1;
+	u8 contact_id : 1;
+	u8 reserved : 5;
+};
+
+struct zinitix_transport_ops {
+	int (*initialize)(struct i2c_client *client);
+	int (*sleep_control)(struct i2c_client *, u16 mode);
+	int (*set_mode)(struct i2c_client *client, u8 mode);
+
+	int (*get_max)(struct i2c_client *client,
+		       unsigned int *max_x, unsigned int *max_y);
+	int (*get_num_channel)(struct i2c_client *client,
+			      unsigned short *x_tracenum,
+			      unsigned short *y_tracenum);
+	
+	int (*reset)(struct i2c_client *client);
+
+	int (*prepare_fw_update)(struct i2c_client *client);
+	int (*write_fw_block)(struct i2c_client *client,
+			      const u8 *page, u16 checksum, int idx);
+	int (*read_fw_block)(struct i2c_client *client,
+			      u8 *page, int idx);
+	int (*finish_fw_update)(struct i2c_client *client,
+				struct completion *reset_done);
+
+	int (*get_report)(struct i2c_client *client, u8 *report);
+	int (*get_pressure_adjustment)(struct i2c_client *client,
+				       int *adjustment);
+	int (*get_pattern)(struct i2c_client *client, u8 *pattern);
+};
+
+extern const struct zinitix_transport_ops zinitix_i2c_ops;
+
+#define TO_LITTLE_ENDIAN(n1, n2, n3) (((u32)n1<<16 & 0x00FF0000) | ((u32)n2<<8 & 0x0000FF00) | ((u32)n3 & 0x000000FF))
+#define SECTOR_SZ		        (8 * 2)
+#define FW_BUFF_SIZE                    (1024*48) // 48K
+#define FW_BUFF_SIZE_650                (1024*128) // 128K
+#define FW_REWRITE_LIMIT	        8
+
+/* Zinitix i2c HID commands */
+#define FWUPGRADE_INIT		0x20F0
+#define FWUPGRADE_PGM		0x21F0
+#define FWUPGRADE_READ		0x22F0
+#define FWUPGRADE_MODE		0x25F0
+#define FWUPGRADE_WRITE_MODE		0x27F0
+#define FWUPGRADE_MERASE		0x28F0
+#define FWUPGRADE_START_PAGE		0x29F0
+#define FWUPGRADE_BLOCK_ERASE	0x2AF0
+
+#define HW_RESET			0x04F0
+
+#define REG_FWVERSION_MAJOR		0x0012
+#define REG_FWVERSION_MINOR		0x0121
+#define REG_FWVERSION_RELEASE		0x0013
+#define REG_FWCHECKSUM			0x012C
+
+#define VENDOR_CMD_ENABLE		0x10F0
+#define INIT_NVM			0x12F0
+#define DISABLE_NVM_WP		        0x13F0
+
+
+enum FWUPGRADE_PROGMODE
+{
+	FWUPGRADE_PROGRAM	= 0,
+	FWUPGRADE_ONLYWRITE	= 1,
+	FWUPGRADE_WRITEREPEAT	= 2,
+};
+
+union nvm_binary_info
+{
+	u16 buff16[128*1024/2];
+	u32 buff32[128*1024/4]; //128*1024byte
+	struct _val
+	{
+		u32 RESERVED0;		// 0
+		u32 auto_boot_flag1;	// 1
+		u32 auto_boot_flag2;	// 2
+		u32 slave_addr_flag;	// 3
+		u32 RESERVED1[4];	// 4
+		u32 info_checksum;	// 8
+		u32 core_checksum;	// 9
+		u32 custom_checksum;	// 10
+		u32 register_checksum;	// 11
+		u16 hw_id;		// 12
+		u16 RESERVED2;
+		u16 major_ver;		// 13
+		u16 RESERVED3;
+		u16 minor_ver;		// 14
+		u16 RESERVED4;
+		u16 release_ver;	// 15
+		u16 RESERVED5;
+		u16 chip_id;		// 16
+		u16 chip_id_reverse;
+		u16 chip_naming_number;	// 17
+		u16 RESERVED6[9];
+		u8  info_size[4];	// 21
+		u8  core_size[4];	// 22
+		u8  custom_size[4];	// 23
+		u8  register_size[4];	// 24
+		u8  total_size[4];	// 25
+		u32 RESERVED7[5];	// 26
+
+		u32 RESERVED8[32736];	// 32
+	}val;
+};
+
+struct fw_info {
+	u32 info_size;
+	u32 core_size;
+	u32 cust_size;
+	u32 regi_size;
+	u32 start_address;
+	u32 end_address;
+};
+
+/* The main device structure */
+
+struct touchpad_data {
+	struct i2c_client	*client;
+	struct input_dev	*input;
+	struct regulator	*vcc;
+
+	const struct zinitix_transport_ops *ops;
+	/* for fw update */
+	struct completion	fw_completion;
+	bool			in_fw_update;
+	struct mutex		sysfs_mutex;
+	unsigned int		phy_x;
+	unsigned int		phy_y;
+	unsigned int		max_x;
+	unsigned int		max_y;
+	unsigned int		width_x;
+	unsigned int		width_y;
+	unsigned int		x_res;
+	unsigned int		y_res;
+
+	u16			product_id;
+	int			pressure_adjustment;
+	bool			irq_wake;
+	u8			*userbuffer;
+	bool 		        ready_userbuffer;
+	u16 		        recv_data_size;
+	u16 		        chip_code;
+};
+
+u16 zinitix_i2c_read_reg(struct i2c_client *client, u16 reg, u16 *value);
+u16 zinitix_i2c_read_data(struct i2c_client *client, u16 reg, u8 *verify_data);
+int zinitix_i2c_write_reg(struct i2c_client *client, u16 reg, u16 value);
+int zinitix_i2c_write_data(struct i2c_client *client, u16 reg, const u8* value, u16 size);
+
+#endif /* _ZINITIX_I2C_H */
+