| lists.openwall.net | lists / announce owl-users owl-dev john-users john-dev passwdqc-users yescrypt popa3d-users / oss-security kernel-hardening musl sabotage tlsify passwords / crypt-dev xvendor / Bugtraq Full-Disclosure linux-kernel linux-netdev linux-ext4 linux-hardening linux-cve-announce PHC | |
|
Open Source and information security mailing list archives
| ||
|
Date: Wed, 7 Jun 2017 12:05:51 +0800
From: Wang Yafei <wangyafei@...dix.com>
To: Dmitry Torokhov <dmitry.torokhov@...il.com>,
Henrik Rydberg <rydberg@...math.org>,
<linux-input@...r.kernel.org>
CC: <linux-kernel@...r.kernel.org>, <andrew@...dix.com>,
<mouse@...dix.com>, <linux-input@...r.kernel.org>
Subject: [PATCH] Add driver for GOODiX GTx5 series touchsereen
This driver is for GOODiX GTx5 series touchscreen controllers
such as GT8589, GT7589. This driver designed with hierarchial structure,
for that can be modified to support subsequent controllers easily.
Some zones of the touchscreen can be set to buttons(according to the
hardware). That is why it handles button and multitouch events.
A brief description of driver structure
- Core Layer: This layer responsible for basic input events report,
GPIO pinctrl, Interrupt, Power resources manager and submodules
manager.
- Hardware Layer: This layer responsible for controllers initialization,
irq handle as well as bus read/write.
- External Module Layer: This layer used for support more features
such as firmware update, debug tools and gesture wakeup.
Signed-off-by: Wang Yafei <wangyafei@...dix.com>
---
.../input/touchscreen/goodix-ts-sunrise/Kconfig | 36 +
.../input/touchscreen/goodix-ts-sunrise/Makefile | 6 +
.../goodix-ts-sunrise/goodix_gtx5_i2c.c | 939 ++++++++++++
.../goodix-ts-sunrise/goodix_gtx5_update.c | 1453 ++++++++++++++++++
.../touchscreen/goodix-ts-sunrise/goodix_ts_core.c | 1618 ++++++++++++++++++++
.../touchscreen/goodix-ts-sunrise/goodix_ts_core.h | 585 +++++++
.../goodix-ts-sunrise/goodix_ts_tools.c | 552 +++++++
7 files changed, 5189 insertions(+)
create mode 100755 drivers/input/touchscreen/goodix-ts-sunrise/Kconfig
create mode 100755 drivers/input/touchscreen/goodix-ts-sunrise/Makefile
create mode 100755 drivers/input/touchscreen/goodix-ts-sunrise/goodix_gtx5_i2c.c
create mode 100755 drivers/input/touchscreen/goodix-ts-sunrise/goodix_gtx5_update.c
create mode 100755 drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_core.c
create mode 100755 drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_core.h
create mode 100755 drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_tools.c
diff --git a/drivers/input/touchscreen/goodix-ts-sunrise/Kconfig b/drivers/input/touchscreen/goodix-ts-sunrise/Kconfig
new file mode 100755
index 0000000..8e16595
--- /dev/null
+++ b/drivers/input/touchscreen/goodix-ts-sunrise/Kconfig
@@ -0,0 +1,36 @@
+#
+# Goodix touchscreen driver configuration
+#
+menuconfig TOUCHSCREEN_GOODIX_GTX5
+ bool "Goodix GTx5 touchscreen"
+ depends on I2C
+ default y
+ help
+ Say Y here if you have a Goodix GTx5xx touchscreen connected
+ to your system.
+
+ If unsure, say N.
+
+if TOUCHSCREEN_GOODIX_GTX5
+
+config TOUCHSCREEN_GOODIX_GTX5_UPDATE
+ tristate "Goodix GTx5xx firmware update module"
+ default y
+ help
+ Say Y here to enable support for doing firmware update.
+
+ If unsure, say N.
+
+ To compile this driver as a module, choose M here.
+
+config TOUCHSCREEN_GOODIX_GTX5_TOOLS
+ tristate "Goodix touch tools support"
+ default n
+ help
+ Say Y here to enable debug tools.
+
+ If unsure, say N.
+
+ To compile this driver as a module, choose M here.
+
+endif
diff --git a/drivers/input/touchscreen/goodix-ts-sunrise/Makefile b/drivers/input/touchscreen/goodix-ts-sunrise/Makefile
new file mode 100755
index 0000000..2d5b38d
--- /dev/null
+++ b/drivers/input/touchscreen/goodix-ts-sunrise/Makefile
@@ -0,0 +1,6 @@
+# Goodix Touchscreen Makefile
+
+obj-$(CONFIG_TOUCHSCREEN_GOODIX_GTX5) += goodix_ts_core.o
+obj-$(CONFIG_TOUCHSCREEN_GOODIX_GTX5_TOOLS) += goodix_ts_tools.o
+obj-$(CONFIG_TOUCHSCREEN_GOODIX_GTX5) += goodix_gtx5_i2c.o
+obj-$(CONFIG_TOUCHSCREEN_GOODIX_GTX5_UPDATE) += goodix_gtx5_update.o
diff --git a/drivers/input/touchscreen/goodix-ts-sunrise/goodix_gtx5_i2c.c b/drivers/input/touchscreen/goodix-ts-sunrise/goodix_gtx5_i2c.c
new file mode 100755
index 0000000..c2e2dee
--- /dev/null
+++ b/drivers/input/touchscreen/goodix-ts-sunrise/goodix_gtx5_i2c.c
@@ -0,0 +1,939 @@
+/*
+ * Goodix GTx5 I2C Dirver
+ * Hardware interface layer of touchdriver architecture.
+ *
+ * Copyright (C) 2015 - 2016 Goodix, Inc.
+ * Authors: Wang Yafei <wangyafei@...dix.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be a reference
+ * to you, when you are integrating the GOODiX's CTP IC into your system,
+ * 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.
+ */
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/delay.h>
+#include <linux/ctype.h>
+#include <linux/slab.h>
+#include <linux/i2c.h>
+#include <linux/platform_device.h>
+#include <linux/interrupt.h>
+#include "goodix_ts_core.h"
+
+#define TS_DT_COMPATIBLE "goodix,gtx5"
+#define TS_DRIVER_NAME "goodix_i2c"
+#define I2C_MAX_TRANSFER_SIZE 256
+#define TS_ADDR_LENGTH 2
+
+#define TS_REG_COORDS_BASE 0x824E
+#define TS_REG_CMD 0x8040
+#define TS_REG_REQUEST 0x8044
+#define TS_REG_VERSION 0x8240
+#define TS_REG_CFG_BASE 0x8050
+
+#define CFG_XMAX_OFFSET (0x8052 - 0x8050)
+#define CFG_YMAX_OFFSET (0x8054 - 0x8050)
+
+#define REQUEST_HANDLED 0x00
+#define REQUEST_CONFIG 0x01
+#define REQUEST_BAKREF 0x02
+#define REQUEST_RESET 0x03
+#define REQUEST_MAINCLK 0x04
+#define REQUEST_IDLE 0x05
+
+#define TS_MAX_SENSORID 5
+#define TS_CFG_MAX_LEN 495
+#if TS_CFG_MAX_LEN > GOODIX_CFG_MAX_SIZE
+#error GOODIX_CFG_MAX_SIZE too small, please fix.
+#endif
+
+#ifdef CONFIG_OF
+/*
+ * goodix_parse_dt_resolution - parse resolution from dt
+ * @node: devicetree node
+ * @board_data: pointer to board data structure
+ * return: 0 - no error, <0 error
+ */
+static int goodix_parse_dt_resolution(struct device_node *node,
+ struct goodix_ts_board_data *board_data)
+{
+ int r, err;
+
+ r = of_property_read_u32(node, "goodix,panel-max-id",
+ &board_data->panel_max_id);
+ if (r) {
+ err = -ENOENT;
+ } else {
+ if (board_data->panel_max_id > GOODIX_MAX_TOUCH)
+ board_data->panel_max_id = GOODIX_MAX_TOUCH;
+ }
+
+ r = of_property_read_u32(node, "goodix,panel-max-x",
+ &board_data->panel_max_x);
+ if (r)
+ err = -ENOENT;
+
+ r = of_property_read_u32(node, "goodix,panel-max-y",
+ &board_data->panel_max_y);
+ if (r)
+ err = -ENOENT;
+
+ r = of_property_read_u32(node, "goodix,panel-max-w",
+ &board_data->panel_max_w);
+ if (r)
+ err = -ENOENT;
+
+ r = of_property_read_u32(node, "goodix,panel-max-p",
+ &board_data->panel_max_p);
+ if (r)
+ err = -ENOENT;
+
+ board_data->swap_axis = of_property_read_bool(node,
+ "goodix,swap-axis");
+
+ return 0;
+}
+
+/**
+ * goodix_parse_dt - parse board data from dt
+ * @dev: pointer to device
+ * @board_data: pointer to board data structure
+ * return: 0 - no error, <0 error
+ */
+static int goodix_parse_dt(struct device_node *node,
+ struct goodix_ts_board_data *board_data)
+{
+ struct property *prop;
+ int r;
+
+ if (!board_data) {
+ ts_err("Invalid board data");
+ return -EINVAL;
+ }
+
+ r = of_property_read_u32(node, "goodix,irq-flags",
+ &board_data->irq_flags);
+ if (r) {
+ ts_err("Invalid irq-flags");
+ return -EINVAL;
+ }
+
+ board_data->avdd_name = "vtouch";
+ r = of_property_read_u32(node, "goodix,power-on-delay-us",
+ &board_data->power_on_delay_us);
+ if (!r) {
+ /* 1000ms is too large, maybe you have pass a wrong value */
+ if (board_data->power_on_delay_us > 1000 * 1000) {
+ ts_err("Power on delay time exceed 1s, please check");
+ board_data->power_on_delay_us = 0;
+ }
+ }
+
+ r = of_property_read_u32(node, "goodix,power-off-delay-us",
+ &board_data->power_off_delay_us);
+ if (!r) {
+ /* 1000ms is too large, maybe you have pass a wrong value */
+ if (board_data->power_off_delay_us > 1000 * 1000) {
+ ts_err("Power off delay time exceed 1s, please check");
+ board_data->power_off_delay_us = 0;
+ }
+ }
+
+ /* get xyz resolutions */
+ r = goodix_parse_dt_resolution(node, board_data);
+ if (r < 0) {
+ ts_err("Failed to parse resolutions:%d", r);
+ return r;
+ }
+
+ /* key map */
+ prop = of_find_property(node, "goodix,panel-key-map", NULL);
+ if (prop && prop->length) {
+ if (prop->length / sizeof(u32) > GOODIX_MAX_KEY) {
+ ts_err("Size of panel-key-map is invalid");
+ return r;
+ }
+
+ board_data->panel_max_key = prop->length / sizeof(u32);
+ r = of_property_read_u32_array(node,
+ "goodix,panel-key-map",
+ &board_data->panel_key_map[0],
+ board_data->panel_max_key);
+ if (r)
+ return r;
+ }
+
+ ts_debug("[DT]id:%d, x:%d, y:%d, w:%d, p:%d",
+ board_data->panel_max_id,
+ board_data->panel_max_x,
+ board_data->panel_max_y,
+ board_data->panel_max_w,
+ board_data->panel_max_p);
+ return 0;
+}
+
+/**
+ * goodix_parse_dt_cfg - pares config data from devicetree node
+ * @dev: pointer to device
+ * @cfg_type: config type such as normal_config, highsense_cfg ...
+ * @config: pointer to config data structure
+ * @sensor_id: sensor id
+ * return: 0 - no error, <0 error
+ */
+static int goodix_parse_dt_cfg(struct goodix_ts_device *dev,
+ char *cfg_type, struct goodix_ts_config *config,
+ unsigned int sensor_id)
+{
+ struct device_node *node = dev->dev->of_node;
+ struct goodix_ts_board_data *ts_bdata = dev->board_data;
+ struct property *prop = NULL;
+ char of_node_name[24];
+ unsigned int len = 0;
+ u16 checksum;
+
+ BUG_ON(config == NULL);
+ if (sensor_id > TS_MAX_SENSORID) {
+ ts_err("Invalid sensor id");
+ return -EINVAL;
+ }
+
+ if (config->initialized) {
+ ts_info("Config already initialized");
+ return 0;
+ }
+
+ /*
+ * config data are located in child node called
+ * 'sensorx', x is the sensor ID got from touch
+ * device.
+ */
+ snprintf(of_node_name, sizeof(of_node_name),
+ "sensor%u", sensor_id);
+ node = of_get_child_by_name(node, of_node_name);
+ if (!node) {
+ ts_err("Child property[%s] not found",
+ of_node_name);
+ return -EINVAL;
+ }
+
+ prop = of_find_property(node, cfg_type, &len);
+ if (!prop || !prop->value || len == 0
+ || len > TS_CFG_MAX_LEN || len % 2 != 1) {
+ ts_err("Invalid cfg type%s, size:%u", cfg_type, len);
+ return -EINVAL;
+ }
+
+ config->length = len;
+
+ mutex_init(&config->lock);
+ mutex_lock(&config->lock);
+
+ memcpy(config->data, prop->value, len);
+
+ /* modify max-x max-y resolution, little-endian */
+ config->data[CFG_XMAX_OFFSET] = (u8)ts_bdata->panel_max_x;
+ config->data[CFG_XMAX_OFFSET + 1] = (u8)(ts_bdata->panel_max_x >> 8);
+ config->data[CFG_YMAX_OFFSET] = (u8)ts_bdata->panel_max_y;
+ config->data[CFG_YMAX_OFFSET + 1] = (u8)(ts_bdata->panel_max_y >> 8);
+
+ /*
+ * checksum: u16 little-endian format
+ * the last byte of config is the config update flag
+ */
+ checksum = checksum_le16(config->data, len - 3);
+ checksum = 0 - checksum;
+ config->data[len - 3] = (u8)checksum;
+ config->data[len - 2] = (u8)(checksum >> 8 & 0xff);
+ config->data[len - 1] = 0x01;
+
+ strlcpy(config->name, cfg_type, sizeof(config->name));
+ config->reg_base = TS_REG_CFG_BASE;
+ config->delay = 0;
+ config->initialized = true;
+ mutex_unlock(&config->lock);
+
+ ts_info("Config name:%s,ver:%02xh,size:%d,checksum:%04xh",
+ config->name, config->data[0],
+ config->length, checksum);
+ return 0;
+}
+
+/**
+ * goodix_parse_customize_params - parse sensor independent params
+ * @dev: pointer to device data
+ * @board_data: board data
+ * @sensor_id: sensor ID
+ * return: 0 - read ok, < 0 - i2c transter error
+ */
+static int goodix_parse_customize_params(struct goodix_ts_device *dev,
+ struct goodix_ts_board_data *board_data,
+ unsigned int sensor_id)
+{
+ struct device_node *node = dev->dev->of_node;
+ char of_node_name[24];
+ int r;
+
+ if (sensor_id > TS_MAX_SENSORID || node == NULL) {
+ ts_err("Invalid sensor id");
+ return -EINVAL;
+ }
+
+ /* parse sensor independent parameters */
+ snprintf(of_node_name, sizeof(of_node_name),
+ "sensor%u", sensor_id);
+ node = of_find_node_by_name(dev->dev->of_node, of_node_name);
+ if (!node) {
+ ts_err("Child property[%s] not found", of_node_name);
+ return -EINVAL;
+ }
+
+ /* sensor independent resolutions */
+ r = goodix_parse_dt_resolution(node, board_data);
+ return r;
+}
+#endif
+
+/**
+ * goodix_i2c_read - read device register through i2c bus
+ * @dev: pointer to device data
+ * @addr: register address
+ * @data: read buffer
+ * @len: bytes to read
+ * return: 0 - read ok, < 0 - i2c transter error
+ */
+static int goodix_i2c_read(struct goodix_ts_device *dev, unsigned int reg,
+ unsigned char *data, unsigned int len)
+{
+ struct i2c_client *client = to_i2c_client(dev->dev);
+ unsigned int transfer_length = 0;
+ unsigned int pos = 0, address = reg;
+ unsigned char get_buf[64], addr_buf[2];
+ int retry, r = 0;
+ struct i2c_msg msgs[] = {
+ {
+ .addr = client->addr,
+ .flags = !I2C_M_RD,
+ .buf = &addr_buf[0],
+ .len = TS_ADDR_LENGTH,
+ }, {
+ .addr = client->addr,
+ .flags = I2C_M_RD,
+ }
+ };
+
+ if (likely(len < sizeof(get_buf))) {
+ /* code optimize, use stack memory */
+ msgs[1].buf = &get_buf[0];
+ } else {
+ msgs[1].buf = kzalloc(len > I2C_MAX_TRANSFER_SIZE
+ ? I2C_MAX_TRANSFER_SIZE : len, GFP_KERNEL);
+ if (!msgs[1].buf)
+ return -ENOMEM;
+ }
+
+ while (pos != len) {
+ if (unlikely(len - pos > I2C_MAX_TRANSFER_SIZE))
+ transfer_length = I2C_MAX_TRANSFER_SIZE;
+ else
+ transfer_length = len - pos;
+
+ msgs[0].buf[0] = (address >> 8) & 0xFF;
+ msgs[0].buf[1] = address & 0xFF;
+ msgs[1].len = transfer_length;
+
+ for (retry = 0; retry < GOODIX_BUS_RETRY_TIMES; retry++) {
+ if (likely(i2c_transfer(client->adapter, msgs, 2) == 2)) {
+ memcpy(&data[pos], msgs[1].buf, transfer_length);
+ pos += transfer_length;
+ address += transfer_length;
+ break;
+ }
+ ts_info("I2c read retry[%d]:0x%x", retry + 1, reg);
+ msleep(20);
+ }
+ if (unlikely(retry == GOODIX_BUS_RETRY_TIMES)) {
+ ts_err("I2c read failed,dev:%02x,reg:%04x,size:%u",
+ client->addr, reg, len);
+ r = -EBUS;
+ goto read_exit;
+ }
+ }
+
+read_exit:
+ if (unlikely(len >= sizeof(get_buf)))
+ kfree(msgs[1].buf);
+ return r;
+}
+
+/**
+ * goodix_i2c_write - write device register through i2c bus
+ * @dev: pointer to device data
+ * @addr: register address
+ * @data: write buffer
+ * @len: bytes to write
+ * return: 0 - write ok; < 0 - i2c transter error.
+ */
+static int goodix_i2c_write(struct goodix_ts_device *dev, unsigned int reg,
+ unsigned char *data, unsigned int len)
+{
+ struct i2c_client *client = to_i2c_client(dev->dev);
+ unsigned int pos = 0, transfer_length = 0;
+ unsigned int address = reg;
+ unsigned char put_buf[64];
+ int retry, r = 0;
+ struct i2c_msg msg = {
+ .addr = client->addr,
+ .flags = !I2C_M_RD,
+ };
+
+ if (likely(len + TS_ADDR_LENGTH < sizeof(put_buf))) {
+ /* code optimize,use stack memory*/
+ msg.buf = &put_buf[0];
+ } else {
+ msg.buf = kmalloc(len + TS_ADDR_LENGTH > I2C_MAX_TRANSFER_SIZE
+ ? I2C_MAX_TRANSFER_SIZE : len + TS_ADDR_LENGTH, GFP_KERNEL);
+ if (!msg.buf)
+ return -ENOMEM;
+ }
+
+ while (pos != len) {
+ if (unlikely(len - pos > I2C_MAX_TRANSFER_SIZE - TS_ADDR_LENGTH))
+ transfer_length = I2C_MAX_TRANSFER_SIZE - TS_ADDR_LENGTH;
+ else
+ transfer_length = len - pos;
+
+ msg.buf[0] = (unsigned char)((address >> 8) & 0xFF);
+ msg.buf[1] = (unsigned char)(address & 0xFF);
+ msg.len = transfer_length + 2;
+ memcpy(&msg.buf[2], &data[pos], transfer_length);
+
+ for (retry = 0; retry < GOODIX_BUS_RETRY_TIMES; retry++) {
+ if (likely(i2c_transfer(client->adapter, &msg, 1) == 1)) {
+ pos += transfer_length;
+ address += transfer_length;
+ break;
+ }
+ ts_info("I2c write retry[%d]", retry + 1);
+ msleep(20);
+ }
+ if (unlikely(retry == GOODIX_BUS_RETRY_TIMES)) {
+ ts_err("I2c write failed,dev:%02x,reg:%04x,size:%u",
+ client->addr, reg, len);
+ r = -EBUS;
+ goto write_exit;
+ }
+ }
+
+write_exit:
+ if (likely(len + TS_ADDR_LENGTH >= sizeof(put_buf)))
+ kfree(msg.buf);
+ return r;
+}
+
+static int goodix_read_version(struct goodix_ts_device *dev,
+ struct goodix_ts_version *version)
+{
+ u8 buffer[12];
+ int r;
+
+ r = goodix_i2c_read(dev, TS_REG_VERSION,
+ buffer, sizeof(buffer));
+ if (r < 0) {
+ ts_err("Read chip version failed");
+ if (version)
+ version->valid = false;
+ return r;
+ }
+
+ /* if checksum is right and first 4 bytes are not invalid value */
+ if (checksum_u8(buffer, sizeof(buffer)) == 0 &&
+ isalnum(buffer[0]) && isalnum(buffer[1]) &&
+ isalnum(buffer[2]) && isalnum(buffer[3])) {
+ if (version) {
+ memcpy(&version->pid[0], buffer, 4);
+ version->pid[4] = '\0';
+ version->cid = buffer[4];
+ /* vid = main version + minor version */
+ version->vid = (buffer[5] << 8) + buffer[6];
+ version->sensor_id = buffer[10] & 0x0F;
+ version->valid = true;
+
+ if (version->cid)
+ ts_info("PID:%s,CID: %c,VID:%04x,SensorID:%u",
+ version->pid, version->cid + 'A' - 1,
+ version->vid, version->sensor_id);
+ else
+ ts_info("PID:%s,VID:%04x,SensorID:%u",
+ version->pid, version->vid,
+ version->sensor_id);
+ }
+ } else {
+ ts_err("Checksum error:%*ph", (int)sizeof(buffer), buffer);
+ /* mark this version is invalid */
+ if (version)
+ version->valid = false;
+ r = -EINVAL;
+ }
+
+ return r;
+}
+
+/**
+ * goodix_send_config - send config data to device.
+ * @dev: pointer to device
+ * @config: pointer to config data struct to be send
+ * @return: 0 - succeed, < 0 - failed
+ */
+static int goodix_send_config(struct goodix_ts_device *dev,
+ struct goodix_ts_config *config)
+{
+ int r = 0;
+
+ if (!config || !config->data) {
+ ts_err("Null config data");
+ return -EINVAL;
+ }
+
+ ts_info("Send %s,ver:%02xh,size:%d",
+ config->name, config->data[0],
+ config->length);
+
+ mutex_lock(&config->lock);
+ r = goodix_i2c_write(dev, config->reg_base,
+ config->data, config->length);
+ if (r)
+ goto exit;
+
+ /* make sure the firmware accept the config data*/
+ if (config->delay)
+ msleep(config->delay);
+exit:
+ mutex_unlock(&config->lock);
+ return r;
+}
+
+static inline int goodix_cmds_init(struct goodix_ts_device *ts_dev)
+{
+ /* low power mode command */
+ ts_dev->sleep_cmd.cmd_reg = TS_REG_CMD;
+ ts_dev->sleep_cmd.length = 3;
+ ts_dev->sleep_cmd.cmds[0] = 0x05;
+ ts_dev->sleep_cmd.cmds[1] = 0x0;
+ ts_dev->sleep_cmd.cmds[2] = 0 - 0x05;
+ ts_dev->sleep_cmd.initialized = true;
+
+ return 0;
+}
+
+/**
+ * goodix_hw_init - hardware initialize
+ * Called by touch core module when bootup
+ * @ts_dev: pointer to touch device
+ * return: 0 - no error, <0 error
+ */
+static int goodix_hw_init(struct goodix_ts_device *ts_dev)
+{
+ int r;
+
+ BUG_ON(!ts_dev);
+ goodix_cmds_init(ts_dev);
+
+ /* goodix_hw_init may be called many times */
+ if (!ts_dev->normal_cfg) {
+ ts_dev->normal_cfg = devm_kzalloc(ts_dev->dev,
+ sizeof(*ts_dev->normal_cfg), GFP_KERNEL);
+ if (!ts_dev->normal_cfg) {
+ ts_err("Failed to alloc memory for normal cfg");
+ return -ENOMEM;
+ }
+ }
+
+ /* read chip version: PID/VID/sensor ID,etc.*/
+ r = goodix_read_version(ts_dev, &ts_dev->chip_version);
+ if (r < 0)
+ return r;
+
+#ifdef CONFIG_OF
+ /* devicetree property like resolution(panel_max_xxx)
+ * may be different between sensors, here we try to parse
+ * parameters form sensor child node
+ */
+ r = goodix_parse_customize_params(ts_dev,
+ ts_dev->board_data,
+ ts_dev->chip_version.sensor_id);
+ if (r < 0)
+ ts_info("Cann't find customized parameters");
+
+ /* lonzo debug */
+ ts_dev->chip_version.sensor_id = 0;
+
+ /* parse normal-cfg from devicetree node */
+ r = goodix_parse_dt_cfg(ts_dev, "normal-cfg",
+ ts_dev->normal_cfg,
+ ts_dev->chip_version.sensor_id);
+ if (r < 0) {
+ ts_err("Failed to obtain normal-cfg");
+ return r;
+ }
+#endif
+
+ ts_dev->normal_cfg->delay = 500;
+ /* send normal-cfg to firmware */
+ r = goodix_send_config(ts_dev, ts_dev->normal_cfg);
+
+ return r;
+}
+
+/**
+ * goodix_hw_reset - reset device
+ *
+ * @dev: pointer to touch device
+ * Returns 0 - succeed,<0 - failed
+ */
+static int goodix_hw_reset(struct goodix_ts_device *dev)
+{
+ ts_info("HW reset");
+ gpiod_direction_output(dev->board_data->reset_gpiod, 0);
+ udelay(200);
+ gpiod_direction_output(dev->board_data->reset_gpiod, 1);
+ msleep(80);
+ return 0;
+}
+
+/**
+ * goodix_request_handler - handle firmware request
+ *
+ * @dev: pointer to touch device
+ * @request_data: requset information
+ * Returns 0 - succeed,<0 - failed
+ */
+static int goodix_request_handler(struct goodix_ts_device *dev,
+ struct goodix_request_data *request_data) {
+ unsigned char buffer[1];
+ int r;
+
+ r = goodix_i2c_read(dev, TS_REG_REQUEST, buffer, 1);
+ if (r < 0)
+ return r;
+
+ switch (buffer[0]) {
+ case REQUEST_CONFIG:
+ ts_info("HW request config");
+ goodix_send_config(dev, dev->normal_cfg);
+ goto clear_requ;
+ case REQUEST_BAKREF:
+ ts_info("HW request bakref");
+ goto clear_requ;
+ case REQUEST_RESET:
+ ts_info("HW requset reset");
+ goto clear_requ;
+ case REQUEST_MAINCLK:
+ ts_info("HW request mainclk");
+ goto clear_requ;
+ default:
+ ts_info("Unknown hw request:%d", buffer[0]);
+ return 0;
+ }
+
+clear_requ:
+ buffer[0] = 0x00;
+ r = goodix_i2c_write(dev, TS_REG_REQUEST, buffer, 1);
+ return r;
+}
+
+/**
+ * goodix_eventt_handler - handle firmware event
+ *
+ * @dev: pointer to touch device
+ * @ts_event: pointer to touch event structure
+ * Returns 0 - succeed,<0 - failed
+ */
+static int goodix_event_handler(struct goodix_ts_device *dev,
+ struct goodix_ts_event *ts_event)
+{
+#define BYTES_PER_COORD 8
+ struct goodix_touch_data *touch_data =
+ &ts_event->event_data.touch_data;
+ struct goodix_ts_coords *coords = &touch_data->coords[0];
+ int max_touch_num = dev->board_data->panel_max_id;
+ unsigned char buffer[2 + BYTES_PER_COORD * max_touch_num];
+ unsigned char coord_sta;
+ int touch_num = 0, i, r;
+ unsigned char chksum = 0;
+
+ r = goodix_i2c_read(dev, TS_REG_COORDS_BASE,
+ buffer, 3 + BYTES_PER_COORD/* * 1*/);
+ if (unlikely(r < 0))
+ return r;
+
+ /* buffer[0]: event state */
+ coord_sta = buffer[0];
+ if (unlikely(coord_sta == 0x00)) {
+ /* handle request event */
+ ts_event->event_type = EVENT_REQUEST;
+ goodix_request_handler(dev,
+ &ts_event->event_data.request_data);
+ goto exit_clean_sta;
+ } else if (unlikely((coord_sta & 0x80) != 0x80)) {
+ r = -EINVAL;
+ return r;
+ }
+
+ /* bit7 of coord_sta is 1, touch data is ready */
+ /* handle touch event */
+ touch_data->key_value = (coord_sta >> 4) & 0x01;
+ touch_num = coord_sta & 0x0F;
+ if (unlikely(touch_num > max_touch_num)) {
+ touch_num = -EINVAL;
+ goto exit_clean_sta;
+ } else if (unlikely(touch_num > 1)) {
+ r = goodix_i2c_read(dev,
+ TS_REG_COORDS_BASE + 3 + BYTES_PER_COORD,
+ &buffer[3 + BYTES_PER_COORD],
+ (touch_num - 1) * BYTES_PER_COORD);
+ if (unlikely(r < 0))
+ goto exit_clean_sta;
+ }
+
+ /* touch_num * BYTES_PER_COORD + 1(touch event state) + 1(checksum)
+ * + 1(key value)
+ */
+ chksum = checksum_u8(&buffer[0], touch_num * BYTES_PER_COORD + 3);
+ if (unlikely(chksum != 0)) {
+ ts_err("Checksum error:%X", chksum);
+ r = -EINVAL;
+ goto exit_clean_sta;
+ }
+
+ memset(touch_data->coords, 0x00, sizeof(touch_data->coords));
+ for (i = 0; i < touch_num; i++) {
+ coords->id = buffer[i * BYTES_PER_COORD + 1] & 0x0f;
+ coords->x = buffer[i * BYTES_PER_COORD + 2] |
+ (buffer[i * BYTES_PER_COORD + 3] << 8);
+ coords->y = buffer[i * BYTES_PER_COORD + 4] |
+ (buffer[i * BYTES_PER_COORD + 5] << 8);
+ coords->w = (buffer[i * BYTES_PER_COORD + 7] << 8)
+ + buffer[i * BYTES_PER_COORD + 6];
+ coords->p = coords->w;
+
+ ts_debug("D:[%d](%d, %d)[%d]", coords->id, coords->x, coords->y,
+ coords->w);
+ coords++;
+ }
+
+ touch_data->touch_num = touch_num;
+ /* mark this event as touch event */
+ ts_event->event_type = EVENT_TOUCH;
+ r = 0;
+
+exit_clean_sta:
+ /* handshake */
+ buffer[0] = 0x00;
+ goodix_i2c_write(dev, TS_REG_COORDS_BASE, buffer, 1);
+ return r;
+}
+
+/**
+ * goodix_send_command - seng cmd to firmware
+ *
+ * @dev: pointer to device
+ * @cmd: pointer to command struct which cotain command data
+ * Returns 0 - succeed,<0 - failed
+ */
+int goodix_send_command(struct goodix_ts_device *dev,
+ struct goodix_ts_cmd *cmd)
+{
+ int ret;
+
+ if (!cmd || !cmd->initialized)
+ return -EINVAL;
+ ret = goodix_i2c_write(dev, cmd->cmd_reg, cmd->cmds,
+ cmd->length);
+ return ret;
+}
+
+/**
+ * goodix_hw_suspend - Let touch deivce stay in lowpower mode.
+ * @dev: pointer to goodix touch device
+ * @return: 0 - succeed, < 0 - failed
+ */
+static int goodix_hw_suspend(struct goodix_ts_device *dev)
+{
+ struct goodix_ts_cmd *sleep_cmd =
+ &dev->sleep_cmd;
+ int r = 0;
+
+ if (sleep_cmd->initialized) {
+ r = goodix_send_command(dev, sleep_cmd);
+ if (!r)
+ ts_info("Chip in sleep mode");
+ } else {
+ ts_err("Uninitialized sleep command");
+ }
+
+ return r;
+}
+
+/**
+ * goodix_hw_resume - Let touch deivce stay in active mode.
+ * @dev: pointer to goodix touch device
+ * @return: 0 - succeed, < 0 - failed
+ */
+static int goodix_hw_resume(struct goodix_ts_device *dev)
+{
+ struct goodix_ts_version ver;
+ int r, retry = GOODIX_BUS_RETRY_TIMES;
+
+ for (; retry--;) {
+ goodix_hw_reset(dev);
+ r = goodix_read_version(dev, &ver);
+ if (!r)
+ break;
+ }
+
+ return r;
+}
+
+/* hardware opeation funstions */
+static const struct goodix_ts_hw_ops hw_i2c_ops = {
+ .init = goodix_hw_init,
+ .read = goodix_i2c_read,
+ .write = goodix_i2c_write,
+ .reset = goodix_hw_reset,
+ .event_handler = goodix_event_handler,
+ .send_config = goodix_send_config,
+ .send_cmd = goodix_send_command,
+ .read_version = goodix_read_version,
+ .suspend = goodix_hw_suspend,
+ .resume = goodix_hw_resume,
+};
+
+static struct platform_device *goodix_pdev;
+static void goodix_pdev_release(struct device *dev)
+{
+ kfree(goodix_pdev);
+}
+
+static int goodix_i2c_probe(struct i2c_client *client,
+ const struct i2c_device_id *dev_id)
+{
+ struct goodix_ts_device *ts_device = NULL;
+ struct goodix_ts_board_data *ts_bdata = NULL;
+ int r = 0;
+
+ r = i2c_check_functionality(client->adapter,
+ I2C_FUNC_I2C);
+ if (!r)
+ return -EIO;
+
+ /* board data */
+ ts_bdata = devm_kzalloc(&client->dev,
+ sizeof(struct goodix_ts_board_data), GFP_KERNEL);
+ if (!ts_bdata)
+ return -ENOMEM;
+
+#ifdef CONFIG_OF
+ if (IS_ENABLED(CONFIG_OF) && client->dev.of_node) {
+ /* parse devicetree property */
+ r = goodix_parse_dt(client->dev.of_node, ts_bdata);
+ if (r < 0)
+ return r;
+ } else
+#endif
+ {
+ /* use platform data */
+ ts_info("Finally use platform data");
+ devm_kfree(&client->dev, ts_bdata);
+ ts_bdata = client->dev.platform_data;
+ }
+
+ if (!ts_bdata)
+ return -ENODEV;
+
+ ts_device = devm_kzalloc(&client->dev,
+ sizeof(struct goodix_ts_device), GFP_KERNEL);
+ if (!ts_device)
+ return -ENOMEM;
+
+ ts_device->name = "GTx5 TouchDevcie";
+ ts_device->dev = &client->dev;
+ ts_device->board_data = ts_bdata;
+ ts_device->hw_ops = &hw_i2c_ops;
+
+ /* ts core device */
+ goodix_pdev = kzalloc(sizeof(struct platform_device), GFP_KERNEL);
+ if (!goodix_pdev)
+ return -ENOMEM;
+
+ goodix_pdev->name = GOODIX_CORE_DRIVER_NAME;
+ goodix_pdev->id = 0;
+ goodix_pdev->num_resources = 0;
+ /*
+ * you could find this platform dev in
+ * /sys/devices/platform/goodix_ts.0
+ * goodix_pdev->dev.parent = &client->dev;
+ */
+ goodix_pdev->dev.platform_data = ts_device;
+ goodix_pdev->dev.release = goodix_pdev_release;
+
+ /* register platform device, then the goodix_ts_core module will probe
+ * the touch deivce.
+ */
+ r = platform_device_register(goodix_pdev);
+ return r;
+}
+
+static int goodix_i2c_remove(struct i2c_client *client)
+{
+ platform_device_unregister(goodix_pdev);
+ return 0;
+}
+
+#ifdef CONFIG_OF
+static const struct of_device_id i2c_matchs[] = {
+ {.compatible = TS_DT_COMPATIBLE,},
+ {},
+};
+MODULE_DEVICE_TABLE(of, i2c_matchs);
+#endif
+
+static const struct i2c_device_id i2c_id_table[] = {
+ {TS_DRIVER_NAME, 0},
+ {},
+};
+MODULE_DEVICE_TABLE(i2c, i2c_id_table);
+
+static struct i2c_driver goodix_i2c_driver = {
+ .driver = {
+ .name = TS_DRIVER_NAME,
+ .owner = THIS_MODULE,
+ .of_match_table = of_match_ptr(i2c_matchs),
+ },
+ .probe = goodix_i2c_probe,
+ .remove = goodix_i2c_remove,
+ .id_table = i2c_id_table,
+};
+
+static int __init goodix_i2c_init(void)
+{
+ ts_info("GTx5xx HW layer init");
+ return i2c_add_driver(&goodix_i2c_driver);
+}
+
+static void __exit goodix_i2c_exit(void)
+{
+ i2c_del_driver(&goodix_i2c_driver);
+}
+
+module_init(goodix_i2c_init);
+module_exit(goodix_i2c_exit);
+
+MODULE_DESCRIPTION("Goodix GTx5 Touchscreen Hardware Module");
+MODULE_AUTHOR("Goodix, Inc.");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/goodix-ts-sunrise/goodix_gtx5_update.c b/drivers/input/touchscreen/goodix-ts-sunrise/goodix_gtx5_update.c
new file mode 100755
index 0000000..5828694
--- /dev/null
+++ b/drivers/input/touchscreen/goodix-ts-sunrise/goodix_gtx5_update.c
@@ -0,0 +1,1453 @@
+/*
+ * Goodix GTX5 Firmware Update Driver.
+ *
+ * Copyright (C) 2015 - 2016 Goodix, Inc.
+ * Authors: Wang Yafei <wangyafei@...dix.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be a reference
+ * to you, when you are integrating the GOODiX's CTP IC into your system,
+ * 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.
+ */
+#include "goodix_ts_core.h"
+
+/* COMMON PART - START */
+#define TS_DEFAULT_FIRMWARE "goodix_ts_fw.bin"
+
+#define FW_HEADER_SIZE 256
+#define FW_SUBSYS_INFO_SIZE 8
+#define FW_SUBSYS_INFO_OFFSET 32
+#define FW_SUBSYS_MAX_NUM 24
+#define FW_NAME_MAX 128
+
+#define ISP_MAX_BUFFERSIZE (1024 * 16)
+
+#define HW_REG_CPU_EN 0x4180
+#define HW_REG_ILM_ACCESS 0x50C0
+#define HW_REG_BANK_SELECT 0x50C4
+#define HW_REG_ISP_ADDR 0x8000
+#define HW_REG_ISP_STAT 0x4195
+#define HW_REG_ISP_CMD 0x4196
+#define HW_REG_ISP_PKT_INFO 0xFFF0
+#define HW_REG_ISP_RESULT 0x4197
+#define HW_REG_ISP_BUFFER 0x8000
+#define HW_REG_BOOT_FLAG 0x434C
+#define HW_REG_BOOT_CTRL0 0xF7CC
+#define HW_REG_BOOT_CTRL1 0xF7EC
+#define HW_REG_WDT 0x40B0
+
+#define CPU_CTRL_PENDING 0x00
+#define CPU_CTRL_RUNNING 0x01
+
+#define ISP_STAT_IDLE 0xFF
+#define ISP_STAT_READY 0xAA
+#define ISP_STAT_WRITING 0xCC
+#define ISP_FLASH_ERROR 0xEE
+#define ISP_FLASH_SUCCESS 0xDD
+#define ISP_CMD_PREPARE 0x55
+#define ISP_CMD_FLASH 0xAA
+
+/**
+ * fw_subsys_info - subsytem firmware information
+ * @type: sybsystem type
+ * @size: firmware size
+ * @flash_addr: flash address
+ * @data: firmware data
+ */
+struct fw_subsys_info {
+ u8 type;
+ u32 size;
+ u32 flash_addr;
+ const u8 *data;
+};
+
+#pragma pack(1)
+/**
+ * firmware_info
+ * @size: fw total length
+ * @checksum: checksum of fw
+ * @hw_pid: mask pid string
+ * @hw_pid: mask vid code
+ * @fw_pid: fw pid string
+ * @fw_vid: fw vid code
+ * @subsys_num: number of fw subsystem
+ * @chip_type: chip type
+ * @protocol_ver: firmware packing
+ * protocol version
+ * @subsys: sybsystem info
+ */
+struct firmware_info {
+ u32 size;
+ u16 checksum;
+ u8 hw_pid[6];
+ u8 hw_vid[3];
+ u8 fw_pid[8];
+ u8 fw_vid[3];
+ u8 subsys_num;
+ u8 chip_type;
+ u8 protocol_ver;
+ u8 reserved[3];
+ struct fw_subsys_info subsys[FW_SUBSYS_MAX_NUM];
+};
+
+/**
+ * firmware_packet - firmware packet information
+ * @packet_size: firmware packet size, max 4Kbytes.
+ * @flash_addr: device flash address
+ * @packet_checksum: checksum of the firmware in this packet
+ * @data: pointer to firmware data.
+ */
+struct firmware_packet {
+ u32 packet_size;
+ u32 flash_addr;
+ u32 packet_checksum;
+ const u8 *data;
+};
+#pragma pack()
+
+/**
+ * firmware_data - firmware data structure
+ * @fw_info: firmware infromation
+ * @firmware: firmware data structure
+ */
+struct firmware_data {
+ struct firmware_info fw_info;
+ const struct firmware *firmware;
+};
+
+enum update_status {
+ UPSTA_NOTWORK = 0,
+ UPSTA_PREPARING,
+ UPSTA_UPDATING,
+ UPSTA_ABORT,
+ UPSTA_SUCCESS,
+ UPSTA_FAILED
+};
+
+/**
+ * fw_update_ctrl - structure used to control the
+ * firmware update process
+ * @status: update status
+ * @progress: indicate the progress of update
+ * @allow_reset: control the reset callback
+ * @allow_irq: control the irq callback
+ * @allow_suspend: control the suspend callback
+ * @allow_resume: allow resume callback
+ * @fw_data: firmware data
+ * @ts_dev: touch device
+ * @fw_name: firmware name
+ * @attr_fwimage: sysfs bin attrs, for storing fw image
+ * @fw_from_sysfs: whether the firmware image is loadind
+ * from sysfs
+ */
+struct fw_update_ctrl {
+ enum update_status status;
+ unsigned int progress;
+ bool force_update;
+
+ bool allow_reset;
+ bool allow_irq;
+ bool allow_suspend;
+ bool allow_resume;
+
+ struct firmware_data fw_data;
+ struct goodix_ts_device *ts_dev;
+
+ char fw_name[FW_NAME_MAX];
+ struct bin_attribute attr_fwimage;
+ bool fw_from_sysfs;
+};
+
+static struct goodix_ext_module goodix_fwu_module;
+/**
+ * goodix_parse_firmware - parse firmware header information
+ * and subsystem information from firmware data buffer
+ *
+ * @fw_data: firmware struct, contains firmware header info
+ * and firmware data.
+ * return: 0 - OK, < 0 - error
+ */
+static int goodix_parse_firmware(struct firmware_data *fw_data)
+{
+ const struct firmware *firmware;
+ struct firmware_info *fw_info;
+ unsigned int i, fw_offset, info_offset;
+ u16 checksum;
+ int r = 0;
+
+ if (!fw_data || !fw_data->firmware) {
+ ts_err("Invalid firmware data");
+ return -EINVAL;
+ }
+ fw_info = &fw_data->fw_info;
+
+ /* copy firmware head info */
+ firmware = fw_data->firmware;
+ if (firmware->size < FW_SUBSYS_INFO_OFFSET) {
+ ts_err("Invalid firmware size:%zu", firmware->size);
+ r = -EINVAL;
+ goto err_size;
+ }
+ memcpy(fw_info, firmware->data, FW_SUBSYS_INFO_OFFSET);
+
+ /* check firmware size */
+ fw_info->size = be32_to_cpu(fw_info->size);
+ if (firmware->size != fw_info->size + 6) {
+ ts_err("Bad firmware, size not match");
+ r = -EINVAL;
+ goto err_size;
+ }
+
+ /* calculate checksum, note: sum of bytes, but check by u16 checksum */
+ for (i = 6, checksum = 0; i < firmware->size; i++)
+ checksum += firmware->data[i];
+
+ /* byte order change, and check */
+ fw_info->checksum = be16_to_cpu(fw_info->checksum);
+ if (checksum != fw_info->checksum) {
+ ts_err("Bad firmware, cheksum error");
+ r = -EINVAL;
+ goto err_size;
+ }
+
+ if (fw_info->subsys_num > FW_SUBSYS_MAX_NUM) {
+ ts_err("Bad firmware, invalid subsys num");
+ r = -EINVAL;
+ goto err_size;
+ }
+
+ /* parse subsystem info */
+ fw_offset = FW_HEADER_SIZE;
+ for (i = 0; i < fw_info->subsys_num; i++) {
+ info_offset = FW_SUBSYS_INFO_OFFSET +
+ i * FW_SUBSYS_INFO_SIZE;
+
+ fw_info->subsys[i].type = firmware->data[info_offset];
+ fw_info->subsys[i].size =
+ be32_to_cpup((__be32 *)&firmware->data[info_offset + 1]);
+ fw_info->subsys[i].flash_addr =
+ be16_to_cpup((__be16 *)&firmware->data[info_offset + 5]);
+ fw_info->subsys[i].flash_addr <<= 8; /* important! */
+
+ if (fw_offset > firmware->size) {
+ ts_err("Sybsys offset exceed Firmware size");
+ goto err_size;
+ }
+
+ fw_info->subsys[i].data = firmware->data + fw_offset;
+ fw_offset += fw_info->subsys[i].size;
+ }
+
+ ts_info("Firmware package protocol: V%u", fw_info->protocol_ver);
+ ts_info("Fimware PID:GT%s", fw_info->fw_pid);
+ ts_info("Fimware VID:%02X%02X%02X", fw_info->fw_vid[0],
+ fw_info->fw_vid[1], fw_info->fw_vid[2]);
+ ts_info("Firmware chip type:%02X", fw_info->chip_type);
+ ts_info("Firmware size:%u", fw_info->size);
+ ts_info("Firmware subsystem num:%u", fw_info->subsys_num);
+#ifdef CONFIG_GOODIX_DEBUG
+ for (i = 0; i < fw_info->subsys_num; i++) {
+ ts_debug("------------------------------------------");
+ ts_debug("Index:%d", i);
+ ts_debug("Subsystem type:%02X", fw_info->subsys[i].type);
+ ts_debug("Subsystem size:%u", fw_info->subsys[i].size);
+ ts_debug("Subsystem flash_addr:%08X", fw_info->subsys[i].flash_addr);
+ ts_debug("Subsystem Ptr:%p", fw_info->subsys[i].data);
+ }
+ ts_debug("------------------------------------------");
+#endif
+
+err_size:
+ return r;
+}
+
+/**
+ * goodix_check_update - compare the version of firmware running in
+ * touch device with the version getting from the firmware file.
+ * @fw_info: firmware information to be compared
+ * return: 0 firmware in the touch device needs to be updated
+ * < 0 no need to update firmware
+ */
+static int goodix_check_update(struct goodix_ts_device *dev,
+ const struct firmware_info *fw_info)
+{
+ struct goodix_ts_version fw_ver = {0};
+ u16 fwimg_vid;
+ u8 fwimg_cid;
+ int r = 0;
+
+ /* read version from chip, if we got invalid firmware version, maybe
+ * fimware in flash is incorrect, so we need to update firmware
+ */
+ r = dev->hw_ops->read_version(dev, &fw_ver);
+ if (r == -EBUS)
+ return r;
+
+ if (fw_ver.valid) {
+ if (memcmp(fw_ver.pid, fw_info->fw_pid, 4)) {
+ ts_err("Product ID is not match");
+ return -EPERM;
+ }
+
+ fwimg_cid = fw_info->fw_vid[0];
+ fwimg_vid = fw_info->fw_vid[1] << 8 | fw_info->fw_vid[2];
+ if (fw_ver.vid == fwimg_vid && fw_ver.cid == fwimg_cid) {
+ ts_err("FW version is equal to the IC's");
+ return -EPERM;
+ } else if (fw_ver.vid > fwimg_vid) {
+ ts_info("Warning: fw version is lower the IC's");
+ }
+ } /* else invalid firmware, update firmware */
+
+ ts_info("Firmware needs to be updated");
+ return 0;
+}
+
+/**
+ * goodix_reg_write_confirm - write register and confirm the value
+ * in the register.
+ * @dev: pointer to touch device
+ * @addr: register address
+ * @data: pointer to data buffer
+ * @len: data length
+ * return: 0 write success and confirm ok
+ * < 0 failed
+ */
+static int goodix_reg_write_confirm(struct goodix_ts_device *dev,
+ unsigned int addr, unsigned char *data, unsigned int len)
+{
+ u8 *cfm, cfm_buf[32];
+ int r, i;
+
+ if (len > sizeof(cfm_buf)) {
+ cfm = kzalloc(len, GFP_KERNEL);
+ if (!cfm) {
+ ts_err("Mem alloc failed");
+ return -ENOMEM;
+ }
+ } else {
+ cfm = &cfm_buf[0];
+ }
+
+ for (i = 0; i < GOODIX_BUS_RETRY_TIMES; i++) {
+ r = dev->hw_ops->write(dev, addr, data, len);
+ if (r < 0)
+ goto exit;
+
+ r = dev->hw_ops->read(dev, addr, cfm, len);
+ if (r < 0)
+ goto exit;
+
+ if (memcmp(data, cfm, len)) {
+ r = -EMEMCMP;
+ continue;
+ } else {
+ r = 0;
+ break;
+ }
+ }
+
+exit:
+ if (cfm != &cfm_buf[0])
+ kfree(cfm);
+ return r;
+}
+
+static inline int goodix_reg_write(struct goodix_ts_device *dev,
+ unsigned int addr, unsigned char *data, unsigned int len)
+{
+ return dev->hw_ops->write(dev, addr, data, len);
+}
+
+static inline int goodix_reg_read(struct goodix_ts_device *dev,
+ unsigned int addr, unsigned char *data, unsigned int len)
+{
+ return dev->hw_ops->read(dev, addr, data, len);
+}
+
+/**
+ * goodix_cpu_ctrl - Let cpu stay in pending state or running state
+ * @dev: pointer to touch device
+ * @flag: control flag, which can be:
+ * CPU_CTRL_PENDING - Pending cpu
+ * Other type of control to cpu is not support.
+ * return: 0 OK, < 0 Failed, -EAGAIN try again
+ */
+static int goodix_cpu_ctrl(struct goodix_ts_device *dev, int flag)
+{
+ u8 ctrl;
+ int r;
+
+ if (flag == CPU_CTRL_PENDING) {
+ ts_info("Pending CPU");
+ ctrl = 0x04;
+ } else if (flag == CPU_CTRL_RUNNING) {
+ ts_info("Running CPU");
+ ctrl = 0x00;
+ } else {
+ ts_err("Invalid cpu ctrl flag");
+ return -EPERM;
+ }
+
+ /* Pending Cpu */
+ r = goodix_reg_write_confirm(dev, HW_REG_CPU_EN, &ctrl, 1);
+ if (unlikely(r < 0)) {
+ ts_err("CPU ctrl failed:%d", r);
+ r = -EAGAIN; /* hw reset and try again */
+ }
+
+ return r;
+}
+
+/**
+ * goodix_isp_wait_stat - waitting ISP state
+ * @dev: pointer to touch device
+ * @state: state to wait
+ * return: 0 - ok, < 0 error, -ETIMEOUT timeout
+ */
+static int goodix_isp_wait_stat(struct goodix_ts_device *dev, u16 state)
+{
+ static u8 last_state;
+ u8 isp_state;
+ int i, r, err_cnt = 0;
+
+ for (i = 0; i < 200; i++) {
+ /* read isp state */
+ r = goodix_reg_read(dev, HW_REG_ISP_STAT,
+ &isp_state, 1);
+ if (r < 0) {
+ ts_err("Failed to read ISP state");
+ if (++err_cnt > GOODIX_BUS_RETRY_TIMES)
+ return r;
+ continue;
+ }
+ err_cnt = 0;
+
+ if (isp_state != last_state) {
+ switch (isp_state) {
+ case ISP_STAT_IDLE:
+ ts_info("ISP state: Idle");
+ break;
+ case ISP_STAT_WRITING:
+ ts_info("ISP state: Writing...");
+ break;
+ case ISP_STAT_READY:
+ ts_info("ISP state: Ready to write");
+ break;
+ default:
+ ts_err("ISP state: Unknown");
+ break;
+ }
+ }
+
+ last_state = isp_state;
+ r = -ETIMEOUT;
+ if (isp_state == state) {
+ r = 0;
+ break;
+ }
+
+ usleep_range(5000, 5010);
+ }
+
+ return r;
+}
+
+/**
+ * goodix_isp_flash_done - check whether flash is successful
+ * @dev: pointer to touch device
+ * return: 0 - ok, < 0 error
+ */
+static int goodix_isp_flash_done(struct goodix_ts_device *dev)
+{
+ u8 isp_result;
+ int r, i;
+
+ for (i = 0; i < 2; i++) {
+ r = goodix_reg_read(dev, HW_REG_ISP_RESULT,
+ &isp_result, 1);
+ if (r < 0) {
+ /* bus error */
+ break;
+ } else if (isp_result == ISP_FLASH_SUCCESS) {
+ ts_info("ISP result: OK!");
+ r = 0;
+ break;
+ } else if (isp_result == ISP_FLASH_ERROR) {
+ ts_err("ISP result: ERROR!");
+ r = -EAGAIN;
+ }
+ }
+ return r;
+}
+
+/**
+ * goodix_isp_command - communication with ISP.
+ * @cmd: ISP command.
+ * return: 0 ok, <0 error
+ */
+static int goodix_isp_command(struct goodix_ts_device *dev, u8 cmd)
+{
+ switch (cmd) {
+ case ISP_CMD_PREPARE:
+ break;
+ case ISP_CMD_FLASH:
+ break;
+ default:
+ ts_err("Invalid ISP cmd");
+ return -EINVAL;
+ }
+
+ return goodix_reg_write(dev, HW_REG_ISP_CMD, &cmd, 1);
+}
+
+/**
+ * goodix_load_isp - load ISP program to deivce ram
+ * @dev: pointer to touch device
+ * @fw_data: firmware data
+ * return 0 ok, <0 error
+ */
+static inline int goodix_load_isp(struct goodix_ts_device *dev,
+ struct firmware_data *fw_data)
+{
+ struct fw_subsys_info *fw_isp;
+ int r;
+
+ fw_isp = &fw_data->fw_info.subsys[0];
+
+ ts_info("Loading ISP program");
+ r = goodix_reg_write_confirm(dev, HW_REG_ISP_ADDR,
+ (u8 *)fw_isp->data, fw_isp->size);
+ if (r < 0)
+ ts_err("Loading ISP error");
+
+ return r;
+}
+
+/**
+ * goodix_enter_update - update prepare, loading ISP program
+ * and make sure the ISP is running.
+ * @fwu_ctrl: pointer to fimrware control structure
+ * return: 0 ok, <0 error
+ */
+static int goodix_update_prepare(struct fw_update_ctrl *fwu_ctrl)
+{
+ struct goodix_ts_device *ts_dev = fwu_ctrl->ts_dev;
+ u8 boot_val0[4] = {0xb8, 0x3f, 0x35, 0x56};
+ u8 boot_val1[4] = {0xb9, 0x3e, 0xb5, 0x54};
+ u8 reg_val[4] = {0x00};
+ int r;
+
+ fwu_ctrl->allow_reset = true;
+ r = ts_dev->hw_ops->reset(ts_dev);
+ if (r < 0)
+ return r;
+ fwu_ctrl->allow_reset = false;
+
+ /* enable ILM access */
+ reg_val[0] = 0x06;
+ r = goodix_reg_write_confirm(ts_dev, HW_REG_ILM_ACCESS,
+ reg_val, 1);
+ if (r < 0) {
+ ts_err("Failed to enable ILM access");
+ return r;
+ }
+
+ /* Pending CPU */
+ r = goodix_cpu_ctrl(ts_dev, CPU_CTRL_PENDING);
+ if (r < 0)
+ return r;
+
+ /* disable watchdog timer */
+ reg_val[0] = 0x00;
+ r = goodix_reg_write_confirm(ts_dev, HW_REG_WDT,
+ reg_val, 1);
+ if (r < 0) {
+ ts_err("Failed to disable watchdog");
+ return r;
+ }
+
+ /* select bank 2 */
+ reg_val[0] = 0x02;
+ r = goodix_reg_write_confirm(ts_dev, HW_REG_BANK_SELECT,
+ reg_val, 1);
+ if (r < 0) {
+ ts_err("Failed to select bank2");
+ return r;
+ }
+
+ /* load ISP code */
+ r = goodix_load_isp(ts_dev, &fwu_ctrl->fw_data);
+ if (r < 0)
+ return r;
+
+ /* Clear ISP state */
+ reg_val[0] = reg_val[1] = 0x00;
+ r = goodix_reg_write_confirm(ts_dev, HW_REG_ISP_STAT,
+ reg_val, 2);
+ if (r < 0) {
+ ts_err("Failed to clear ISP state");
+ return r;
+ }
+
+ /* set boot flag */
+ reg_val[0] = 0;
+ r = goodix_reg_write_confirm(ts_dev, HW_REG_BOOT_FLAG,
+ reg_val, 1);
+ if (r < 0) {
+ ts_err("Failed to set boot flag");
+ return r;
+ }
+
+ /* set boot from sRam */
+ r = goodix_reg_write_confirm(ts_dev, HW_REG_BOOT_CTRL0,
+ boot_val0, sizeof(boot_val0));
+ if (r < 0) {
+ ts_err("Failed to set boot flag");
+ return r;
+ }
+
+ /* set boot from sRam */
+ r = goodix_reg_write_confirm(ts_dev, HW_REG_BOOT_CTRL1,
+ boot_val1, sizeof(boot_val1));
+ if (r < 0) {
+ ts_err("Failed to set boot flag");
+ return r;
+ }
+
+ /* disbale ILM access */
+ reg_val[0] = 0x00;
+ r = goodix_reg_write_confirm(ts_dev, HW_REG_ILM_ACCESS,
+ reg_val, 1);
+ if (r < 0) {
+ ts_err("Failed to disable ILM access");
+ return r;
+ }
+
+ /* Release CPU */
+ r = goodix_cpu_ctrl(ts_dev, CPU_CTRL_RUNNING);
+ if (r < 0)
+ return r;
+
+ /* wait isp idel */
+ r = goodix_isp_wait_stat(ts_dev, ISP_STAT_IDLE);
+ if (r < 0) {
+ ts_err("Wait ISP IDLE timeout");
+ return r;
+ }
+
+ return r;
+}
+
+/**
+ * goodix_write_fwdata - write firmware data to ISP buffer
+ * @dev: pointer to touch device
+ * @fw_data: firmware data
+ * @size: size of data, size can not exceed ISP_MAX_BUFFERSIZE
+ * + checksum size{2},
+ * return: 0 ok, <0 error
+ */
+static int goodix_write_fwdata(struct goodix_ts_device *dev,
+ const u8 *fw_data, u32 size)
+{
+ if (!fw_data || size > ISP_MAX_BUFFERSIZE)
+ return -EINVAL;
+
+ return goodix_reg_write(dev, HW_REG_ISP_BUFFER,
+ (u8 *)fw_data, size);
+}
+
+/**
+ * goodix_format_fw_packet - formate one flash packet
+ * @pkt: target firmware packet
+ * @flash_addr: flash address
+ * @size: packet size
+ * @data: packet data
+ */
+static int goodix_format_fw_packet(struct firmware_packet *pkt,
+ u32 flash_addr, u32 size, const u8 *data)
+{
+ if (!pkt || !data || size % 4)
+ return -EINVAL;
+
+ /*
+ * checksum rule:sum of data in one format is equal to zero
+ * data format: byte/le16/be16/le32/be32/le64/be64
+ */
+ pkt->flash_addr = cpu_to_le32(flash_addr);
+ pkt->packet_size = cpu_to_le32(size);
+ pkt->packet_checksum = checksum_le32((u8 *)data, size);
+ pkt->data = data;
+ return 0;
+}
+
+/**
+ * goodix_send_fw_packet - send one firmware packet to ISP
+ * @dev: target touch device
+ * @pkt: firmware packet
+ * return：0 ok, <0 error
+ */
+static int goodix_send_fw_packet(struct goodix_ts_device *dev,
+ struct firmware_packet *pkt)
+{
+ u8 pkt_info[12];
+ int r;
+
+ if (!pkt)
+ return -EINVAL;
+
+ /* 1: wait ISP idle */
+ r = goodix_isp_wait_stat(dev, ISP_STAT_IDLE);
+ if (r < 0)
+ return r;
+
+ /* 2: write packet information */
+ memcpy(pkt_info, pkt, sizeof(pkt_info));
+ r = goodix_reg_write(dev, HW_REG_ISP_PKT_INFO,
+ pkt_info, sizeof(pkt_info));
+ if (r < 0) {
+ ts_err("Failed to write packet info");
+ return r;
+ }
+
+ /* 3: Make ISP ready to flash */
+ r = goodix_isp_command(dev, ISP_CMD_PREPARE);
+ if (r < 0) {
+ ts_err("Failed to make ISP ready");
+ return r;
+ }
+
+ /* 4: write packet data(firmware block) to ISP buffer */
+ r = goodix_write_fwdata(dev, pkt->data, pkt->packet_size);
+ if (r < 0) {
+ ts_err("Failed to write firmware packet");
+ return r;
+ }
+
+ /* 5: wait ISP ready */
+ r = goodix_isp_wait_stat(dev, ISP_STAT_READY);
+ if (r < 0) {
+ ts_err("Failed to wait ISP ready");
+ return r;
+ }
+
+ /* 6: start writting to flash */
+ r = goodix_isp_command(dev, ISP_CMD_FLASH);
+ if (r < 0) {
+ ts_err("Failed to start flash");
+ return r;
+ }
+
+ /* 7: wait idle */
+ r = goodix_isp_wait_stat(dev, ISP_STAT_IDLE);
+ if (r < 0) {
+ ts_err("Error occurred when wait ISP idle");
+ return r;
+ };
+
+ /* check ISP result */
+ r = goodix_isp_flash_done(dev);
+ if (r < 0) {
+ ts_err("Flash fw packet failed:%d", r);
+ return r;
+ }
+
+ return 0;
+}
+
+/**
+ * goodix_flash_subsystem - flash subsystem firmware,
+ * Main flow of flashing firmware.
+ * Each firmware subsystem is divided into several
+ * packets, the max size of packet is limited to
+ * @{ISP_MAX_BUFFERSIZE}
+ * @dev: pointer to touch device
+ * @subsys: subsystem information
+ * return: 0 ok, < 0 error
+ */
+static int goodix_flash_subsystem(struct goodix_ts_device *dev,
+ struct fw_subsys_info *subsys)
+{
+ struct firmware_packet fw_pkt;
+ u32 data_size, total_size, offset;
+ int r = 0;
+
+ /*
+ * if bus(i2c/spi) error occued, then exit, we will do
+ * hardware reset and re-prepare ISP and then retry
+ * flashing
+ */
+ total_size = subsys->size;
+ offset = 0;
+ while (total_size > 0) {
+ data_size = total_size > ISP_MAX_BUFFERSIZE ?
+ ISP_MAX_BUFFERSIZE : total_size;
+ ts_info("Flash firmware to %08x,size:%u bytes",
+ subsys->flash_addr + offset, data_size);
+
+ /* format one firmware packet */
+ r = goodix_format_fw_packet(&fw_pkt, subsys->flash_addr + offset,
+ data_size, &subsys->data[offset]);
+ if (r < 0) {
+ ts_err("Invalid packet params");
+ goto exit;
+ }
+
+ /* send one firmware packet */
+ r = goodix_send_fw_packet(dev, &fw_pkt);
+ if (r < 0) {
+ ts_err("Failed to send firmware packet,err:%d", r);
+ goto exit;
+ }
+
+ offset += data_size;
+ total_size -= data_size;
+ } /* end while */
+
+exit:
+ return r;
+}
+
+/**
+ * goodix_flash_firmware - flash firmware
+ * @dev: pointer to touch device
+ * @fw_data: firmware data
+ * return: 0 ok, < 0 error
+ */
+static int goodix_flash_firmware(struct goodix_ts_device *dev,
+ struct firmware_data *fw_data)
+{
+ struct fw_update_ctrl *fw_ctrl;
+ struct firmware_info *fw_info;
+ struct fw_subsys_info *fw_x;
+ int retry = GOODIX_BUS_RETRY_TIMES;
+ int i, r = 0, fw_num, prog_step;
+
+ /* start from subsystem 1, subsystem 0 is the ISP program */
+ fw_ctrl = container_of(fw_data, struct fw_update_ctrl, fw_data);
+ fw_info = &fw_data->fw_info;
+ fw_num = fw_info->subsys_num;
+
+ /* we have 80% work here */
+ prog_step = 80 / (fw_num - 1);
+
+ for (i = 1; i < fw_num && retry;) {
+ ts_info("--- Start to flash subsystem[%d] ---", i);
+ fw_x = &fw_info->subsys[i];
+ r = goodix_flash_subsystem(dev, fw_x);
+ if (r == 0) {
+ ts_info("--- End flash subsystem[%d]: OK ---", i);
+ fw_ctrl->progress += prog_step;
+ i++;
+ } else if (r == -EAGAIN) {
+ retry--;
+ ts_err("--- End flash subsystem%d: Fail, errno:%d, retry:%d ---",
+ i, r, GOODIX_BUS_RETRY_TIMES - retry);
+ } else if (r < 0) { /* bus error */
+ ts_err("--- End flash subsystem%d: Fatal error:%d exit ---",
+ i, r);
+ goto exit_flash;
+ }
+ }
+
+exit_flash:
+ return r;
+}
+
+/**
+ * goodix_update_finish - update finished, free resource
+ * and reset flags---
+ * @fwu_ctrl: pointer to fw_update_ctrl structrue
+ * return: 0 ok, < 0 error
+ */
+static int goodix_update_finish(struct fw_update_ctrl *fwu_ctrl)
+{
+ struct goodix_ts_version ver;
+ int r = 0;
+
+ fwu_ctrl->ts_dev->hw_ops->reset(fwu_ctrl->ts_dev);
+ r = fwu_ctrl->ts_dev->hw_ops->read_version(fwu_ctrl->ts_dev, &ver);
+ return r;
+}
+
+/**
+ * goodix_fw_update_proc - firmware update process, the entry of
+ * firmware update flow
+ * @fwu_ctrl: firmware control
+ * return: 0 ok, < 0 error
+ */
+int goodix_fw_update_proc(struct fw_update_ctrl *fwu_ctrl)
+{
+#define FW_UPDATE_RETRY 2
+ int retry0 = FW_UPDATE_RETRY, retry1 = FW_UPDATE_RETRY;
+ int r = 0;
+
+ if (fwu_ctrl->status == UPSTA_PREPARING ||
+ fwu_ctrl->status == UPSTA_UPDATING) {
+ ts_err("Firmware update already in progress");
+ return -EBUSY;
+ }
+ fwu_ctrl->progress = 0;
+ fwu_ctrl->status = UPSTA_PREPARING;
+ r = goodix_parse_firmware(&fwu_ctrl->fw_data);
+ if (r < 0) {
+ fwu_ctrl->status = UPSTA_ABORT;
+ goto err_parse_fw;
+ }
+ fwu_ctrl->progress = 10;
+ if (fwu_ctrl->force_update == false) {
+ r = goodix_check_update(fwu_ctrl->ts_dev,
+ &fwu_ctrl->fw_data.fw_info);
+ if (r < 0) {
+ fwu_ctrl->status = UPSTA_ABORT;
+ goto err_check_update;
+ }
+ }
+start_update:
+ fwu_ctrl->progress = 20;
+ fwu_ctrl->status = UPSTA_UPDATING; /* show upgrading status */
+ r = goodix_update_prepare(fwu_ctrl);
+ if ((r == -EBUS || r == -EAGAIN) && --retry0 > 0) {
+ ts_err("Bus error, retry prepare ISP:%d",
+ FW_UPDATE_RETRY - retry0);
+ goto start_update;
+ } else if (r < 0) {
+ ts_err("Failed to prepare ISP, exit update:%d", r);
+ fwu_ctrl->status = UPSTA_FAILED;
+ goto err_fw_prepare;
+ }
+ /* progress: 20%~100% */
+ r = goodix_flash_firmware(fwu_ctrl->ts_dev, &fwu_ctrl->fw_data);
+ if ((r == -EBUS || r == -ETIMEOUT) && --retry1 > 0) {
+ /* we will retry[twice] if returns bus error[i2c/spi]
+ * we will do hardware reset and re-prepare ISP and then retry
+ * flashing
+ */
+ ts_err("Bus error, retry firmware update:%d",
+ FW_UPDATE_RETRY - retry1);
+ goto start_update;
+ } else if (r < 0) {
+ ts_err("Fatal error, exit update:%d", r);
+ fwu_ctrl->status = UPSTA_FAILED;
+ goto err_fw_flash;
+ }
+ fwu_ctrl->status = UPSTA_SUCCESS;
+err_fw_flash:
+err_fw_prepare:
+ goodix_update_finish(fwu_ctrl);
+err_check_update:
+err_parse_fw:
+ if (fwu_ctrl->status == UPSTA_SUCCESS)
+ ts_info("Firmware update successfully");
+ else if (fwu_ctrl->status == UPSTA_FAILED)
+ ts_err("Firmware update failed");
+ fwu_ctrl->progress = 100; /* 100% */
+ return r;
+}
+/* COMMON PART - END */
+
+/**
+ * goodix_request_firmware - request firmware data from user space
+ *
+ * @fw_data: firmware struct, contains firmware header info
+ * and firmware data pointer.
+ * return: 0 - OK, < 0 - error
+ */
+static int goodix_request_firmware(struct firmware_data *fw_data,
+ const char *name)
+{
+ struct fw_update_ctrl *fw_ctrl =
+ container_of(fw_data, struct fw_update_ctrl, fw_data);
+ struct device *dev = fw_ctrl->ts_dev->dev;
+ int r;
+
+ ts_info("Request firmware image [%s]", name);
+ r = request_firmware(&fw_data->firmware, name, dev);
+ if (r < 0)
+ ts_err("Firmware image [%s] not available,errno:%d", name, r);
+ else
+ ts_info("Firmware image [%s] is ready", name);
+ return r;
+}
+
+/**
+ * relase firmware resources
+ *
+ */
+static inline void goodix_release_firmware(struct firmware_data *fw_data)
+{
+ if (fw_data->firmware) {
+ release_firmware(fw_data->firmware);
+ fw_data->firmware = NULL;
+ }
+}
+
+static int goodix_fw_update_thread(void *data)
+{
+ struct fw_update_ctrl *fwu_ctrl = data;
+ static DEFINE_MUTEX(fwu_lock);
+ int r = -EINVAL;
+
+ if (!fwu_ctrl) {
+ ts_err("Invaid thread params");
+ return r;
+ }
+
+ if (goodix_register_ext_module(&goodix_fwu_module))
+ return -EIO;
+
+ mutex_lock(&fwu_lock);
+ /* judge where to get firmware data */
+ if (!fwu_ctrl->fw_from_sysfs) {
+ r = goodix_request_firmware(&fwu_ctrl->fw_data,
+ fwu_ctrl->fw_name);
+ if (r < 0) {
+ fwu_ctrl->status = UPSTA_ABORT;
+ fwu_ctrl->progress = 100;
+ goto out;
+ }
+ } else {
+ if (!fwu_ctrl->fw_data.firmware) {
+ ts_err("Invalid firmware from sysfs");
+ fwu_ctrl->status = UPSTA_ABORT;
+ fwu_ctrl->progress = 100;
+ r = -EINVAL;
+ goto out;
+ }
+ }
+
+ /* DONT allow reset/irq/suspend/resume during update */
+ fwu_ctrl->allow_irq = false;
+ fwu_ctrl->allow_suspend = false;
+ fwu_ctrl->allow_resume = false;
+ goodix_ts_blocking_notify(NOTIFY_FWUPDATE_START, NULL);
+
+ /* ready to update */
+ r = goodix_fw_update_proc(fwu_ctrl);
+
+ goodix_ts_blocking_notify(NOTIFY_FWUPDATE_END, NULL);
+ fwu_ctrl->allow_reset = true;
+ fwu_ctrl->allow_irq = true;
+ fwu_ctrl->allow_suspend = true;
+ fwu_ctrl->allow_resume = true;
+
+ /* clean */
+ if (!fwu_ctrl->fw_from_sysfs) {
+ goodix_release_firmware(&fwu_ctrl->fw_data);
+ } else {
+ fwu_ctrl->fw_from_sysfs = false;
+ vfree(fwu_ctrl->fw_data.firmware);
+ fwu_ctrl->fw_data.firmware = NULL;
+ }
+
+out:
+ goodix_unregister_ext_module(&goodix_fwu_module);
+ mutex_unlock(&fwu_lock);
+ return r;
+}
+
+/* sysfs attributes */
+static ssize_t goodix_sysfs_update_fw_store(
+ struct goodix_ext_module *module,
+ const char *buf, size_t count)
+{
+ int ret;
+
+ ret = goodix_fw_update_thread(module->priv_data);
+ if (ret) {
+ ts_err("Firmware update failed");
+ count = ret;
+ } else {
+ ts_info("Firmware update succeeded");
+ }
+ return count;
+}
+
+static ssize_t goodix_sysfs_update_progress_show(
+ struct goodix_ext_module *module,
+ char *buf)
+{
+ struct fw_update_ctrl *fw_ctrl = module->priv_data;
+
+ return scnprintf(buf, PAGE_SIZE, "%d\n", fw_ctrl->progress);
+}
+
+static ssize_t goodix_sysfs_update_result_show(
+ struct goodix_ext_module *module,
+ char *buf)
+{
+ char *result = NULL;
+ struct fw_update_ctrl *fw_ctrl = module->priv_data;
+
+ ts_info("result show");
+ switch (fw_ctrl->status) {
+ case UPSTA_NOTWORK:
+ result = "notwork";
+ break;
+ case UPSTA_PREPARING:
+ result = "preparing";
+ break;
+ case UPSTA_UPDATING:
+ result = "upgrading";
+ break;
+ case UPSTA_ABORT:
+ result = "abort";
+ break;
+ case UPSTA_SUCCESS:
+ result = "success";
+ break;
+ case UPSTA_FAILED:
+ result = "failed";
+ break;
+ default:
+ break;
+ }
+
+ return scnprintf(buf, PAGE_SIZE, "%s\n", result);
+}
+
+static ssize_t goodix_sysfs_update_fwversion_show(
+ struct goodix_ext_module *module,
+ char *buf)
+{
+ struct goodix_ts_version fw_ver;
+ struct fw_update_ctrl *fw_ctrl = module->priv_data;
+ int r = 0;
+ char str[5];
+
+ /* read version from chip */
+ r = fw_ctrl->ts_dev->hw_ops->read_version(fw_ctrl->ts_dev,
+ &fw_ver);
+ if (!r) {
+ memcpy(str, fw_ver.pid, 4);
+ str[4] = '\0';
+ return scnprintf(buf, PAGE_SIZE, "PID:%s VID:%04x SENSOR_ID:%d\n",
+ str, fw_ver.vid, fw_ver.sensor_id);
+ }
+ return 0;
+}
+
+static ssize_t goodix_sysfs_fwsize_show(struct goodix_ext_module *module,
+ char *buf)
+{
+ struct fw_update_ctrl *fw_ctrl = module->priv_data;
+ int r = -EINVAL;
+
+ if (fw_ctrl && fw_ctrl->fw_data.firmware)
+ r = snprintf(buf, PAGE_SIZE, "%zu\n",
+ fw_ctrl->fw_data.firmware->size);
+ return r;
+}
+
+static ssize_t goodix_sysfs_fwsize_store(struct goodix_ext_module *module,
+ const char *buf, size_t count)
+{
+ struct fw_update_ctrl *fw_ctrl = module->priv_data;
+ struct firmware *fw;
+ u8 **data;
+ size_t size = 0;
+
+ if (!fw_ctrl)
+ return -EINVAL;
+
+ if (sscanf(buf, "%zu", &size) < 0 || !size) {
+ ts_err("Failed to get fwsize");
+ return -EFAULT;
+ }
+
+ fw = vmalloc(sizeof(*fw) + size);
+ if (!fw)
+ return -ENOMEM;
+
+ memset(fw, 0x00, sizeof(*fw) + size);
+ data = (u8 **)&fw->data;
+ *data = (u8 *)fw + sizeof(struct firmware);
+ fw->size = size;
+ fw_ctrl->fw_data.firmware = fw;
+ fw_ctrl->fw_from_sysfs = true;
+
+ return count;
+}
+
+static ssize_t goodix_sysfs_fwimage_store(struct file *file,
+ struct kobject *kobj, struct bin_attribute *attr,
+ char *buf, loff_t pos, size_t count)
+{
+ struct fw_update_ctrl *fw_ctrl;
+ struct firmware_data *fw_data;
+
+ fw_ctrl = container_of(attr, struct fw_update_ctrl,
+ attr_fwimage);
+ fw_data = &fw_ctrl->fw_data;
+
+ if (!fw_data->firmware) {
+ ts_err("Need set fw image size first");
+ return -ENOMEM;
+ }
+
+ if (fw_data->firmware->size == 0) {
+ ts_err("Invalid firmware size");
+ return -EINVAL;
+ }
+
+ if (pos + count > fw_data->firmware->size)
+ return -EFAULT;
+
+ memcpy((u8 *)&fw_data->firmware->data[pos], buf, count);
+ fw_ctrl->force_update = true;
+
+ return count;
+}
+
+static ssize_t goodix_sysfs_force_update_store(
+ struct goodix_ext_module *module,
+ const char *buf, size_t count)
+{
+ struct fw_update_ctrl *fw_ctrl = module->priv_data;
+ int val;
+
+ if (kstrtoint(buf, 10, &val))
+ return -EINVAL;
+
+ if (val)
+ fw_ctrl->force_update = true;
+ else
+ fw_ctrl->force_update = false;
+
+ return count;
+}
+
+
+static ssize_t goodix_sysfs_update_hwversion_show(
+ struct goodix_ext_module *module,
+ char *buf)
+{
+ struct goodix_ts_version fw_ver;
+ struct fw_update_ctrl *fw_ctrl = module->priv_data;
+ int r = 0;
+ char str[5];
+
+ /* read version from chip */
+ r = fw_ctrl->ts_dev->hw_ops->read_version(fw_ctrl->ts_dev,
+ &fw_ver);
+ if (!r) {
+ memcpy(str, fw_ver.pid, 4);
+ str[4] = '\0';
+ return scnprintf(buf, PAGE_SIZE, "%s\n", str);
+ }
+ return 0;
+}
+
+static ssize_t goodix_sysfs_update_fw_version_show(
+ struct goodix_ext_module *module,
+ char *buf)
+{
+ struct goodix_ts_version fw_ver;
+ struct fw_update_ctrl *fw_ctrl = module->priv_data;
+ int r = 0;
+
+ /* read version from chip */
+ r = fw_ctrl->ts_dev->hw_ops->read_version(fw_ctrl->ts_dev,
+ &fw_ver);
+ if (!r) {
+ /* firmversion major+minor store formate is 2byte compress BCD */
+ return scnprintf(buf, PAGE_SIZE, "%2x.%2x\n",
+ fw_ver.vid >> 8, fw_ver.vid & 0xff);
+
+ }
+ return 0;
+}
+
+static ssize_t goodix_sysfs_fw_name_store(
+ struct goodix_ext_module *module,
+ const char *buf, size_t count)
+{
+ struct fw_update_ctrl *fwu_ctrl;
+
+ if (!module || !module->priv_data)
+ return -ENOMEM;
+
+ fwu_ctrl = module->priv_data;
+ if (count > FW_NAME_MAX) {
+ ts_err("Firmware name too long");
+ return -EINVAL;
+ }
+ memset(fwu_ctrl->fw_name, 0, FW_NAME_MAX);
+ memcpy(fwu_ctrl->fw_name, buf, count);
+
+ return count;
+}
+
+static struct goodix_ext_attribute goodix_fwu_attrs[] = {
+ __EXTMOD_ATTR(progress, 0444, goodix_sysfs_update_progress_show, NULL),
+ __EXTMOD_ATTR(result, 0444, goodix_sysfs_update_result_show, NULL),
+ __EXTMOD_ATTR(fwversion, 0444, goodix_sysfs_update_fwversion_show, NULL),
+ __EXTMOD_ATTR(fwsize, 0644, goodix_sysfs_fwsize_show,
+ goodix_sysfs_fwsize_store),
+ __EXTMOD_ATTR(force_update, 0200, NULL, goodix_sysfs_force_update_store),
+ __EXTMOD_ATTR(update_fw, 0200, NULL, goodix_sysfs_update_fw_store),
+ __EXTMOD_ATTR(fw_version, 0444, goodix_sysfs_update_fw_version_show, NULL),
+ __EXTMOD_ATTR(fw_name, 0200, NULL, goodix_sysfs_fw_name_store),
+ __EXTMOD_ATTR(hw_version, 0444, goodix_sysfs_update_hwversion_show, NULL),
+};
+
+static int goodix_syfs_init(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module)
+{
+ struct fw_update_ctrl *fw_ctrl = module->priv_data;
+ struct kobj_type *ktype;
+ int ret = 0, i;
+
+ ktype = goodix_get_default_ktype();
+ ret = kobject_init_and_add(&module->kobj,
+ ktype,
+ &core_data->pdev->dev.kobj,
+ "fwupdate");
+ if (ret) {
+ ts_err("Create fwupdate sysfs node error!");
+ goto exit_sysfs_init;
+ }
+
+ for (i = 0; i < ARRAY_SIZE(goodix_fwu_attrs); i++) {
+ if (sysfs_create_file(&module->kobj,
+ &goodix_fwu_attrs[i].attr)) {
+ ts_err("Create sysfs attr file error");
+ kobject_put(&module->kobj);
+ ret = -EINVAL;
+ goto exit_sysfs_init;
+ }
+ }
+
+ fw_ctrl->attr_fwimage.attr.name = "fwimage";
+ fw_ctrl->attr_fwimage.attr.mode = 0200;
+ fw_ctrl->attr_fwimage.size = 0;
+ fw_ctrl->attr_fwimage.write = goodix_sysfs_fwimage_store;
+ ret = sysfs_create_bin_file(&module->kobj,
+ &fw_ctrl->attr_fwimage);
+
+exit_sysfs_init:
+ return ret;
+}
+
+static int goodix_fw_update_init(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module)
+{
+ struct goodix_ts_board_data *ts_bdata = board_data(core_data);
+ struct fw_update_ctrl *fwu_ctrl;
+ static bool init_sysfs = true;
+
+ if (!core_data->ts_dev)
+ return -ENODEV;
+
+ if (!module->priv_data) {
+ module->priv_data = kzalloc(sizeof(struct fw_update_ctrl),
+ GFP_KERNEL);
+ if (!module->priv_data) {
+ ts_err("Failed to alloc memory for fwu_ctrl");
+ return -ENOMEM;
+ }
+ }
+ fwu_ctrl = module->priv_data;
+ fwu_ctrl->ts_dev = core_data->ts_dev;
+
+ /* find a valid firmware image name */
+ if (strlen(fwu_ctrl->fw_name) == 0) {
+ if (ts_bdata && ts_bdata->fw_name)
+ strlcpy(fwu_ctrl->fw_name, ts_bdata->fw_name,
+ sizeof(fwu_ctrl->fw_name));
+ else
+ strlcpy(fwu_ctrl->fw_name, TS_DEFAULT_FIRMWARE,
+ sizeof(fwu_ctrl->fw_name));
+ }
+
+
+ /* create sysfs interface */
+ if (init_sysfs) {
+ if (!goodix_syfs_init(core_data, module))
+ init_sysfs = false;
+ }
+
+ return 0;
+}
+
+static int goodix_fw_update_exit(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module)
+{
+ return 0;
+}
+
+static int goodix_fw_before_suspend(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module)
+{
+ struct fw_update_ctrl *fwu_ctrl = module->priv_data;
+
+ return fwu_ctrl->allow_suspend ?
+ EVT_HANDLED : EVT_CANCEL_SUSPEND;
+}
+
+static int goodix_fw_before_resume(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module)
+{
+ struct fw_update_ctrl *fwu_ctrl = module->priv_data;
+
+ return fwu_ctrl->allow_resume ?
+ EVT_HANDLED : EVT_CANCEL_RESUME;
+}
+
+static int goodix_fw_irq_event(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module)
+{
+ struct fw_update_ctrl *fwu_ctrl = module->priv_data;
+
+ return fwu_ctrl->allow_irq ?
+ EVT_HANDLED : EVT_CANCEL_IRQEVT;
+}
+
+static int goodix_fw_before_reset(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module)
+{
+ struct fw_update_ctrl *fwu_ctrl = module->priv_data;
+
+ return fwu_ctrl->allow_reset ?
+ EVT_HANDLED : EVT_CANCEL_RESET;
+}
+
+static const struct goodix_ext_module_funcs goodix_ext_funcs = {
+ .init = goodix_fw_update_init,
+ .exit = goodix_fw_update_exit,
+ .before_reset = goodix_fw_before_reset,
+ .after_reset = NULL,
+ .before_suspend = goodix_fw_before_suspend,
+ .after_suspend = NULL,
+ .before_resume = goodix_fw_before_resume,
+ .after_resume = NULL,
+ .irq_event = goodix_fw_irq_event,
+};
+
+static struct goodix_ext_module goodix_fwu_module = {
+ .name = "goodix-fwu",
+ .funcs = &goodix_ext_funcs,
+ .priority = EXTMOD_PRIO_FWUPDATE,
+};
+
+static int __init goodix_fwu_module_init(void)
+{
+ return goodix_register_ext_module(&goodix_fwu_module);
+}
+
+static void __exit goodix_fwu_module_exit(void)
+{
+}
+
+module_init(goodix_fwu_module_init);
+module_exit(goodix_fwu_module_exit);
+
+MODULE_DESCRIPTION("Goodix FWU Module");
+MODULE_AUTHOR("Goodix, Inc.");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_core.c b/drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_core.c
new file mode 100755
index 0000000..2808f3a
--- /dev/null
+++ b/drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_core.c
@@ -0,0 +1,1618 @@
+ /*
+ * Goodix Touchscreen Driver
+ * Core layer of touchdriver architecture.
+ *
+ * Copyright (C) 2015 - 2016 Goodix, Inc.
+ * Authors: Wang Yafei <wangyafei@...dix.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be a reference
+ * to you, when you are integrating the GOODiX's CTP IC into your system,
+ * 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.
+ *
+ */
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/slab.h>
+#include <linux/interrupt.h>
+#include <linux/of_platform.h>
+#include <linux/completion.h>
+#include <linux/debugfs.h>
+#include <linux/of_irq.h>
+#ifdef CONFIG_FB
+#include <linux/notifier.h>
+#include <linux/fb.h>
+#endif
+#include <linux/regulator/consumer.h>
+#include <linux/input/mt.h>
+#include "goodix_ts_core.h"
+
+#define INPUT_TYPE_B_PROTOCOL
+
+#define GOOIDX_INPUT_PHYS "goodix_ts/input0"
+#define PINCTRL_STATE_ACTIVE "pmx_ts_active"
+#define PINCTRL_STATE_SUSPEND "pmx_ts_suspend"
+
+/* Set this to 1 if you have a reset pin*/
+#define HAVE_RESET_PIN 0
+/*
+ * struct goodix_modules - external modules container
+ * @head: external modules list
+ * @initilized: whether this struct is initilized
+ * @mutex: mutex lock
+ * @count: current number of registered external module
+ * @wq: workqueue to do register work
+ * @core_exit: if goodix touch core exit, then no
+ * registration is allowed.
+ * @core_data: core_data pointer
+ */
+struct goodix_modules {
+ struct list_head head;
+ bool initilized;
+ struct mutex mutex;
+ unsigned int count;
+ struct workqueue_struct *wq;
+ bool core_exit;
+ struct completion core_comp;
+ struct goodix_ts_core *core_data;
+};
+static struct goodix_modules goodix_modules;
+
+/**
+ * __do_register_ext_module - register external module
+ * to register into touch core modules structure
+ */
+static void __do_register_ext_module(struct work_struct *work)
+{
+ struct goodix_ext_module *module =
+ container_of(work, struct goodix_ext_module, work);
+ struct goodix_ext_module *ext_module;
+ struct list_head *insert_point = &goodix_modules.head;
+
+ /* waitting for core layer */
+ if (!wait_for_completion_timeout(&goodix_modules.core_comp, 5 * HZ)) {
+ ts_err("Module [%s] timeout", module->name);
+ return;
+ }
+
+ /* driver probe failed */
+ if (goodix_modules.core_exit) {
+ ts_err("Can't register ext_module, core exit");
+ return;
+ }
+
+ /* prority level *must* be set */
+ if (module->priority == EXTMOD_PRIO_RESERVED) {
+ ts_err("Priority of module [%s] needs to be set",
+ module->name);
+ return;
+ }
+
+ mutex_lock(&goodix_modules.mutex);
+ if (!list_empty(&goodix_modules.head)) {
+ list_for_each_entry(ext_module, &goodix_modules.head, list) {
+ if (ext_module == module) {
+ ts_info("Module [%s] already exists",
+ ext_module->name);
+ mutex_unlock(&goodix_modules.mutex);
+ return;
+ }
+ }
+
+ list_for_each_entry(ext_module, &goodix_modules.head, list) {
+ /* small value of priority have higher priority level */
+ if (ext_module->priority >= module->priority) {
+ insert_point = &ext_module->list;
+ break;
+ }
+ }
+ /* else module will be inserted to goodix_modules->head */
+ }
+
+ if (module->funcs && module->funcs->init) {
+ if (module->funcs->init(goodix_modules.core_data,
+ module) < 0) {
+ ts_err("Module [%s] init error",
+ module->name ? module->name : " ");
+ mutex_unlock(&goodix_modules.mutex);
+ return;
+ }
+ }
+
+ list_add(&module->list, insert_point->prev);
+ goodix_modules.count++;
+ mutex_unlock(&goodix_modules.mutex);
+
+ ts_info("Module [%s] registered,priority:%u",
+ module->name,
+ module->priority);
+}
+
+/**
+ * goodix_register_ext_module - interface for external module
+ * to register into touch core modules structure
+ *
+ * @module: pointer to external module to be register
+ * return: 0 ok, <0 failed
+ */
+int goodix_register_ext_module(struct goodix_ext_module *module)
+{
+ if (!module)
+ return -EINVAL;
+
+ if (!goodix_modules.initilized) {
+ goodix_modules.initilized = true;
+ INIT_LIST_HEAD(&goodix_modules.head);
+ mutex_init(&goodix_modules.mutex);
+ init_completion(&goodix_modules.core_comp);
+ }
+
+ if (goodix_modules.core_exit) {
+ ts_err("Can't register ext_module, core exit");
+ return -EFAULT;
+ }
+
+ INIT_WORK(&module->work, __do_register_ext_module);
+ schedule_work(&module->work);
+
+ return 0;
+}
+EXPORT_SYMBOL_GPL(goodix_register_ext_module);
+
+/**
+ * goodix_unregister_ext_module - interface for external module
+ * to unregister external modules
+ *
+ * @module: pointer to external module
+ * return: 0 ok, <0 failed
+ */
+int goodix_unregister_ext_module(struct goodix_ext_module *module)
+{
+ struct goodix_ext_module *ext_module;
+ bool found = false;
+
+ if (!module)
+ return -EINVAL;
+
+ if (!goodix_modules.initilized)
+ return -EINVAL;
+
+ if (!goodix_modules.core_data)
+ return -ENODEV;
+
+ mutex_lock(&goodix_modules.mutex);
+ if (!list_empty(&goodix_modules.head)) {
+ list_for_each_entry(ext_module, &goodix_modules.head, list) {
+ if (ext_module == module) {
+ found = true;
+ break;
+ }
+ }
+ } else {
+ mutex_unlock(&goodix_modules.mutex);
+ return -EFAULT;
+ }
+
+ if (!found) {
+ ts_err("Module [%s] never registed",
+ module->name);
+ mutex_unlock(&goodix_modules.mutex);
+ return -EFAULT;
+ }
+
+ list_del(&module->list);
+ mutex_unlock(&goodix_modules.mutex);
+
+ if (module->funcs && module->funcs->exit)
+ module->funcs->exit(goodix_modules.core_data, module);
+ goodix_modules.count--;
+
+ ts_info("Moudle [%s] unregistered",
+ module->name ? module->name : " ");
+ return 0;
+}
+EXPORT_SYMBOL_GPL(goodix_unregister_ext_module);
+
+static void goodix_ext_sysfs_release(struct kobject *kobj)
+{
+ ts_info("Kobject released!");
+}
+
+#define to_ext_module(kobj) container_of(kobj,\
+ struct goodix_ext_module, kobj)
+#define to_ext_attr(attr) container_of(attr,\
+ struct goodix_ext_attribute, attr)
+
+static ssize_t goodix_ext_sysfs_show(struct kobject *kobj,
+ struct attribute *attr, char *buf)
+{
+ struct goodix_ext_module *module = to_ext_module(kobj);
+ struct goodix_ext_attribute *ext_attr = to_ext_attr(attr);
+
+ if (ext_attr->show)
+ return ext_attr->show(module, buf);
+
+ return -EIO;
+}
+
+static ssize_t goodix_ext_sysfs_store(struct kobject *kobj,
+ struct attribute *attr, const char *buf, size_t count)
+{
+ struct goodix_ext_module *module = to_ext_module(kobj);
+ struct goodix_ext_attribute *ext_attr = to_ext_attr(attr);
+
+ if (ext_attr->store)
+ return ext_attr->store(module, buf, count);
+
+ return -EIO;
+}
+
+static const struct sysfs_ops goodix_ext_ops = {
+ .show = goodix_ext_sysfs_show,
+ .store = goodix_ext_sysfs_store
+};
+
+static struct kobj_type goodix_ext_ktype = {
+ .release = goodix_ext_sysfs_release,
+ .sysfs_ops = &goodix_ext_ops,
+};
+
+struct kobj_type *goodix_get_default_ktype(void)
+{
+ return &goodix_ext_ktype;
+}
+EXPORT_SYMBOL_GPL(goodix_get_default_ktype);
+
+struct kobject *goodix_get_default_kobj(void)
+{
+ struct kobject *kobj = NULL;
+
+ if (goodix_modules.core_data &&
+ goodix_modules.core_data->pdev)
+ kobj = &goodix_modules.core_data->pdev->dev.kobj;
+ return kobj;
+}
+EXPORT_SYMBOL_GPL(goodix_get_default_kobj);
+
+/* debug fs */
+struct debugfs_buf {
+ struct debugfs_blob_wrapper buf;
+ int pos;
+ struct dentry *dentry;
+} goodix_dbg;
+
+void goodix_msg_printf(const char *fmt, ...)
+{
+ va_list args;
+ int r;
+
+ if (goodix_dbg.pos < goodix_dbg.buf.size) {
+ va_start(args, fmt);
+ r = vscnprintf(goodix_dbg.buf.data + goodix_dbg.pos,
+ goodix_dbg.buf.size - 1, fmt, args);
+ goodix_dbg.pos += r;
+ va_end(args);
+ }
+}
+EXPORT_SYMBOL_GPL(goodix_msg_printf);
+
+static int goodix_debugfs_init(void)
+{
+ struct dentry *r_b;
+
+ goodix_dbg.buf.size = PAGE_SIZE;
+ goodix_dbg.pos = 0;
+ goodix_dbg.buf.data = kzalloc(goodix_dbg.buf.size, GFP_KERNEL);
+ if (!goodix_dbg.buf.data) {
+ pr_err("Debugfs init failed\n");
+ goto exit;
+ }
+ r_b = debugfs_create_blob("goodix_ts", 0644, NULL, &goodix_dbg.buf);
+ if (!r_b) {
+ pr_err("Debugfs create failed\n");
+ return -ENOENT;
+ }
+ goodix_dbg.dentry = r_b;
+
+exit:
+ return 0;
+}
+
+static void goodix_debugfs_exit(void)
+{
+ debugfs_remove(goodix_dbg.dentry);
+ goodix_dbg.dentry = NULL;
+ pr_info("Debugfs module exit\n");
+}
+
+/* show external module information */
+static ssize_t goodix_ts_extmod_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ struct goodix_ext_module *module;
+ size_t offset = 0;
+ int r;
+
+ mutex_lock(&goodix_modules.mutex);
+ if (!list_empty(&goodix_modules.head)) {
+ list_for_each_entry(module, &goodix_modules.head, list) {
+ r = snprintf(&buf[offset], PAGE_SIZE,
+ "priority:%u module:%s\n",
+ module->priority, module->name);
+ if (r < 0) {
+ mutex_unlock(&goodix_modules.mutex);
+ return -EINVAL;
+ }
+ offset += r;
+ }
+ }
+
+ mutex_unlock(&goodix_modules.mutex);
+ return offset;
+}
+
+/* show driver information */
+static ssize_t goodix_ts_driver_info_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ return snprintf(buf, PAGE_SIZE, "DriverVersion:%s\n",
+ GOODIX_DRIVER_VERSION);
+}
+
+/* show chip infoamtion */
+static ssize_t goodix_ts_chip_info_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ struct goodix_ts_core *core_data =
+ dev_get_drvdata(dev);
+ struct goodix_ts_device *ts_dev = core_data->ts_dev;
+ struct goodix_ts_version chip_ver;
+ int r, cnt = 0;
+
+ cnt += snprintf(buf, PAGE_SIZE,
+ "TouchDeviceName:%s\n", ts_dev->name);
+ if (ts_dev->hw_ops->read_version) {
+ r = ts_dev->hw_ops->read_version(ts_dev, &chip_ver);
+ if (!r && chip_ver.valid) {
+ cnt += snprintf(&buf[cnt], PAGE_SIZE,
+ "PID:%s\nVID:%04x\nSensorID:%02x\n",
+ chip_ver.pid, chip_ver.vid,
+ chip_ver.sensor_id);
+ }
+ }
+
+ return cnt;
+}
+
+/* show chip configuration data */
+static ssize_t goodix_ts_config_data_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ struct goodix_ts_core *core_data =
+ dev_get_drvdata(dev);
+ struct goodix_ts_device *ts_dev = core_data->ts_dev;
+ struct goodix_ts_config *ncfg = ts_dev->normal_cfg;
+ u8 *data;
+ int i, r, offset = 0;
+
+ if (ncfg && ncfg->initialized && ncfg->length < PAGE_SIZE) {
+ data = kmalloc(ncfg->length, GFP_KERNEL);
+ if (!data)
+ return -ENOMEM;
+
+ r = ts_dev->hw_ops->read(ts_dev, ncfg->reg_base,
+ &data[0], ncfg->length);
+ if (r < 0) {
+ kfree(data);
+ return -EINVAL;
+ }
+
+ for (i = 0; i < ncfg->length; i++) {
+ if (i != 0 && i % 20 == 0)
+ buf[offset++] = '\n';
+ offset += snprintf(&buf[offset], PAGE_SIZE - offset,
+ "%02x ", data[i]);
+ }
+ buf[offset++] = '\n';
+ buf[offset++] = '\0';
+ kfree(data);
+ return offset;
+ }
+
+ return -EINVAL;
+}
+
+/* reset chip */
+static ssize_t goodix_ts_reset_store(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf,
+ size_t count)
+{
+ struct goodix_ts_core *core_data =
+ dev_get_drvdata(dev);
+ struct goodix_ts_device *ts_dev = core_data->ts_dev;
+ int en;
+
+ if (kstrtoint(buf, 10, &en))
+ return -EINVAL;
+
+ if (en != 1)
+ return -EINVAL;
+
+ if (ts_dev->hw_ops->reset)
+ ts_dev->hw_ops->reset(ts_dev);
+ return count;
+
+}
+
+/* show irq information */
+static ssize_t goodix_ts_irq_info_show(struct device *dev,
+ struct device_attribute *attr,
+ char *buf)
+{
+ struct goodix_ts_core *core_data =
+ dev_get_drvdata(dev);
+ struct irq_desc *desc;
+ size_t offset = 0;
+ int r;
+
+ r = snprintf(&buf[offset], PAGE_SIZE, "irq:%u\n",
+ core_data->irq);
+ if (r < 0)
+ return -EINVAL;
+
+ offset += r;
+ r = snprintf(&buf[offset], PAGE_SIZE - offset, "state:%s\n",
+ atomic_read(&core_data->irq_enabled) ?
+ "enabled" : "disabled");
+ if (r < 0)
+ return -EINVAL;
+
+ desc = irq_to_desc(core_data->irq);
+ offset += r;
+ r = snprintf(&buf[offset], PAGE_SIZE - offset, "disable-depth:%d\n",
+ desc->depth);
+ if (r < 0)
+ return -EINVAL;
+
+ offset += r;
+ r = snprintf(&buf[offset], PAGE_SIZE - offset, "trigger-count:%zu\n",
+ core_data->irq_trig_cnt);
+ if (r < 0)
+ return -EINVAL;
+
+ offset += r;
+ r = snprintf(&buf[offset], PAGE_SIZE - offset,
+ "echo 0/1 > irq_info to disable/enable irq");
+ if (r < 0)
+ return -EINVAL;
+
+ offset += r;
+ return offset;
+}
+
+/* enable/disable irq */
+static ssize_t goodix_ts_irq_info_store(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf,
+ size_t count)
+{
+ struct goodix_ts_core *core_data =
+ dev_get_drvdata(dev);
+ int en;
+
+ if (kstrtoint(buf, 10, &en))
+ return -EINVAL;
+
+ goodix_ts_irq_enable(core_data, en);
+ return count;
+}
+
+static DEVICE_ATTR(extmod_info, 0440, goodix_ts_extmod_show, NULL);
+static DEVICE_ATTR(driver_info, 0440, goodix_ts_driver_info_show, NULL);
+static DEVICE_ATTR(chip_info, 0440, goodix_ts_chip_info_show, NULL);
+static DEVICE_ATTR(config_data, 0440, goodix_ts_config_data_show, NULL);
+static DEVICE_ATTR(reset, 0220, NULL, goodix_ts_reset_store);
+static DEVICE_ATTR(irq_info, 0660,
+ goodix_ts_irq_info_show, goodix_ts_irq_info_store);
+
+static struct attribute *sysfs_attrs[] = {
+ &dev_attr_extmod_info.attr,
+ &dev_attr_driver_info.attr,
+ &dev_attr_chip_info.attr,
+ &dev_attr_config_data.attr,
+ &dev_attr_reset.attr,
+ &dev_attr_irq_info.attr,
+ NULL,
+};
+
+static const struct attribute_group sysfs_group = {
+ .attrs = sysfs_attrs,
+};
+
+static int goodix_ts_sysfs_init(struct goodix_ts_core *core_data)
+{
+ return sysfs_create_group(&core_data->pdev->dev.kobj, &sysfs_group);
+}
+
+static void goodix_ts_sysfs_exit(struct goodix_ts_core *core_data)
+{
+ sysfs_remove_group(&core_data->pdev->dev.kobj, &sysfs_group);
+}
+
+/* event notifier */
+static BLOCKING_NOTIFIER_HEAD(ts_notifier_list);
+/**
+ * goodix_ts_register_client - register a client notifier
+ * @nb: notifier block to callback on events
+ * see enum ts_notify_event in goodix_ts_core.h
+ */
+int goodix_ts_register_notifier(struct notifier_block *nb)
+{
+ return blocking_notifier_chain_register(&ts_notifier_list, nb);
+}
+EXPORT_SYMBOL(goodix_ts_register_notifier);
+
+/**
+ * goodix_ts_unregister_client - unregister a client notifier
+ * @nb: notifier block to callback on events
+ * see enum ts_notify_event in goodix_ts_core.h
+ */
+int goodix_ts_unregister_notifier(struct notifier_block *nb)
+{
+ return blocking_notifier_chain_unregister(&ts_notifier_list, nb);
+}
+EXPORT_SYMBOL(goodix_ts_unregister_notifier);
+
+/**
+ * fb_notifier_call_chain - notify clients of fb_events
+ * see enum ts_notify_event in goodix_ts_core.h
+ */
+int goodix_ts_blocking_notify(enum ts_notify_event evt, void *v)
+{
+ return blocking_notifier_call_chain(&ts_notifier_list,
+ (unsigned long)evt, v);
+}
+EXPORT_SYMBOL_GPL(goodix_ts_blocking_notify);
+
+/**
+ * goodix_ts_input_report - report touch event to input subsystem
+ *
+ * @dev: input device pointer
+ * @touch_data: touch data pointer
+ * return: 0 ok, <0 failed
+ */
+static int goodix_ts_input_report(struct input_dev *dev,
+ struct goodix_touch_data *touch_data)
+{
+ struct goodix_ts_coords *coords = &touch_data->coords[0];
+ struct goodix_ts_core *core_data = input_get_drvdata(dev);
+ struct goodix_ts_board_data *ts_bdata = board_data(core_data);
+ unsigned int touch_num = touch_data->touch_num, x, y;
+ static u16 pre_fin;
+ int i, id;
+
+ /* report touch-key */
+ if (unlikely(touch_data->key_value)) {
+ for (i = 0; i < ts_bdata->panel_max_key; i++) {
+ input_report_key(dev, ts_bdata->panel_key_map[i],
+ touch_data->key_value & (1 << i));
+ }
+ }
+
+ /* first touch down and last touch up condition */
+ if (touch_num != 0 && pre_fin == 0x0000) {
+ /* first touch down event */
+ input_report_key(dev, BTN_TOUCH, 1);
+ input_report_key(dev, BTN_TOOL_FINGER, 1);
+ } else if (touch_num == 0 && pre_fin != 0x0000) {
+ /* no finger exist */
+ input_report_key(dev, BTN_TOUCH, 0);
+ input_report_key(dev, BTN_TOOL_FINGER, 0);
+ } else if (touch_num == 0 && pre_fin == 0x0000) {
+ return 0;
+ }
+
+ /* report abs */
+ id = coords->id;
+ for (i = 0; i < ts_bdata->panel_max_id; i++) {
+ if (touch_num && i == id) {
+ /* this is a valid touch down event */
+#ifdef INPUT_TYPE_B_PROTOCOL
+ input_mt_slot(dev, id);
+ input_mt_report_slot_state(dev, MT_TOOL_FINGER, true);
+#else
+ input_report_abs(dev, ABS_MT_TRACKING_ID, id);
+#endif
+ if (unlikely(ts_bdata->swap_axis)) {
+ x = coords->y;
+ y = coords->x;
+ } else {
+ x = coords->x;
+ y = coords->y;
+ }
+ input_report_abs(dev, ABS_MT_POSITION_X, x);
+ input_report_abs(dev, ABS_MT_POSITION_Y, y);
+ input_report_abs(dev, ABS_MT_TOUCH_MAJOR, coords->w);
+ pre_fin |= 1 << i;
+ id = (++coords)->id;
+#ifndef INPUT_TYPE_B_PROTOCOL
+ input_mt_sync(dev);
+#endif
+ } else {
+ if (pre_fin & (1 << i)) {/* release touch */
+#ifdef INPUT_TYPE_B_PROTOCOL
+ input_mt_slot(dev, i);
+ input_mt_report_slot_state(dev, MT_TOOL_FINGER,
+ false);
+#endif
+ pre_fin &= ~(1 << i);
+ }
+ }
+ }
+
+#ifndef INPUT_TYPE_B_PROTOCOL
+ if (!pre_fin)
+ input_mt_sync(dev);
+#endif
+ input_sync(dev);
+ return 0;
+}
+
+/**
+ * goodix_ts_threadirq_func - Bottom half of interrupt
+ * This functions is excuted in thread context,
+ * sleep in this function is permit.
+ *
+ * @core_data: pointer to touch core data
+ * return: 0 ok, <0 failed
+ */
+static irqreturn_t goodix_ts_threadirq_func(int irq, void *data)
+{
+ struct goodix_ts_core *core_data = data;
+ struct goodix_ts_device *ts_dev = core_data->ts_dev;
+ struct goodix_ext_module *ext_module;
+ struct goodix_ts_event *ts_event = &core_data->ts_event;
+ int r;
+
+ core_data->irq_trig_cnt++;
+ /* inform external module */
+ list_for_each_entry(ext_module, &goodix_modules.head, list) {
+ if (!ext_module->funcs->irq_event)
+ continue;
+ r = ext_module->funcs->irq_event(core_data, ext_module);
+ if (r == EVT_CANCEL_IRQEVT)
+ return IRQ_HANDLED;
+ }
+
+ /* read touch data from touch device */
+ r = ts_dev->hw_ops->event_handler(ts_dev, ts_event);
+ if (likely(r >= 0)) {
+ if (ts_event->event_type == EVENT_TOUCH) {
+ /* report touch */
+ goodix_ts_input_report(core_data->input_dev,
+ &ts_event->event_data.touch_data);
+ }
+ }
+
+ return IRQ_HANDLED;
+}
+
+/**
+ * goodix_ts_init_irq - Requset interrupt line from system
+ * @core_data: pointer to touch core data
+ * return: 0 ok, <0 failed
+ */
+static int goodix_ts_irq_setup(struct goodix_ts_core *core_data)
+{
+ const struct goodix_ts_board_data *ts_bdata =
+ board_data(core_data);
+ int r;
+
+ /* if ts_bdata-> irq is invalid */
+ if (ts_bdata->irq <= 0)
+ core_data->irq = gpiod_to_irq(ts_bdata->irq_gpiod);
+ else
+ core_data->irq = ts_bdata->irq;
+
+ ts_info("IRQ:%u,flags:%d", core_data->irq, (int)ts_bdata->irq_flags);
+ r = devm_request_threaded_irq(&core_data->pdev->dev,
+ core_data->irq, NULL,
+ goodix_ts_threadirq_func,
+ ts_bdata->irq_flags | IRQF_ONESHOT,
+ GOODIX_CORE_DRIVER_NAME,
+ core_data);
+ if (r < 0)
+ ts_err("Failed to requeset threaded irq:%d", r);
+ else
+ atomic_set(&core_data->irq_enabled, 1);
+
+ return r;
+}
+
+/**
+ * goodix_ts_irq_enable - Enable/Disable a irq
+ * @core_data: pointer to touch core data
+ * enable: enable or disable irq
+ * return: 0 ok, <0 failed
+ */
+int goodix_ts_irq_enable(struct goodix_ts_core *core_data,
+ bool enable)
+{
+ if (enable) {
+ if (!atomic_cmpxchg(&core_data->irq_enabled, 0, 1)) {
+ enable_irq(core_data->irq);
+ ts_debug("Irq enabled");
+ }
+ } else {
+ if (atomic_cmpxchg(&core_data->irq_enabled, 1, 0)) {
+ disable_irq(core_data->irq);
+ ts_debug("Irq disabled");
+ }
+ }
+
+ return 0;
+}
+EXPORT_SYMBOL(goodix_ts_irq_enable);
+/**
+ * goodix_ts_power_init - Get regulator for touch device
+ * @core_data: pointer to touch core data
+ * return: 0 ok, <0 failed
+ */
+static int goodix_ts_power_init(struct goodix_ts_core *core_data)
+{
+ struct device *dev = NULL;
+ struct goodix_ts_board_data *ts_bdata;
+
+ ts_info("Power init");
+ /* dev:i2c client device or spi slave device*/
+ dev = core_data->ts_dev->dev;
+ ts_bdata = board_data(core_data);
+
+ if (ts_bdata->avdd_name) {
+ core_data->avdd = devm_regulator_get(dev, ts_bdata->avdd_name);
+ if (IS_ERR_OR_NULL(core_data->avdd)) {
+ ts_err("Failed to get regulator %s:%ld",
+ ts_bdata->avdd_name,
+ PTR_ERR(core_data->avdd));
+ core_data->avdd = NULL;
+ return -ENOENT;
+ }
+ } else {
+ ts_info("Avdd name is NULL");
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+/**
+ * goodix_ts_power_on - Turn on power to the touch device
+ * @core_data: pointer to touch core data
+ * return: 0 ok, <0 failed
+ */
+static int goodix_ts_power_on(struct goodix_ts_core *core_data)
+{
+ struct goodix_ts_board_data *ts_bdata =
+ board_data(core_data);
+ int r;
+
+ ts_info("Device power on");
+ if (core_data->power_on)
+ return 0;
+
+ if (core_data->avdd) {
+ r = regulator_enable(core_data->avdd);
+ if (!r) {
+ if (ts_bdata->power_on_delay_us)
+ usleep_range(ts_bdata->power_on_delay_us,
+ ts_bdata->power_on_delay_us);
+ } else {
+ ts_err("Failed to enable analog power:%d", r);
+ return r;
+ }
+ }
+
+ core_data->power_on = 1;
+ return 0;
+}
+
+/**
+ * goodix_ts_power_off - Turn off power to the touch device
+ * @core_data: pointer to touch core data
+ * return: 0 ok, <0 failed
+ */
+static int goodix_ts_power_off(struct goodix_ts_core *core_data)
+{
+ struct goodix_ts_board_data *ts_bdata =
+ board_data(core_data);
+ int r;
+
+ ts_info("Device power off");
+ if (!core_data->power_on)
+ return 0;
+
+ if (core_data->avdd) {
+ r = regulator_disable(core_data->avdd);
+ if (!r) {
+ if (ts_bdata->power_off_delay_us)
+ usleep_range(ts_bdata->power_off_delay_us,
+ ts_bdata->power_off_delay_us);
+ } else {
+ ts_err("Failed to disable analog power:%d", r);
+ return r;
+ }
+ }
+
+ core_data->power_on = 0;
+ return 0;
+}
+
+#ifdef CONFIG_PINCTRL
+/**
+ * goodix_ts_pinctrl_init - Get pinctrl handler and pinctrl_state
+ * @core_data: pointer to touch core data
+ * return: 0 ok, <0 failed
+ */
+static int goodix_ts_pinctrl_init(struct goodix_ts_core *core_data)
+{
+ int r = 0;
+
+ /* get pinctrl handler from of node */
+ core_data->pinctrl = devm_pinctrl_get(core_data->ts_dev->dev);
+ if (IS_ERR_OR_NULL(core_data->pinctrl)) {
+ ts_err("Failed to get pinctrl handler");
+ return PTR_ERR(core_data->pinctrl);
+ }
+
+ /* active state */
+ core_data->pin_sta_active = pinctrl_lookup_state(core_data->pinctrl,
+ PINCTRL_STATE_ACTIVE);
+ if (IS_ERR_OR_NULL(core_data->pin_sta_active)) {
+ r = PTR_ERR(core_data->pin_sta_active);
+ ts_err("Failed to get pinctrl state:%s, r:%d",
+ PINCTRL_STATE_ACTIVE, r);
+ goto exit_pinctrl_put;
+ }
+
+ /* suspend state */
+ core_data->pin_sta_suspend = pinctrl_lookup_state(core_data->pinctrl,
+ PINCTRL_STATE_SUSPEND);
+ if (IS_ERR_OR_NULL(core_data->pin_sta_suspend)) {
+ r = PTR_ERR(core_data->pin_sta_suspend);
+ ts_err("Failed to get pinctrl state:%s, r:%d",
+ PINCTRL_STATE_SUSPEND, r);
+ goto exit_pinctrl_put;
+ }
+
+ return 0;
+exit_pinctrl_put:
+ devm_pinctrl_put(core_data->pinctrl);
+ core_data->pinctrl = NULL;
+ return r;
+}
+#endif
+
+/**
+ * goodix_ts_gpio_setup - Request gpio resources from GPIO subsysten
+ * reset_gpio and irq_gpio number are obtained from goodix_ts_device
+ * which created in hardware layer driver. e.g.goodix_xx_i2c.c
+ * A goodix_ts_device should set those two fileds to right value
+ * before registed to touch core driver.
+ * @core_data: pointer to touch core data
+ * return: 0 ok, <0 failed
+ */
+static int goodix_ts_gpio_setup(struct goodix_ts_core *core_data)
+{
+ struct goodix_ts_board_data *ts_bdata = board_data(core_data);
+ struct goodix_ts_device *ts_dev = ts_device(core_data);
+ int r = 0;
+
+#if HAVE_RESET_PIN
+ ts_bdata->reset_gpiod = devm_gpiod_get(ts_dev->dev,
+ "goodix,reset", GPIOD_OUT_LOW);
+ if (IS_ERR(ts_bdata->reset_gpiod)) {
+ r = PTR_ERR(ts_bdata->reset_gpiod);
+ ts_err("Failed to request reset gpio, r:%d", r);
+ return r;
+ }
+#endif
+ /* need to compare the difference between 'devm_gpiod_get' and
+ * 'devm_gpiod_get_optional'
+ */
+ ts_bdata->irq_gpiod = devm_gpiod_get(ts_dev->dev,
+ "goodix,irq", GPIOD_IN);
+ if (IS_ERR(ts_bdata->irq_gpiod)) {
+ r = PTR_ERR(ts_bdata->irq_gpiod);
+ ts_err("Failed to request irq gpio, r:%d", r);
+ return r;
+ }
+
+ ts_info("GPIO setup,reset-gpip:%d, irq-gpio:%d",
+ desc_to_gpio(ts_bdata->reset_gpiod),
+ desc_to_gpio(ts_bdata->irq_gpiod));
+
+ return 0;
+}
+
+/**
+ * goodix_input_set_params - set input parameters
+ */
+static void goodix_ts_set_input_params(struct input_dev *input_dev,
+ struct goodix_ts_board_data *ts_bdata)
+{
+ int i;
+
+ if (ts_bdata->swap_axis)
+ swap(ts_bdata->panel_max_x, ts_bdata->panel_max_y);
+
+ input_set_abs_params(input_dev, ABS_MT_TRACKING_ID,
+ 0, ts_bdata->panel_max_id, 0, 0);
+ input_set_abs_params(input_dev, ABS_MT_POSITION_X,
+ 0, ts_bdata->panel_max_x, 0, 0);
+
+ input_set_abs_params(input_dev, ABS_MT_POSITION_Y,
+ 0, ts_bdata->panel_max_y, 0, 0);
+
+ input_set_abs_params(input_dev, ABS_MT_TOUCH_MAJOR,
+ 0, ts_bdata->panel_max_w, 0, 0);
+ if (ts_bdata->panel_max_key) {
+ for (i = 0; i < ts_bdata->panel_max_key; i++)
+ input_set_capability(input_dev, EV_KEY,
+ ts_bdata->panel_key_map[i]);
+ }
+}
+
+/**
+ * goodix_ts_input_dev_config - Requset and config a input device
+ * then register it to input sybsystem.
+ * NOTE that some hardware layer may provide a input device
+ * (ts_dev->input_dev not NULL).
+ * @core_data: pointer to touch core data
+ * return: 0 ok, <0 failed
+ */
+static int goodix_ts_input_dev_config(struct goodix_ts_core *core_data)
+{
+ struct goodix_ts_board_data *ts_bdata = board_data(core_data);
+ struct input_dev *input_dev = NULL;
+ int r;
+
+ input_dev = devm_input_allocate_device(&core_data->pdev->dev);
+ if (!input_dev) {
+ ts_err("Failed to allocated input device");
+ return -ENOMEM;
+ }
+
+ core_data->input_dev = input_dev;
+ input_set_drvdata(input_dev, core_data);
+
+ input_dev->name = GOODIX_CORE_DRIVER_NAME;
+ input_dev->phys = GOOIDX_INPUT_PHYS;
+ input_dev->id.product = 0xDEAD;
+ input_dev->id.vendor = 0xBEEF;
+ input_dev->id.version = 10427;
+
+ __set_bit(EV_SYN, input_dev->evbit);
+ __set_bit(EV_KEY, input_dev->evbit);
+ __set_bit(EV_ABS, input_dev->evbit);
+ __set_bit(BTN_TOUCH, input_dev->keybit);
+ __set_bit(BTN_TOOL_FINGER, input_dev->keybit);
+
+#ifdef INPUT_PROP_DIRECT
+ __set_bit(INPUT_PROP_DIRECT, input_dev->propbit);
+#endif
+
+ /* set input parameters */
+ goodix_ts_set_input_params(input_dev, ts_bdata);
+
+#ifdef INPUT_TYPE_B_PROTOCOL
+ input_mt_init_slots(input_dev, ts_bdata->panel_max_id,
+ INPUT_MT_DIRECT);
+#endif
+
+ input_set_capability(input_dev, EV_KEY, KEY_POWER);
+ r = input_register_device(input_dev);
+ if (r < 0) {
+ ts_err("Unable to register input device");
+ return r;
+ }
+
+ return 0;
+}
+
+/**
+ * goodix_ts_hw_init - Hardware initialize
+ * poweron - hardware reset - sendconfig
+ * @core_data: pointer to touch core data
+ * return: 0 intilize ok, <0 failed
+ */
+static int goodix_ts_hw_init(struct goodix_ts_core *core_data)
+{
+ const struct goodix_ts_hw_ops *hw_ops =
+ ts_hw_ops(core_data);
+ int r;
+
+ r = goodix_ts_power_on(core_data);
+ if (r < 0)
+ goto exit;
+
+ /* reset touch device */
+ if (hw_ops->reset) {
+ r = hw_ops->reset(core_data->ts_dev);
+ if (r < 0)
+ goto exit;
+ }
+
+ /* init */
+ if (hw_ops->init) {
+ r = hw_ops->init(core_data->ts_dev);
+ if (r < 0) {
+ core_data->hw_err = true;
+ goto exit;
+ }
+ }
+
+exit:
+ /* if bus communication error occurred then exit driver binding, other
+ * errors will be ignored
+ */
+ if (r != -EBUS)
+ r = 0;
+ return r;
+}
+
+/**
+ * goodix_ts_esd_work - check hardware status and recovery
+ * the hardware if needed.
+ */
+static void goodix_ts_esd_work(struct work_struct *work)
+{
+ struct delayed_work *dwork = to_delayed_work(work);
+ struct goodix_ts_esd *ts_esd = container_of(dwork,
+ struct goodix_ts_esd, esd_work);
+ struct goodix_ts_core *core = container_of(ts_esd,
+ struct goodix_ts_core, ts_esd);
+ const struct goodix_ts_hw_ops *hw_ops = ts_hw_ops(core);
+ int r = 0;
+
+ if (ts_esd->esd_on == false)
+ return;
+
+ if (hw_ops->check_hw)
+ r = hw_ops->check_hw(core->ts_dev);
+ if (r < 0) {
+ goodix_ts_power_off(core);
+ goodix_ts_power_on(core);
+ if (hw_ops->reset)
+ hw_ops->reset(core->ts_dev);
+ }
+
+ mutex_lock(&ts_esd->esd_mutex);
+ if (ts_esd->esd_on)
+ schedule_delayed_work(&ts_esd->esd_work, 2 * HZ);
+ mutex_unlock(&ts_esd->esd_mutex);
+}
+
+/**
+ * goodix_ts_esd_on - turn on esd protection
+ */
+static void goodix_ts_esd_on(struct goodix_ts_core *core)
+{
+ struct goodix_ts_esd *ts_esd = &core->ts_esd;
+
+ mutex_lock(&ts_esd->esd_mutex);
+ if (ts_esd->esd_on == false) {
+ ts_esd->esd_on = true;
+ schedule_delayed_work(&ts_esd->esd_work, 2 * HZ);
+ mutex_unlock(&ts_esd->esd_mutex);
+ ts_info("Esd on");
+ return;
+ }
+ mutex_unlock(&ts_esd->esd_mutex);
+}
+
+/**
+ * goodix_ts_esd_off - turn off esd protection
+ */
+static void goodix_ts_esd_off(struct goodix_ts_core *core)
+{
+ struct goodix_ts_esd *ts_esd = &core->ts_esd;
+
+ mutex_lock(&ts_esd->esd_mutex);
+ if (ts_esd->esd_on == true) {
+ ts_esd->esd_on = false;
+ cancel_delayed_work(&ts_esd->esd_work);
+ mutex_unlock(&ts_esd->esd_mutex);
+ ts_info("Esd off");
+ return;
+ }
+ mutex_unlock(&ts_esd->esd_mutex);
+}
+
+/**
+ * goodix_esd_notifier_callback - notification callback
+ * under certain condition, we need to turn off/on the esd
+ * protector, we use kernel notify call chain to achieve this.
+ *
+ * for example: before firmware update we need to turn off the
+ * esd protector and after firmware update finished, we should
+ * turn on the esd protector.
+ */
+static int goodix_esd_notifier_callback(struct notifier_block *nb,
+ unsigned long action, void *data)
+{
+ struct goodix_ts_esd *ts_esd = container_of(nb,
+ struct goodix_ts_esd, esd_notifier);
+
+ switch (action) {
+ case NOTIFY_FWUPDATE_START:
+ case NOTIFY_SUSPEND:
+ goodix_ts_esd_off(ts_esd->ts_core);
+ break;
+ case NOTIFY_FWUPDATE_END:
+ case NOTIFY_RESUME:
+ goodix_ts_esd_on(ts_esd->ts_core);
+ break;
+ }
+
+ return 0;
+}
+
+/**
+ * goodix_ts_esd_init - initialize esd protection
+ */
+static int goodix_ts_esd_init(struct goodix_ts_core *core)
+{
+ struct goodix_ts_esd *ts_esd = &core->ts_esd;
+
+ INIT_DELAYED_WORK(&ts_esd->esd_work, goodix_ts_esd_work);
+ mutex_init(&ts_esd->esd_mutex);
+ ts_esd->ts_core = core;
+ ts_esd->esd_on = false;
+ ts_esd->esd_notifier.notifier_call = goodix_esd_notifier_callback;
+ goodix_ts_register_notifier(&ts_esd->esd_notifier);
+
+ if (core->ts_dev->board_data->esd_default_on == true
+ && core->ts_dev->hw_ops->check_hw)
+ goodix_ts_esd_on(core);
+ return 0;
+}
+
+/**
+ * goodix_ts_suspend - Touchscreen suspend function
+ * Called by PM/FB/EARLYSUSPEN module to put the device to sleep
+ */
+static int goodix_ts_suspend(struct goodix_ts_core *core_data)
+{
+ struct goodix_ext_module *ext_module;
+ struct goodix_ts_device *ts_dev = core_data->ts_dev;
+ int r;
+
+ ts_info("Suspend start");
+
+ /*
+ * notify suspend event, inform the esd protector
+ * and charger detector to turn off the work
+ */
+ goodix_ts_blocking_notify(NOTIFY_SUSPEND, NULL);
+
+ /* inform external module */
+ mutex_lock(&goodix_modules.mutex);
+ if (!list_empty(&goodix_modules.head)) {
+ list_for_each_entry(ext_module, &goodix_modules.head, list) {
+ if (!ext_module->funcs->before_suspend)
+ continue;
+
+ r = ext_module->funcs->before_suspend(core_data, ext_module);
+ if (r == EVT_CANCEL_SUSPEND) {
+ mutex_unlock(&goodix_modules.mutex);
+ ts_info("Canceled by module:%s", ext_module->name);
+ goto out;
+ }
+ }
+ }
+ mutex_unlock(&goodix_modules.mutex);
+
+ /* disable irq */
+ goodix_ts_irq_enable(core_data, false);
+
+ /* let touch ic work in sleep mode */
+ if (ts_dev && ts_dev->hw_ops->suspend)
+ ts_dev->hw_ops->suspend(ts_dev);
+ atomic_set(&core_data->suspended, 1);
+
+#ifdef CONFIG_PINCTRL
+ if (core_data->pinctrl) {
+ r = pinctrl_select_state(core_data->pinctrl,
+ core_data->pin_sta_suspend);
+ if (r < 0)
+ ts_err("Failed to select active pinstate, r:%d", r);
+ }
+#endif
+
+ /* inform exteranl modules */
+ mutex_lock(&goodix_modules.mutex);
+ if (!list_empty(&goodix_modules.head)) {
+ list_for_each_entry(ext_module, &goodix_modules.head, list) {
+ if (!ext_module->funcs->after_suspend)
+ continue;
+
+ r = ext_module->funcs->after_suspend(core_data, ext_module);
+ if (r == EVT_CANCEL_SUSPEND) {
+ mutex_unlock(&goodix_modules.mutex);
+ ts_info("Canceled by module:%s", ext_module->name);
+ goto out;
+ }
+ }
+ }
+ mutex_unlock(&goodix_modules.mutex);
+
+out:
+ /* release all the touch IDs */
+ core_data->ts_event.event_data.touch_data.touch_num = 0;
+ goodix_ts_input_report(core_data->input_dev,
+ &core_data->ts_event.event_data.touch_data);
+ ts_info("Suspend end");
+ return 0;
+}
+
+/**
+ * goodix_ts_resume - Touchscreen resume function
+ * Called by PM/FB/EARLYSUSPEN module to wakeup device
+ */
+static int goodix_ts_resume(struct goodix_ts_core *core_data)
+{
+ struct goodix_ext_module *ext_module;
+ struct goodix_ts_device *ts_dev =
+ core_data->ts_dev;
+ int r;
+
+ ts_info("Resume start");
+ mutex_lock(&goodix_modules.mutex);
+ if (!list_empty(&goodix_modules.head)) {
+ list_for_each_entry(ext_module, &goodix_modules.head, list) {
+ if (!ext_module->funcs->before_resume)
+ continue;
+
+ r = ext_module->funcs->before_resume(core_data, ext_module);
+ if (r == EVT_CANCEL_RESUME) {
+ mutex_unlock(&goodix_modules.mutex);
+ ts_info("Canceled by module:%s", ext_module->name);
+ goto out;
+ }
+ }
+ }
+ mutex_unlock(&goodix_modules.mutex);
+
+#ifdef CONFIG_PINCTRL
+ if (core_data->pinctrl) {
+ r = pinctrl_select_state(core_data->pinctrl,
+ core_data->pin_sta_active);
+ if (r < 0)
+ ts_err("Failed to select active pinstate, r:%d", r);
+ }
+#endif
+
+ atomic_set(&core_data->suspended, 0);
+ /* resume device */
+ if (ts_dev && ts_dev->hw_ops->resume)
+ ts_dev->hw_ops->resume(ts_dev);
+
+ goodix_ts_irq_enable(core_data, true);
+
+ mutex_lock(&goodix_modules.mutex);
+ if (!list_empty(&goodix_modules.head)) {
+ list_for_each_entry(ext_module, &goodix_modules.head, list) {
+ if (!ext_module->funcs->after_resume)
+ continue;
+
+ r = ext_module->funcs->after_resume(core_data, ext_module);
+ if (r == EVT_CANCEL_RESUME) {
+ mutex_unlock(&goodix_modules.mutex);
+ ts_info("Canceled by module:%s", ext_module->name);
+ goto out;
+ }
+ }
+ }
+ mutex_unlock(&goodix_modules.mutex);
+
+out:
+ /*
+ * notify resume event, inform the esd protector
+ * and charger detector to turn on the work
+ */
+ goodix_ts_blocking_notify(NOTIFY_RESUME, NULL);
+ ts_debug("Resume end");
+ return 0;
+}
+
+#ifdef CONFIG_FB
+/**
+ * goodix_ts_fb_notifier_callback - Framebuffer notifier callback
+ * Called by kernel during framebuffer blanck/unblank phrase
+ */
+static int goodix_ts_fb_notifier_callback(struct notifier_block *self,
+ unsigned long event, void *data)
+{
+ struct goodix_ts_core *core_data =
+ container_of(self, struct goodix_ts_core, fb_notifier);
+ struct fb_event *fb_event = data;
+
+ if (fb_event && fb_event->data && core_data) {
+ if (event == FB_EARLY_EVENT_BLANK) {
+ /* before fb blank */
+ } else if (event == FB_EVENT_BLANK) {
+ int *blank = fb_event->data;
+
+ if (*blank == FB_BLANK_UNBLANK)
+ goodix_ts_resume(core_data);
+ else if (*blank == FB_BLANK_POWERDOWN)
+ goodix_ts_suspend(core_data);
+ }
+ }
+
+ return 0;
+}
+#endif
+
+#ifdef CONFIG_HAS_EARLYSUSPEND
+/**
+ * goodix_ts_earlysuspend - Early suspend function
+ * Called by kernel during system suspend phrase
+ */
+static void goodix_ts_earlysuspend(struct early_suspend *h)
+{
+ struct goodix_ts_core *core_data =
+ container_of(h, struct goodix_ts_core,
+ early_suspend);
+
+ goodix_ts_suspend(core_data);
+}
+/**
+ * goodix_ts_lateresume - Late resume function
+ * Called by kernel during system wakeup
+ */
+static void goodix_ts_lateresume(struct early_suspend *h)
+{
+ struct goodix_ts_core *core_data =
+ container_of(h, struct goodix_ts_core,
+ early_suspend);
+
+ goodix_ts_resume(core_data);
+}
+#endif
+
+#ifdef CONFIG_PM
+#if !defined(CONFIG_FB) && !defined(CONFIG_HAS_EARLYSUSPEND)
+/**
+ * goodix_ts_pm_suspend - PM suspend function
+ * Called by kernel during system suspend phrase
+ */
+static int goodix_ts_pm_suspend(struct device *dev)
+{
+ struct goodix_ts_core *core_data =
+ dev_get_drvdata(dev);
+
+ return goodix_ts_suspend(core_data);
+}
+/**
+ * goodix_ts_pm_resume - PM resume function
+ * Called by kernel during system wakeup
+ */
+static int goodix_ts_pm_resume(struct device *dev)
+{
+ struct goodix_ts_core *core_data =
+ dev_get_drvdata(dev);
+
+ return goodix_ts_resume(core_data);
+}
+#endif
+#endif
+
+/**
+ * goodix_generic_noti_callback - generic notifier callback
+ * for goodix touch notification event.
+ */
+static int goodix_generic_noti_callback(struct notifier_block *self,
+ unsigned long action, void *data)
+{
+ struct goodix_ts_core *ts_core = container_of(self,
+ struct goodix_ts_core, ts_notifier);
+ const struct goodix_ts_hw_ops *hw_ops = ts_hw_ops(ts_core);
+ int r;
+
+ switch (action) {
+ case NOTIFY_FWUPDATE_END:
+ if (ts_core->hw_err && hw_ops->init) {
+ /* Firmware has been updated, we need to reinit
+ * the chip, read the sensor ID and send the
+ * correct config data based on sensor ID.
+ * The input parameters also needs to be updated.
+ */
+ r = hw_ops->init(ts_core->ts_dev);
+ if (r < 0)
+ goto exit;
+
+ goodix_ts_set_input_params(ts_core->input_dev,
+ ts_core->ts_dev->board_data);
+ ts_core->hw_err = false;
+ }
+ break;
+ }
+
+exit:
+ return 0;
+
+}
+
+/**
+ * goodix_ts_probe - called by kernel when a Goodix touch
+ * platform driver is added.
+ */
+static int goodix_ts_probe(struct platform_device *pdev)
+{
+ struct goodix_ts_core *core_data = NULL;
+ struct goodix_ts_device *ts_device;
+ int r;
+
+ ts_device = pdev->dev.platform_data;
+ if (!ts_device || !ts_device->hw_ops || !ts_device->board_data) {
+ ts_err("Invalid touch device");
+ return -ENODEV;
+ }
+
+ core_data = devm_kzalloc(&pdev->dev, sizeof(struct goodix_ts_core),
+ GFP_KERNEL);
+ if (!core_data)
+ return -ENOMEM;
+
+ /* touch core layer is a platform driver */
+ core_data->pdev = pdev;
+ core_data->ts_dev = ts_device;
+ platform_set_drvdata(pdev, core_data);
+
+ r = goodix_ts_power_init(core_data);
+ if (r < 0)
+ ts_err("Failed power init");
+
+#ifdef CONFIG_PINCTRL
+ /* Pinctrl handle is optional. */
+ r = goodix_ts_pinctrl_init(core_data);
+ if (!r && core_data->pinctrl) {
+ r = pinctrl_select_state(core_data->pinctrl,
+ core_data->pin_sta_active);
+ if (r < 0)
+ ts_err("Failed to select active pinstate, r:%d", r);
+ }
+#endif
+
+ /* get GPIO resource */
+ r = goodix_ts_gpio_setup(core_data);
+ if (r < 0)
+ goto out;
+
+ /* initialize firmware */
+ r = goodix_ts_hw_init(core_data);
+ if (r < 0)
+ goto out;
+
+ /* alloc/config/register input device */
+ r = goodix_ts_input_dev_config(core_data);
+ if (r < 0)
+ goto out;
+
+ /* request irq line */
+ r = goodix_ts_irq_setup(core_data);
+ if (r < 0)
+ goto out;
+
+ /* inform the external module manager that
+ * touch core layer is ready now
+ */
+ goodix_modules.core_data = core_data;
+ complete_all(&goodix_modules.core_comp);
+
+ /* create sysfs files */
+ goodix_ts_sysfs_init(core_data);
+
+#ifdef CONFIG_FB
+ core_data->fb_notifier.notifier_call = goodix_ts_fb_notifier_callback;
+ if (fb_register_client(&core_data->fb_notifier))
+ ts_err("Failed to register fb notifier client:%d", r);
+#elif defined(CONFIG_HAS_EARLYSUSPEND)
+ core_data->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN + 1;
+ core_data->early_suspend.resume = goodix_ts_lateresume;
+ core_data->early_suspend.suspend = goodix_ts_earlysuspend;
+ register_early_suspend(&core_data->early_suspend);
+#endif
+
+ /* esd protector */
+ goodix_ts_esd_init(core_data);
+
+ /* generic notifier callback */
+ core_data->ts_notifier.notifier_call = goodix_generic_noti_callback;
+ goodix_ts_register_notifier(&core_data->ts_notifier);
+
+ return 0;
+ /* we use resource managed api(devm_), no need to free resource */
+out:
+ goodix_modules.core_exit = true;
+ complete_all(&goodix_modules.core_comp);
+ ts_err("Core layer probe failed");
+ return r;
+}
+
+static int goodix_ts_remove(struct platform_device *pdev)
+{
+ struct goodix_ts_core *core_data =
+ platform_get_drvdata(pdev);
+
+ goodix_ts_power_off(core_data);
+ goodix_debugfs_exit();
+ goodix_ts_sysfs_exit(core_data);
+ return 0;
+}
+
+#ifdef CONFIG_PM
+static const struct dev_pm_ops dev_pm_ops = {
+#if !defined(CONFIG_FB) && !defined(CONFIG_HAS_EARLYSUSPEND)
+ .suspend = goodix_ts_pm_suspend,
+ .resume = goodix_ts_pm_resume,
+#endif
+};
+#endif
+
+static const struct platform_device_id ts_core_ids[] = {
+ {.name = GOODIX_CORE_DRIVER_NAME},
+ {}
+};
+MODULE_DEVICE_TABLE(platform, ts_core_ids);
+
+static struct platform_driver goodix_ts_driver = {
+ .driver = {
+ .name = GOODIX_CORE_DRIVER_NAME,
+ .owner = THIS_MODULE,
+#ifdef CONFIG_PM
+ .pm = &dev_pm_ops,
+#endif
+ },
+ .probe = goodix_ts_probe,
+ .remove = goodix_ts_remove,
+ .id_table = ts_core_ids,
+};
+
+static int __init goodix_ts_core_init(void)
+{
+ ts_info("Core layer init");
+
+ if (!goodix_modules.initilized) {
+ goodix_modules.initilized = true;
+ INIT_LIST_HEAD(&goodix_modules.head);
+ mutex_init(&goodix_modules.mutex);
+ init_completion(&goodix_modules.core_comp);
+ }
+
+ goodix_debugfs_init();
+ return platform_driver_register(&goodix_ts_driver);
+}
+
+
+static void __exit goodix_ts_core_exit(void)
+{
+ ts_info("Core layer exit");
+ platform_driver_unregister(&goodix_ts_driver);
+}
+
+module_init(goodix_ts_core_init);
+module_exit(goodix_ts_core_exit);
+
+MODULE_DESCRIPTION("Goodix Touchscreen Core Module");
+MODULE_AUTHOR("Goodix, Inc.");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_core.h b/drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_core.h
new file mode 100755
index 0000000..d913549
--- /dev/null
+++ b/drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_core.h
@@ -0,0 +1,585 @@
+/*
+ * Goodix Touchscreen Driver
+ * Core layer of touchdriver architecture.
+ *
+ * Copyright (C) 2015 - 2016 Goodix, Inc.
+ * Authors: Wang Yafei <wangyafei@...dix.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be a reference
+ * to you, when you are integrating the GOODiX's CTP IC into your system,
+ * 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.
+ *
+ */
+#ifndef _GOODIX_TS_CORE_H_
+#define _GOODIX_TS_CORE_H_
+
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/firmware.h>
+#include <linux/slab.h>
+#include <linux/vmalloc.h>
+#include <linux/kthread.h>
+#include <linux/version.h>
+#include <linux/delay.h>
+#include <linux/mutex.h>
+#include <linux/platform_device.h>
+#include <linux/input.h>
+#ifdef CONFIG_OF
+#include <linux/of_gpio.h>
+#include <linux/regulator/consumer.h>
+#endif
+#ifdef CONFIG_HAS_EARLYSUSPEND
+#include <linux/earlysuspend.h>
+#endif
+
+#include <linux/gpio/consumer.h>
+
+/* macros definition */
+#define GOODIX_CORE_DRIVER_NAME "goodix_ts"
+#define GOODIX_DRIVER_VERSION "v0.8"
+#define GOODIX_BUS_RETRY_TIMES 3
+#define GOODIX_MAX_TOUCH 10
+#define GOODIX_MAX_KEY 3
+#define GOODIX_CFG_MAX_SIZE 1024
+
+/*
+ * struct goodix_ts_board_data - board data
+ * @avdd_name: name of analoy regulator
+ * @reset_gpio: reset gpio number
+ * @irq_gpio: interrupt gpio number
+ * @irq_flag: irq trigger type
+ * @power_on_delay_us: power on delay time (us)
+ * @power_off_delay_us: power off delay time (us)
+ * @swap_axis: whether swaw x y axis
+ * @panel_max_id: max supported fingers
+ * @panel_max_x/y/w/p: resolution and size
+ * @panel_max_key: max supported keys
+ * @pannel_key_map: key map
+ * @fw_name: name of the firmware image
+ */
+struct goodix_ts_board_data {
+ const char *avdd_name;
+ struct gpio_desc *reset_gpiod;
+ struct gpio_desc *irq_gpiod;
+ int irq;
+ unsigned int irq_flags;
+
+ unsigned int power_on_delay_us;
+ unsigned int power_off_delay_us;
+
+ unsigned int swap_axis;
+ unsigned int panel_max_id; /*max touch id*/
+ unsigned int panel_max_x;
+ unsigned int panel_max_y;
+ unsigned int panel_max_w; /*major and minor*/
+ unsigned int panel_max_p; /*pressure*/
+ unsigned int panel_max_key;
+ unsigned int panel_key_map[GOODIX_MAX_KEY];
+
+ const char *fw_name;
+ bool esd_default_on;
+};
+
+/*
+ * struct goodix_ts_config - chip config data
+ * @initialized: whether intialized
+ * @name: name of this config
+ * @lock: mutex
+ * @reg_base: register base of config data
+ * @length: bytes of the config
+ * @delay: delay time after sending config
+ * @data: config data buffer
+ */
+struct goodix_ts_config {
+ bool initialized;
+ char name[24];
+ struct mutex lock;
+ unsigned int reg_base;
+ unsigned int length;
+ unsigned int delay; /*ms*/
+ unsigned char data[GOODIX_CFG_MAX_SIZE];
+};
+
+/*
+ * struct goodix_ts_cmd - command package
+ * @initialized: whether initialized
+ * @cmd_reg: command register
+ * @length: command length in bytes
+ * @cmds: command data
+ */
+#pragma pack(4)
+struct goodix_ts_cmd {
+ u32 initialized;
+ u32 cmd_reg;
+ u32 length;
+ u8 cmds[3];
+};
+#pragma pack()
+
+/* interrupt event type */
+enum ts_event_type {
+ EVENT_INVALID,
+ EVENT_TOUCH,
+ EVENT_REQUEST,
+};
+
+/* requset event type */
+enum ts_request_type {
+ REQUEST_INVALID,
+ REQUEST_CONFIG,
+ REQUEST_BAKREF,
+ REQUEST_RESET,
+ REQUEST_MAINCLK,
+};
+
+/* notifier event */
+
+enum ts_notify_event {
+ NOTIFY_FWUPDATE_START,
+ NOTIFY_FWUPDATE_END,
+ NOTIFY_SUSPEND,
+ NOTIFY_RESUME,
+};
+
+/* coordinate package */
+struct goodix_ts_coords {
+ int id;
+ unsigned int x, y, w, p;
+};
+
+/* touch event data */
+struct goodix_touch_data {
+ /* finger */
+ int touch_num;
+ struct goodix_ts_coords coords[GOODIX_MAX_TOUCH];
+ /* key */
+ u16 key_value;
+};
+
+/* request event data */
+struct goodix_request_data {
+ enum ts_request_type request_type;
+};
+
+/*
+ * struct goodix_ts_event - touch event struct
+ * @event_type: touch event type, touch data or
+ * request event
+ * @event_data: event data
+ */
+struct goodix_ts_event {
+ enum ts_event_type event_type;
+ union {
+ struct goodix_touch_data touch_data;
+ struct goodix_request_data request_data;
+ } event_data;
+};
+
+/*
+ * struct goodix_ts_version - firmware version
+ * @valid: whether these infomation is valid
+ * @pid: product id string
+ * @vid: firmware version code
+ * @cid: customer id code
+ * @sensor_id: sendor id
+ */
+struct goodix_ts_version {
+ bool valid;
+ char pid[5];
+ u16 vid;
+ u8 cid;
+ u8 sensor_id;
+};
+
+/*
+ * struct goodix_ts_device - ts device data
+ * @name: device name
+ * @version: reserved
+ * @bus_type: i2c or spi
+ * @board_data: board data obtained from dts
+ * @normal_cfg: normal config data
+ * @highsense_cfg: high sense config data
+ * @hw_ops: hardware operations
+ * @chip_version: firmware version infomation
+ * @sleep_cmd: sleep commang
+ * @gesture_cmd: gesture command
+ * @dev: device pointer,may be a i2c or spi device
+ * @of_node: device node
+ */
+struct goodix_ts_device {
+ char *name;
+ int version;
+ int bus_type;
+
+ struct goodix_ts_board_data *board_data;
+ struct goodix_ts_config *normal_cfg;
+ struct goodix_ts_config *highsense_cfg;
+ const struct goodix_ts_hw_ops *hw_ops;
+
+ struct goodix_ts_version chip_version;
+ struct goodix_ts_cmd sleep_cmd;
+ struct goodix_ts_cmd gesture_cmd;
+
+ struct device *dev;
+};
+
+/*
+ * struct goodix_ts_hw_ops - hardware opeartions
+ * @init: hardware initialization
+ * @reset: hardware reset
+ * @read: read data from touch device
+ * @write: write data to touch device
+ * @send_cmd: send command to touch device
+ * @send_config: send configuration data
+ * @read_version: read firmware version
+ * @event_handler: touch event handler
+ * @suspend: put touch device into low power mode
+ * @resume: put touch device into working mode
+ */
+struct goodix_ts_hw_ops {
+
+ int (*init)(struct goodix_ts_device *dev);
+ int (*reset)(struct goodix_ts_device *dev);
+ int (*read)(struct goodix_ts_device *dev, unsigned int addr,
+ unsigned char *data, unsigned int len);
+ int (*write)(struct goodix_ts_device *dev, unsigned int addr,
+ unsigned char *data, unsigned int len);
+ int (*send_cmd)(struct goodix_ts_device *dev,
+ struct goodix_ts_cmd *cmd);
+ int (*send_config)(struct goodix_ts_device *dev,
+ struct goodix_ts_config *config);
+ int (*read_version)(struct goodix_ts_device *dev,
+ struct goodix_ts_version *version);
+ int (*event_handler)(struct goodix_ts_device *dev,
+ struct goodix_ts_event *ts_event);
+ int (*check_hw)(struct goodix_ts_device *dev);
+ int (*suspend)(struct goodix_ts_device *dev);
+ int (*resume)(struct goodix_ts_device *dev);
+};
+
+/*
+ * struct goodix_ts_esd - esd protector structure
+ * @esd_work: esd delayed work
+ * @esd_on: true - turn on esd protection, false - turn
+ * off esd protection
+ * @esd_mutex: protect @esd_on flag
+ */
+struct goodix_ts_esd {
+ struct delayed_work esd_work;
+ struct mutex esd_mutex;
+ struct notifier_block esd_notifier;
+ struct goodix_ts_core *ts_core;
+ bool esd_on;
+};
+
+/*
+ * struct godix_ts_core - core layer data struct
+ * @pdev: core layer platform device
+ * @ts_dev: hardware layer touch device
+ * @input_dev: input device
+ * @avdd: analog regulator
+ * @pinctrl: pinctrl handler
+ * @pin_sta_active: active/normal pin state
+ * @pin_sta_suspend: suspend/sleep pin state
+ * @ts_event: touch event data struct
+ * @power_on: power on/off flag
+ * @irq: irq number
+ * @irq_enabled: irq enabled/disabled flag
+ * @suspended: suspend/resume flag
+ * @hw_err: indicate that hw_ops->init() failed
+ * @ts_notifier: generic notifier
+ * @ts_esd: esd protector structure
+ * @fb_notifier: framebuffer notifier
+ * @early_suspend: early suspend
+ */
+struct goodix_ts_core {
+ struct platform_device *pdev;
+ struct goodix_ts_device *ts_dev;
+ struct input_dev *input_dev;
+
+ struct regulator *avdd;
+#ifdef CONFIG_PINCTRL
+ struct pinctrl *pinctrl;
+ struct pinctrl_state *pin_sta_active;
+ struct pinctrl_state *pin_sta_suspend;
+#endif
+ struct goodix_ts_event ts_event;
+ int power_on;
+ int irq;
+ size_t irq_trig_cnt;
+
+ atomic_t irq_enabled;
+ atomic_t suspended;
+ bool hw_err;
+
+ struct notifier_block ts_notifier;
+ struct goodix_ts_esd ts_esd;
+
+#ifdef CONFIG_FB
+ struct notifier_block fb_notifier;
+#elif defined(CONFIG_HAS_EARLYSUSPEND)
+ struct early_suspend early_suspend;
+#endif
+};
+
+/* external module structures */
+enum goodix_ext_priority {
+ EXTMOD_PRIO_RESERVED = 0,
+ EXTMOD_PRIO_FWUPDATE,
+ EXTMOD_PRIO_GESTURE,
+ EXTMOD_PRIO_HOTKNOT,
+ EXTMOD_PRIO_DBGTOOL,
+ EXTMOD_PRIO_DEFAULT,
+};
+
+struct goodix_ext_module;
+/* external module's operations callback */
+struct goodix_ext_module_funcs {
+ int (*init)(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module);
+ int (*exit)(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module);
+
+ int (*before_reset)(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module);
+ int (*after_reset)(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module);
+
+ int (*before_suspend)(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module);
+ int (*after_suspend)(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module);
+
+ int (*before_resume)(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module);
+ int (*after_resume)(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module);
+
+ int (*irq_event)(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module);
+};
+
+/*
+ * struct goodix_ext_module - external module struct
+ * @list: list used to link into modules manager
+ * @name: name of external module
+ * @priority: module priority vlaue, zero is invalid
+ * @funcs: operations callback
+ * @priv_data: private data region
+ * @kobj: kobject
+ * @work: used to queue one work to do registration
+ */
+struct goodix_ext_module {
+ struct list_head list;
+ char *name;
+ enum goodix_ext_priority priority;
+ const struct goodix_ext_module_funcs *funcs;
+ void *priv_data;
+ struct kobject kobj;
+ struct work_struct work;
+};
+
+/*
+ * struct goodix_ext_attribute - exteranl attribute struct
+ * @attr: attribute
+ * @show: show interface of external attribute
+ * @store: store interface of external attribute
+ */
+struct goodix_ext_attribute {
+ struct attribute attr;
+ ssize_t (*show)(struct goodix_ext_module *, char *);
+ ssize_t (*store)(struct goodix_ext_module *, const char *, size_t);
+};
+
+/* external attrs helper macro */
+#define __EXTMOD_ATTR(_name, _mode, _show, _store) { \
+ .attr = {.name = __stringify(_name), .mode = _mode }, \
+ .show = _show, \
+ .store = _store, \
+}
+
+/* external attrs helper macro, used to define external attrs */
+#define DEFINE_EXTMOD_ATTR(_name, _mode, _show, _store) \
+static struct goodix_ext_attribute ext_attr_##_name = \
+ __EXTMOD_ATTR(_name, _mode, _show, _store)
+
+/*
+ * get board data pointer
+ */
+static inline struct goodix_ts_board_data *board_data(
+ struct goodix_ts_core *core)
+{
+ return core->ts_dev->board_data;
+}
+
+/*
+ * get touch device pointer
+ */
+static inline struct goodix_ts_device *ts_device(
+ struct goodix_ts_core *core)
+{
+ return core->ts_dev;
+}
+
+/*
+ * get touch hardware operations pointer
+ */
+static inline const struct goodix_ts_hw_ops *ts_hw_ops(
+ struct goodix_ts_core *core)
+{
+ return core->ts_dev->hw_ops;
+}
+
+/*
+ * checksum helper functions
+ * checksum can be u8/le16/be16/le32/be32 format
+ * NOTE: the caller shoule be responsible for the
+ * legality of @data and @size parameters, so be
+ * careful when call these functions.
+ */
+static inline u8 checksum_u8(u8 *data, u32 size)
+{
+ u8 checksum = 0;
+ u32 i;
+
+ for (i = 0; i < size; i++)
+ checksum += data[i];
+ return checksum;
+}
+
+static inline u16 checksum_le16(u8 *data, u32 size)
+{
+ u16 checksum = 0;
+ u32 i;
+
+ for (i = 0; i < size; i += 2)
+ checksum += le16_to_cpup((__le16 *)(data + i));
+ return checksum;
+}
+
+static inline u16 checksum_be16(u8 *data, u32 size)
+{
+ u16 checksum = 0;
+ u32 i;
+
+ for (i = 0; i < size; i += 2)
+ checksum += be16_to_cpup((__be16 *)(data + i));
+ return checksum;
+}
+
+static inline u32 checksum_le32(u8 *data, u32 size)
+{
+ u32 checksum = 0;
+ u32 i;
+
+ for (i = 0; i < size; i += 4)
+ checksum += le32_to_cpup((__le32 *)(data + i));
+ return checksum;
+}
+
+static inline u32 checksum_be32(u8 *data, u32 size)
+{
+ u32 checksum = 0;
+ u32 i;
+
+ for (i = 0; i < size; i += 4)
+ checksum += be32_to_cpup((__be32 *)(data + i));
+ return checksum;
+}
+
+/*
+ * define event action
+ * EVT_xxx macros are used in opeartions callback
+ * defined in @goodix_ext_module_funcs to control
+ * the behaviors of event such as suspend/resume/
+ * irq_event.
+ *
+ * generally there are two types of behaviors:
+ * 1. you want the flow of this event be canceled,
+ * in this condition, you should return EVT_CANCEL_XXX
+ * in the operations callback.
+ * e.g. the firmware update module is updating
+ * the firmware, you want to cancel suspend flow,
+ * so you need to return EVT_CANCEL_SUSPEND in
+ * suspend callback function.
+ * 2. you want the flow of this event continue, in
+ * this condition, you should return EVT_HANDLED in
+ * the callback function.
+ */
+#define EVT_HANDLED 0
+#define EVT_CONTINUE 0
+#define EVT_CANCEL 1
+#define EVT_CANCEL_IRQEVT 1
+#define EVT_CANCEL_SUSPEND 1
+#define EVT_CANCEL_RESUME 1
+#define EVT_CANCEL_RESET 1
+
+/*
+ * errno define
+ * Note:
+ * 1. bus read/write functions defined in hardware
+ * layer code(e.g. goodix_xxx_i2c.c) *must* return
+ * -EBUS if failed to transfer data on bus.
+ */
+#define EBUS 1000
+#define ETIMEOUT 1001
+#define ECHKSUM 1002
+#define EMEMCMP 1003
+
+#define CONFIG_GOODIX_DEBUG
+/* log macro */
+#define ts_info(fmt, arg...) pr_info("[GTP-INF][%s:%d] "fmt"\n", __func__, __LINE__, ##arg)
+#define ts_err(fmt, arg...) pr_err("[GTP-ERR][%s:%d] "fmt"\n", __func__, __LINE__, ##arg)
+#define boot_log(fmt, arg...) g_info(fmt, ##arg)
+#ifdef CONFIG_GOODIX_DEBUG
+#define ts_debug(fmt, arg...) pr_info("[GTP-DBG][%s:%d] "fmt"\n", __func__, __LINE__, ##arg)
+#else
+#define ts_debug(fmt, arg...) do {} while (0)
+#endif
+
+/**
+ * goodix_register_ext_module - interface for external module
+ * to register into touch core modules structure
+ *
+ * @module: pointer to external module to be register
+ * return: 0 ok, <0 failed
+ */
+int goodix_register_ext_module(struct goodix_ext_module *module);
+
+/**
+ * goodix_unregister_ext_module - interface for external module
+ * to unregister external modules
+ *
+ * @module: pointer to external module
+ * return: 0 ok, <0 failed
+ */
+int goodix_unregister_ext_module(struct goodix_ext_module *module);
+
+/**
+ * goodix_ts_irq_enable - Enable/Disable a irq
+
+ * @core_data: pointer to touch core data
+ * enable: enable or disable irq
+ * return: 0 ok, <0 failed
+ */
+int goodix_ts_irq_enable(struct goodix_ts_core *core_data, bool enable);
+
+struct kobj_type *goodix_get_default_ktype(void);
+
+/**
+ * fb_notifier_call_chain - notify clients of fb_events
+ * see enum ts_notify_event in goodix_ts_core.h
+ */
+int goodix_ts_blocking_notify(enum ts_notify_event evt, void *v);
+
+extern void goodix_msg_printf(const char *fmt, ...);
+
+#endif
diff --git a/drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_tools.c b/drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_tools.c
new file mode 100755
index 0000000..112567a
--- /dev/null
+++ b/drivers/input/touchscreen/goodix-ts-sunrise/goodix_ts_tools.c
@@ -0,0 +1,552 @@
+/*
+ * Goodix GTX5 tools Dirver
+ *
+ * Copyright (C) 2015 - 2016 Goodix, Inc.
+ * Authors: Wang Yafei <wangyafei@...dix.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be a reference
+ * to you, when you are integrating the GOODiX's CTP IC into your system,
+ * 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.
+ */
+
+#include <linux/module.h>
+#include <linux/compat.h>
+#include <linux/kernel.h>
+#include <linux/atomic.h>
+#include <linux/miscdevice.h>
+#include <linux/slab.h>
+#include <linux/uaccess.h>
+#include <linux/fs.h>
+#include <linux/list.h>
+#include <linux/ioctl.h>
+#include <linux/wait.h>
+#include "goodix_ts_core.h"
+
+#define GOODIX_TOOLS_NAME "gtp_tools"
+#define GOODIX_TS_IOC_MAGIC 'G'
+#define NEGLECT_SIZE_MASK (~(_IOC_SIZEMASK << _IOC_SIZESHIFT))
+
+#define GTP_IRQ_ENABLE _IO(GOODIX_TS_IOC_MAGIC, 0)
+#define GTP_DEV_RESET _IO(GOODIX_TS_IOC_MAGIC, 1)
+#define GTP_SEND_COMMAND (_IOW(GOODIX_TS_IOC_MAGIC, 2, u8) & NEGLECT_SIZE_MASK)
+#define GTP_SEND_CONFIG (_IOW(GOODIX_TS_IOC_MAGIC, 3, u8) & NEGLECT_SIZE_MASK)
+#define GTP_ASYNC_READ (_IOR(GOODIX_TS_IOC_MAGIC, 4, u8) & NEGLECT_SIZE_MASK)
+#define GTP_SYNC_READ (_IOR(GOODIX_TS_IOC_MAGIC, 5, u8) & NEGLECT_SIZE_MASK)
+#define GTP_ASYNC_WRITE (_IOW(GOODIX_TS_IOC_MAGIC, 6, u8) & NEGLECT_SIZE_MASK)
+
+#define GOODIX_TS_IOC_MAXNR 6
+
+#define IRQ_FALG (0x01 << 2)
+
+#define I2C_MSG_HEAD_LEN 20
+#define MAX_DATA_LEN 4096
+#define TS_REG_COORDS_BASE 0x824E
+/*
+ * struct goodix_tools_data - goodix tools data message used in sync read
+ * @data: The buffer into which data is written
+ * @reg_addr: Slave device register start address to start read data
+ * @length: Number of data bytes in @data being read from slave device
+ * @filled: When buffer @data be filled will set this flag with 1, outhrwise 0
+ * @list_head:Eonnet every goodix_tools_data struct into a list
+ */
+
+struct goodix_tools_data {
+ u32 reg_addr;
+ u32 length;
+ u8 *data;
+ bool filled;
+ struct list_head list;
+};
+
+
+/*
+ * struct goodix_tools_dev - goodix tools device struct
+ * @ts_core: The core data struct of ts driver
+ * @ops_mode: represent device work mode
+ * @rawdiffcmd: Set slave device into rawdata mode
+ * @normalcmd: Set slave device into normal mode
+ * @wq: Wait queue struct use in synchronous data read
+ * @mutex: Protect goodix_tools_dev
+ * @ref_count: reference count
+ * @ref_mutex: Protect ref_count
+ */
+struct goodix_tools_dev {
+ struct goodix_ts_core *ts_core;
+ struct list_head head;
+ unsigned int ops_mode;
+ struct goodix_ts_cmd rawdiffcmd, normalcmd;
+ wait_queue_head_t wq;
+ struct mutex mutex;
+ int ref_count;
+ struct mutex ref_mutex;
+ struct goodix_ext_module module;
+} *goodix_tools_dev;
+
+
+/* read data from i2c asynchronous,
+ * success return bytes read, else return <= 0
+ */
+static int async_read(struct goodix_tools_dev *dev, void __user *arg)
+{
+ u8 *databuf = NULL;
+ int ret = 0;
+ u32 reg_addr, length;
+ u8 i2c_msg_head[I2C_MSG_HEAD_LEN];
+ struct goodix_ts_device *ts_dev = dev->ts_core->ts_dev;
+ const struct goodix_ts_hw_ops *hw_ops = ts_dev->hw_ops;
+
+ ret = copy_from_user(&i2c_msg_head, arg, I2C_MSG_HEAD_LEN);
+ if (ret) {
+ ret = -EFAULT;
+ goto err_out;
+ }
+ reg_addr = le32_to_cpup((__le32 *)&i2c_msg_head[0]);
+ length = le32_to_cpup((__le32 *)&i2c_msg_head[4]);
+ if (length > MAX_DATA_LEN) {
+ ts_info("I2C data too long:%d, cut to 4096", length);
+ length = MAX_DATA_LEN;
+ }
+ databuf = kzalloc(length, GFP_KERNEL);
+ if (!databuf)
+ return -ENOMEM;
+
+ if (!hw_ops->read(ts_dev, reg_addr, databuf, length)) {
+ if (copy_to_user((u8 *)arg + I2C_MSG_HEAD_LEN,
+ databuf, length)) {
+ ret = -EFAULT;
+ ts_err("Copy_to_user failed");
+ } else {
+ ret = length;
+ }
+ } else {
+ ret = -EBUSY;
+ ts_err("Read i2c failed");
+ }
+err_out:
+ kfree(databuf);
+ return ret;
+}
+
+/* read data from i2c synchronous,
+ * success return bytes read, else return <= 0
+ */
+static int sync_read(struct goodix_tools_dev *dev, void __user *arg)
+{
+ int ret = 0;
+ u8 i2c_msg_head[I2C_MSG_HEAD_LEN];
+ struct goodix_tools_data tools_data;
+
+ ret = copy_from_user(&i2c_msg_head, arg, I2C_MSG_HEAD_LEN);
+ if (ret) {
+ ts_err("Copy data from user failed");
+ return -EFAULT;
+ }
+ tools_data.reg_addr = le32_to_cpup((__le32 *)&i2c_msg_head[0]);
+ tools_data.length = le32_to_cpup((__le32 *)&i2c_msg_head[4]);
+ tools_data.filled = 0;
+ if (tools_data.length > MAX_DATA_LEN) {
+ ts_info("I2C data too long:%d, cut to 4096", tools_data.length);
+ tools_data.length = MAX_DATA_LEN;
+ }
+
+ tools_data.data = kzalloc(tools_data.length, GFP_KERNEL);
+ if (!tools_data.data)
+ return -ENOMEM;
+
+ mutex_lock(&dev->mutex);
+ list_add_tail(&tools_data.list, &dev->head);
+ mutex_unlock(&dev->mutex);
+ /* wait queue will timeout after 1 seconds */
+ wait_event_interruptible_timeout(dev->wq, tools_data.filled == 1, HZ);
+
+ mutex_lock(&dev->mutex);
+ list_del(&tools_data.list);
+ mutex_unlock(&dev->mutex);
+ if (tools_data.filled == 1) {
+ if (copy_to_user((u8 *)arg + I2C_MSG_HEAD_LEN, tools_data.data,
+ tools_data.length)) {
+ ret = -EFAULT;
+ ts_err("Copy_to_user failed");
+ } else {
+ ret = tools_data.length;
+ }
+ } else {
+ ret = -EAGAIN;
+ ts_err("Wait queue timeout");
+ }
+
+ kfree(tools_data.data);
+ return ret;
+}
+
+/* write data to i2c asynchronous,
+ * success return bytes write, else return <= 0
+ */
+static int async_write(struct goodix_tools_dev *dev, void __user *arg)
+{
+ u8 *databuf;
+ int ret = 0;
+ u32 reg_addr, length;
+ u8 i2c_msg_head[I2C_MSG_HEAD_LEN];
+ struct goodix_ts_device *ts_dev = dev->ts_core->ts_dev;
+ const struct goodix_ts_hw_ops *hw_ops = ts_dev->hw_ops;
+
+ ret = copy_from_user(&i2c_msg_head, arg, I2C_MSG_HEAD_LEN);
+ if (ret) {
+ ts_err("Copy data from user failed");
+ return -EFAULT;
+ }
+
+ reg_addr = le32_to_cpup((__le32 *)&i2c_msg_head[0]);
+ length = le32_to_cpup((__le32 *)&i2c_msg_head[4]);
+ if (length > MAX_DATA_LEN) {
+ ts_info("I2C data too long:%d, cut to 4096", length);
+ length = MAX_DATA_LEN;
+ }
+
+ databuf = kzalloc(length, GFP_KERNEL);
+ if (!databuf)
+ return -ENOMEM;
+
+ ret = copy_from_user(databuf, (u8 *)arg + I2C_MSG_HEAD_LEN, length);
+ if (ret) {
+ ret = -EFAULT;
+ ts_err("Copy data from user failed");
+ goto err_out;
+ }
+
+ if (hw_ops->write(ts_dev, reg_addr, databuf, length)) {
+ ret = -EBUSY;
+ ts_err("Write data to device failed");
+ } else {
+ ret = length;
+ }
+
+err_out:
+ kfree(databuf);
+ return ret;
+}
+
+static int init_cfg_data(struct goodix_ts_config *cfg, void __user *arg)
+{
+ int ret = 0;
+ u32 reg_addr, length;
+ u8 i2c_msg_head[I2C_MSG_HEAD_LEN];
+
+ cfg->initialized = 0;
+ mutex_init(&cfg->lock);
+ ret = copy_from_user(&i2c_msg_head, arg, I2C_MSG_HEAD_LEN);
+ if (ret) {
+ ts_err("Copy data from user failed");
+ return -EFAULT;
+ }
+
+ reg_addr = le32_to_cpup((__le32 *)&i2c_msg_head[0]);
+ length = le32_to_cpup((__le32 *)&i2c_msg_head[4]);
+ if (length > MAX_DATA_LEN) {
+ ts_info("I2C data too long:%d, cut to 4096", length);
+ length = MAX_DATA_LEN;
+ }
+
+ ret = copy_from_user(cfg->data, (u8 *)arg + I2C_MSG_HEAD_LEN, length);
+ if (ret) {
+ ret = -EFAULT;
+ ts_err("Copy data from user failed");
+ goto err_out;
+ }
+ cfg->reg_base = reg_addr;
+ cfg->length = length;
+ strlcpy(cfg->name, "tools-send-cfg", sizeof(cfg->name));
+ cfg->delay = 50;
+ cfg->initialized = true;
+ return 0;
+
+err_out:
+ return ret;
+}
+/**
+ * goodix_tools_ioctl - ioctl implementation
+ *
+ * @filp: Pointer to file opened
+ * @cmd: Ioctl opertion command
+ * @arg: Command data
+ * Returns >=0 - succeed, else failed
+ */
+static long goodix_tools_ioctl(struct file *filp, unsigned int cmd,
+ unsigned long arg)
+{
+ int ret = 0;
+ struct goodix_tools_dev *dev = filp->private_data;
+ struct goodix_ts_device *ts_dev;
+ const struct goodix_ts_hw_ops *hw_ops;
+ struct goodix_ts_cmd temp_cmd;
+ struct goodix_ts_config *temp_cfg;
+
+ if (dev->ts_core == NULL) {
+ ts_err("Tools module not register");
+ return -EINVAL;
+ }
+ ts_dev = dev->ts_core->ts_dev;
+ hw_ops = ts_dev->hw_ops;
+
+ if (_IOC_TYPE(cmd) != GOODIX_TS_IOC_MAGIC)
+ return -ENOTTY;
+ if (_IOC_NR(cmd) > GOODIX_TS_IOC_MAXNR)
+ return -ENOTTY;
+
+
+ switch (cmd & NEGLECT_SIZE_MASK) {
+ case GTP_IRQ_ENABLE:
+ if (arg == 1) {
+ goodix_ts_irq_enable(dev->ts_core, true);
+ mutex_lock(&dev->mutex);
+ dev->ops_mode |= IRQ_FALG;
+ mutex_unlock(&dev->mutex);
+ ts_info("IRQ enabled");
+ } else if (arg == 0) {
+ goodix_ts_irq_enable(dev->ts_core, false);
+ mutex_lock(&dev->mutex);
+ dev->ops_mode &= ~IRQ_FALG;
+ mutex_unlock(&dev->mutex);
+ ts_info("IRQ disabled");
+ } else {
+ ts_info("Irq already set with, arg = %ld", arg);
+ }
+ ret = 0;
+ break;
+ case GTP_DEV_RESET:
+ hw_ops->reset(ts_dev);
+ break;
+ case GTP_SEND_COMMAND:
+ ret = copy_from_user(&temp_cmd, (void __user *)arg,
+ sizeof(struct goodix_ts_cmd));
+ if (ret) {
+ ret = -EINVAL;
+ goto err_out;
+ }
+
+ ret = hw_ops->send_cmd(ts_dev, &temp_cmd);
+ if (ret) {
+ ts_err("Send command failed");
+ ret = -EAGAIN;
+ }
+ break;
+ case GTP_SEND_CONFIG:
+ temp_cfg = kzalloc(sizeof(struct goodix_ts_config), GFP_KERNEL);
+ if (!temp_cfg) {
+ ret = -ENOMEM;
+ goto err_out;
+ }
+ ret = init_cfg_data(temp_cfg, (void __user *)arg);
+
+ if (!ret) {
+ ret = hw_ops->send_config(ts_dev, temp_cfg);
+ if (ret) {
+ ts_err("Failed send config");
+ ret = -EAGAIN;
+ } else {
+ ts_info("Send config success");
+ ret = 0;
+ }
+ }
+ kfree(temp_cfg);
+ break;
+ case GTP_ASYNC_READ:
+ ret = async_read(dev, (void __user *)arg);
+ if (ret < 0)
+ ts_err("Async data read failed");
+ break;
+ case GTP_SYNC_READ:
+ if (filp->f_flags & O_NONBLOCK) {
+ ts_err("Goodix tools now worked in sync_bus mode");
+ ret = -EAGAIN;
+ goto err_out;
+ }
+ ret = sync_read(dev, (void __user *)arg);
+ if (ret < 0)
+ ts_err("Sync data read failed");
+ break;
+ case GTP_ASYNC_WRITE:
+ ret = async_write(dev, (void __user *)arg);
+ if (ret < 0)
+ ts_err("Async data write failed");
+ break;
+ default:
+ ts_info("Invalid cmd");
+ ret = -ENOTTY;
+ break;
+ }
+
+err_out:
+ return ret;
+}
+
+#ifdef CONFIG_COMPAT
+static long goodix_tools_compat_ioctl(struct file *file, unsigned int cmd,
+ unsigned long arg)
+{
+ //void __user *arg32 = compat_ptr(arg);
+
+ if (!file->f_op || !file->f_op->unlocked_ioctl)
+ return -ENOTTY;
+ //return file->f_op->unlocked_ioctl(file, cmd, (unsigned long)arg32);
+ return goodix_tools_ioctl(file, cmd, (unsigned long)compat_ptr(arg));
+}
+#endif
+
+static int goodix_tools_open(struct inode *inode, struct file *filp)
+{
+ int ret = 0;
+
+ filp->private_data = goodix_tools_dev;
+
+ mutex_lock(&goodix_tools_dev->ref_mutex);
+
+ /* Only the first time open device need to register module */
+ if (goodix_tools_dev->ref_count == 0)
+ ret = goodix_register_ext_module(&goodix_tools_dev->module);
+ if (!ret)
+ goodix_tools_dev->ref_count++;
+
+ mutex_unlock(&goodix_tools_dev->ref_mutex);
+ return ret;
+}
+
+static int goodix_tools_release(struct inode *inode, struct file *filp)
+{
+ int ret = 0;
+
+ mutex_lock(&goodix_tools_dev->ref_mutex);
+
+ goodix_tools_dev->ref_count--;
+ /* when the last close this dev node unregister the module */
+ if (goodix_tools_dev->ref_count == 0)
+ ret = goodix_unregister_ext_module(&goodix_tools_dev->module);
+
+ mutex_unlock(&goodix_tools_dev->ref_mutex);
+ return ret;
+}
+
+/**
+ * goodix_tools_module_irq - goodix tools Irq handle
+ * This functions is excuted when interrupt happened
+ *
+ * @core_data: pointer to touch core data
+ * @module: pointer to goodix_ext_module struct
+ * return: EVT_CONTINUE let other module handle this irq
+ */
+static int goodix_tools_module_irq(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module)
+{
+ struct goodix_tools_dev *dev = module->priv_data;
+ struct goodix_ts_device *ts_dev = dev->ts_core->ts_dev;
+ const struct goodix_ts_hw_ops *hw_ops = ts_dev->hw_ops;
+ struct goodix_tools_data *tools_data;
+ int r = 0;
+ u8 evt_sta = 0;
+
+ if (!list_empty(&dev->head)) {
+ r = hw_ops->read(ts_dev, TS_REG_COORDS_BASE, &evt_sta, 1);
+ if (r < 0 || ((evt_sta & 0x80) == 0))
+ return EVT_CONTINUE;
+
+ mutex_lock(&dev->mutex);
+ list_for_each_entry(tools_data, &dev->head, list) {
+ if (!hw_ops->read(ts_dev, tools_data->reg_addr,
+ tools_data->data, tools_data->length)) {
+ tools_data->filled = 1;
+ }
+ }
+ mutex_unlock(&dev->mutex);
+ wake_up(&dev->wq);
+ }
+ return EVT_CONTINUE;
+}
+
+static int goodix_tools_module_init(struct goodix_ts_core *core_data,
+ struct goodix_ext_module *module)
+{
+ struct goodix_tools_dev *dev = module->priv_data;
+
+ if (core_data) {
+ dev->ts_core = core_data;
+ return 0;
+ } else {
+ return -ENODEV;
+ }
+}
+
+static const struct file_operations goodix_tools_fops = {
+ .owner = THIS_MODULE,
+ .open = goodix_tools_open,
+ .release = goodix_tools_release,
+ .unlocked_ioctl = goodix_tools_ioctl,
+#ifdef CONFIG_COMPAT
+ .compat_ioctl = goodix_tools_compat_ioctl,
+#endif
+};
+
+static struct miscdevice goodix_tools_miscdev = {
+ .minor = MISC_DYNAMIC_MINOR,
+ .name = GOODIX_TOOLS_NAME,
+ .fops = &goodix_tools_fops,
+};
+
+static struct goodix_ext_module_funcs goodix_tools_module_funcs = {
+ .irq_event = goodix_tools_module_irq,
+ .init = goodix_tools_module_init,
+};
+
+/**
+ * goodix_tools_init - init goodix tools device and register a miscdevice
+ *
+ * return: 0 success, else failed
+ */
+static int __init goodix_tools_init(void)
+{
+ int ret;
+
+ goodix_tools_dev = kzalloc(sizeof(struct goodix_tools_dev), GFP_KERNEL);
+ if (!goodix_tools_dev)
+ return -ENOMEM;
+
+ INIT_LIST_HEAD(&goodix_tools_dev->head);
+ goodix_tools_dev->ops_mode = 0;
+ goodix_tools_dev->ops_mode |= IRQ_FALG;
+ init_waitqueue_head(&goodix_tools_dev->wq);
+ mutex_init(&goodix_tools_dev->mutex);
+ goodix_tools_dev->ref_count = 0;
+ mutex_init(&goodix_tools_dev->ref_mutex);
+
+ goodix_tools_dev->module.funcs = &goodix_tools_module_funcs;
+ goodix_tools_dev->module.name = GOODIX_TOOLS_NAME;
+ goodix_tools_dev->module.priv_data = goodix_tools_dev;
+ goodix_tools_dev->module.priority = EXTMOD_PRIO_DBGTOOL;
+
+ ret = misc_register(&goodix_tools_miscdev);
+ if (ret)
+ ts_err("Debug tools miscdev register failed");
+
+ return ret;
+}
+
+static void __exit goodix_tools_exit(void)
+{
+ misc_deregister(&goodix_tools_miscdev);
+ kfree(goodix_tools_dev);
+ ts_info("Goodix tools miscdev exit");
+}
+
+module_init(goodix_tools_init);
+module_exit(goodix_tools_exit);
+
+MODULE_DESCRIPTION("Goodix tools Module");
+MODULE_AUTHOR("Goodix, Inc.");
+MODULE_LICENSE("GPL v2");
--
2.7.4
Powered by blists - more mailing lists