From patchwork Mon Nov 23 12:01:34 2015 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Patchwork-Submitter: =?utf-8?q?Mika_Penttil=C3=A4?= X-Patchwork-Id: 7680811 Return-Path: X-Original-To: patchwork-linux-input@patchwork.kernel.org Delivered-To: patchwork-parsemail@patchwork1.web.kernel.org Received: from mail.kernel.org (mail.kernel.org [198.145.29.136]) by patchwork1.web.kernel.org (Postfix) with ESMTP id B4F4C9F1BE for ; Mon, 23 Nov 2015 12:19:06 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id 064CB206DB for ; Mon, 23 Nov 2015 12:19:05 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id 41BC92051C for ; Mon, 23 Nov 2015 12:19:03 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1752207AbbKWMTB (ORCPT ); Mon, 23 Nov 2015 07:19:01 -0500 Received: from mail-db3on0084.outbound.protection.outlook.com ([157.55.234.84]:23602 "EHLO emea01-db3-obe.outbound.protection.outlook.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S1751076AbbKWMS7 (ORCPT ); Mon, 23 Nov 2015 07:18:59 -0500 Received: from HE1PR07MB0907.eurprd07.prod.outlook.com (10.162.26.14) by HE1PR07MB0795.eurprd07.prod.outlook.com (10.162.24.146) with Microsoft SMTP Server (TLS) id 15.1.331.20; Mon, 23 Nov 2015 12:03:47 +0000 Authentication-Results: spf=none (sender IP is ) smtp.mailfrom=mika.penttila@nextfour.com; Received: from mjp-ThinkCentre-M92p.nextfour.com (194.157.170.34) by HE1PR07MB0907.eurprd07.prod.outlook.com (10.162.26.14) with Microsoft SMTP Server (TLS) id 15.1.325.17; Mon, 23 Nov 2015 12:03:45 +0000 From: To: CC: , , =?UTF-8?q?Mika=20Penttil=C3=A4?= Subject: [PATCH 1/2] INPUT: Driver for SiS 9200 family I2C touchscreen controller. Date: Mon, 23 Nov 2015 14:01:34 +0200 Message-ID: <1448280095-27680-2-git-send-email-mika.penttila@nextfour.com> X-Mailer: git-send-email 1.9.1 In-Reply-To: <1448280095-27680-1-git-send-email-mika.penttila@nextfour.com> References: <1448280095-27680-1-git-send-email-mika.penttila@nextfour.com> MIME-Version: 1.0 X-Originating-IP: [194.157.170.34] X-ClientProxiedBy: HE1PR03CA0013.eurprd03.prod.outlook.com (25.163.170.151) To HE1PR07MB0907.eurprd07.prod.outlook.com (25.162.26.14) X-Microsoft-Exchange-Diagnostics: 1; HE1PR07MB0907; 2:z0ERC9Zb0YQGAJ9Mk6PxV3JdX5GgHNwwrQM8Lzj2ACc7+991qO0sV7Fh8mPgM3OB1MECH9bPuu3ZgqIlKujuGR9njGuxgbwQcEwhvpb+uO70pBnzo9FBQQInKOIJ/x/SAt2Tk83dHcJYglBgyv1d3MTyC/l4nQZwGL6KVywRmUA=; 3:mq6+1tAJXjv2UnX+HDUDW99RKfoVZIvgCrC2TKj+27hwYHts7wazLdHo4l+3UYFj8F6Ojbavp+MuwDwTVOj75o0vJHZvtf9M8mi8m0YjtLatxoJx43sosqc+5OfBz5JcADi/kVE2neR/D+KJZTu6Pg==; 25:3cPe9sdhNjllP9YdcHwQ6RIx0r/CefQk720KuiPbOtVegE5aBjUGaqiXDaiaiKJluueh7nd68/xJSFXwUVbucAMAHSpRMenOjUJPo680m0iYo9iebbB2h/ppstdZJ2FxSwSIe/j1DSbHmu5F7kp+AoEFzEKhyWWaHK6ob2RIednO4cezJePKLQ9aYMLHlc9Y2UXmDNY7zOjTLk9SNyD4/2WshSuRjT3Y1/ZALJXATjw2LHrUF7846morq+d1RU0q; 4:f7Y7WyS164EYVnVM5hOLIURNigFYuLc1A47MCro/G/HNwK5w3D7Tt9BRt+2a7z7PyYIy5oDgYHb3lnxEzkSrFQEE5KQ2wPncL7+hxSLr2X0SqHp5RvLqd0vR3/UW/+dvIC7rsI4RJVD4bbem5OiV+8GsnCsZrwoOtnkj+Va7tAqzsOU+rX2uy7kMjDZ3RyxthYIfxturoY0UINggxx2TcqMJSx8t6yayAIQwwSnTP+DDKk5t0yv7iUQ0ZHDM/Bf1ZSFIafnq54i+b1KsYtwopvLcPw28CDQPO57OZhGtvPqdS6ylPrnN+PlyXXuVpdhozS2HITpK091oRwamiYEd7ixk1jx1 1KVwxgfDILADnyIK+yMziY6DmVrtJi334fat X-Microsoft-Antispam: UriScan:;BCL:0;PCL:0;RULEID:;SRVR:HE1PR07MB0907; X-Microsoft-Antispam-PRVS: X-Exchange-Antispam-Report-Test: UriScan:(57076107561441); X-Exchange-Antispam-Report-CFA-Test: BCL:0; PCL:0; RULEID:(601004)(2401047)(8121501046)(5005006)(520078)(10201501046)(3002001); SRVR:HE1PR07MB0907; BCL:0; PCL:0; RULEID:; SRVR:HE1PR07MB0907; X-Forefront-PRVS: 07697999E6 X-Forefront-Antispam-Report: SFV:NSPM; SFS:(10009020)(6009001)(189002)(199003)(3846002)(105586002)(50466002)(2351001)(575784001)(106356001)(86152002)(86362001)(92566002)(76176999)(53416004)(87976001)(229853001)(33646002)(50986999)(50226001)(5820100001)(23676002)(77096005)(122386002)(40100003)(101416001)(36756003)(47776003)(19580395003)(19580405001)(42186005)(81156007)(69596002)(5004730100002)(66066001)(189998001)(6116002)(110136002)(4001430100002)(2950100001)(5007970100001)(5001960100002)(586003)(5001920100001)(107886002)(5008740100001)(97736004)(2004002); DIR:OUT; SFP:1101; SCL:1; SRVR:HE1PR07MB0907; H:mjp-ThinkCentre-M92p.nextfour.com; FPR:; SPF:None; PTR:InfoNoRecords; MX:1; A:1; LANG:en; Received-SPF: None (protection.outlook.com: nextfour.com does not designate permitted sender hosts) X-Microsoft-Exchange-Diagnostics: =?utf-8?B?MTtIRTFQUjA3TUIwOTA3OzIzOnBycWtXLytJUFdGRXNoL3FXeEJiMkFqWkd5?= =?utf-8?B?dmEwTTBMMFlTamlUVmRseEJKbkpYU3V4Zi9Ed0NGeDRtWWtaOG85TWJzdTB3?= =?utf-8?B?SDY2MElWU3JQOWI3aE8vVHB5UWNoMjhxNjE0dDFWMUd3UkpRL0R5dU4vaFN3?= =?utf-8?B?RGIydFhCQVIrNUVhVi9yTXBsaDRvQ1B2Smx2cUIrZitEZ2JQYnJoTjkwZTBi?= =?utf-8?B?ZnVXUVpZNEptc2NoVFZjQTc4RTg0dXlwTmsrR0lEdy80bE92RHRZbU9ZU0Ix?= =?utf-8?B?QmtxKzJrQk1nc2E4ZkJYWkVEQUd1R1pZVSthMzNTSk9FcXZTRTdOOWpwc1VE?= =?utf-8?B?L3FqZVExMm5GSzh1RW5RaEIxbHZFTEROeS9hTkoxOTlvbW9VaDI2dGtpNVBN?= =?utf-8?B?YXV5dmFsUTRLRE9WWmJ0WEFhekM3Ly95alJieU4yWE9QbDFmSmpXMzB3cHB2?= =?utf-8?B?MHVEUWhuQmNmUzVEdkhHUUhvNldUNytXTjA5YkdhL083Y3VFVUJ5SFBSUFRv?= =?utf-8?B?d3pWeXByV3JHRnFvRnArOHNscDdPdUVScG5qdDNBM0FjaW5NVTJDdytzNjNF?= =?utf-8?B?ZzEza3JuUVNWOXFSVzBZNzVtSVh0QVFDM0NjdWRRWVhTejFSUHVVbkQyUTZ1?= =?utf-8?B?NGUyTzJpaUF4d0dnRHhSWTIwMDZuVVhWdUhWZWdydlBMMnBWbmdnVmo4dTE2?= =?utf-8?B?eVlBMEF4K1N5VDRFbFpZZk5CMG42eWVydytSckx3YzVId0tTQm1oL0dkcWZl?= =?utf-8?B?MllWNlEycGlUOEpxWVlreHR0dWt5b0VZcm5BRno0Q2w2Q2pTcEV5dzZ5ZkhS?= =?utf-8?B?dXc1RWhjdHl6b2tKcUJISDd0SW5FVWVZZzR1TzRlcTV6dEZkOW9zdHp2ZlIw?= =?utf-8?B?bng0ODY0RXZuWEE3ZURaMStQcWgvSzhRUXA4Wm1BdENYdWIvdDNycHBuNDFk?= =?utf-8?B?TTlrYmNERGRXV0JoQlpFWmF5M3lUZWlmaktlUWVQVm5GSytUOGZsbW1nTjZF?= =?utf-8?B?Ti9Tbm0rRUwzclBzb1VVemo2anFwd0VqWkVnQjA3bGoxU1VSbURNZTQ0dVJL?= =?utf-8?B?MjE1elAxM3hOTy9RVEZTcWtVZVZOaCtZakkzRXU2ejJ3MlYxdmdoZlpGeHF2?= =?utf-8?B?MXdrRUcyVmRmdUg2UXBPSUROeFlia3NqNlJzdUZaeFBlL044ZGtrNTlQdkFB?= =?utf-8?B?dm1SWDdodDMzLy9UeTJJK1B0MHlOSm1vVEp4TnRvY3E1dFZSYTZjUXVROFla?= =?utf-8?B?b1NiZ2F4d3BTeHFGd1dlMXJtVm5pRFZpZFNsSXNJYy94OWRKbmxQRWFidC83?= =?utf-8?B?MllOTnFQMlZZME9qL3Irc05Id01ucFY2bWx0c1kzMUNzNytEaHQxbyt3RjV2?= =?utf-8?B?MTMwQXgrMnFpV1pnNzA0Ymc5WnhnZVJMVXlPdzlidmRLWmJaTFoyWXk0cjA2?= =?utf-8?B?VjFCYnIxdm9rN21UU0Q3Rm56Q0JVM2tzZ051TGhhYk9aRU1YQ01GMUpNUWdV?= =?utf-8?B?c25UbDYrRVVzMjA3aGh4d3FFWDhvcmVXQ0MvQnNWbjFEcG5BKzVqTm5ZK1ds?= =?utf-8?B?Wm5mWFRyOWZsUjIzeHpPMUFDQWRBZmFETU52OENWYjRMQVF1bGI5dGNwU1VD?= =?utf-8?B?ZFhNL1dpN2JHdnRqanhZaTIweWN6QW5TRlU1S2REVkNUc2dYbUZhcCtxa09z?= =?utf-8?Q?C1o5Z9M6PUunBgEbj8=3D?= X-Microsoft-Exchange-Diagnostics: 1; HE1PR07MB0907; 5:DpyRg6CIn8I2gjxz/Nlqx3Q4+TrVhIYlYzTflEgltffd9a3S/7wEYylmHBNaHNu9QF6qvpc8DKuOr9En4XZzz9+i1khOmDmxSCtW8BGbiEyYqgzH8zxta7IMQnmNDTvsdxMPcRNkIt9IIFfDcvkjzA==; 24:8yOPIC9HxHL+OxP1KZwIvNCasKyDeKVaA2LruvwY5Dzn1HUG8+PpNbzlQPQYY6B0cRVzrX15lf9qBT/dzL0EdBTq+fUUfdWMWq6it+6M0M0=; 20:4k1aMAC0VLih/aS7ZVnefz5G6tgbCAltXydJ48kjuHUK8mDgc+H27uCWt/diDniW3KIV1wbNbo+Wy31OWJWBmw== SpamDiagnosticOutput: 1:23 SpamDiagnosticMetadata: NSPM X-MS-Exchange-CrossTenant-OriginalArrivalTime: 23 Nov 2015 12:03:45.4240 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-Transport-CrossTenantHeadersStamped: HE1PR07MB0907 X-Microsoft-Exchange-Diagnostics: 1; HE1PR07MB0795; 2:WWmWYPjOTCuVj04suE5/PysZrq4ZswbU8AJHh59c893AnXTjsvMASWsZRkaOEBXMCN/z3EaGqbL8f9MU0IOpwZa3He1Wf2H2Q8IPzyDUMZ7AEEy2risl4YnWgdGPG4sNPiYkdlWOW2Vc7BTiZVqwGQ==; 23:LYrL4zYYvKru/vUCJRE4/yWV9W2j8/9ioxvYMgBn9sL5yDo05m6gG+ct3hDWj6GVCK/PEXitT3sAVC+W9OB3fselBjflds3ncq5VbzBgaHtxuxWAGnjYViAP+Dklw/L4WuMtotPhIE9FBZQ81kLNR4cwCCki4Y78FDGf5SyVNOTO1Pw6nmLdCEOAQwIVelw2 X-OriginatorOrg: nextfour.com Sender: linux-input-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-input@vger.kernel.org X-Spam-Status: No, score=-7.5 required=5.0 tests=BAYES_00, RCVD_IN_DNSWL_HI, RP_MATCHES_RCVD, UNPARSEABLE_RELAY autolearn=ham version=3.3.1 X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on mail.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP From: Mika Penttilä Multitouch protocol B support. Signed-off-by: Mika Penttilä --- drivers/input/touchscreen/Kconfig | 11 + drivers/input/touchscreen/Makefile | 1 + drivers/input/touchscreen/sis_i2c.c | 583 ++++++++++++++++++++++++++++++++++++ 3 files changed, 595 insertions(+) create mode 100644 drivers/input/touchscreen/sis_i2c.c diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig index 30666163..d5f294e 100644 --- a/drivers/input/touchscreen/Kconfig +++ b/drivers/input/touchscreen/Kconfig @@ -1106,5 +1106,16 @@ config TOUCHSCREEN_ROHM_BU21023 To compile this driver as a module, choose M here: the module will be called bu21023_ts. +config TOUCHSCREEN_SIS_I2C + tristate "SiS 9200 family I2C touchscreen driver" + depends on I2C + depends on GPIOLIB + help + This enables support for SiS 9200 family over I2C based touchscreens. + + If unsure, say N. + + To compile this driver as a module, choose M here: the + module will be called sis_i2c. endif diff --git a/drivers/input/touchscreen/Makefile b/drivers/input/touchscreen/Makefile index 30325f2..418f16f 100644 --- a/drivers/input/touchscreen/Makefile +++ b/drivers/input/touchscreen/Makefile @@ -60,6 +60,7 @@ obj-$(CONFIG_TOUCHSCREEN_PCAP) += pcap_ts.o obj-$(CONFIG_TOUCHSCREEN_PENMOUNT) += penmount.o obj-$(CONFIG_TOUCHSCREEN_PIXCIR) += pixcir_i2c_ts.o obj-$(CONFIG_TOUCHSCREEN_S3C2410) += s3c2410_ts.o +obj-$(CONFIG_TOUCHSCREEN_SIS_I2C) += sis_i2c.o obj-$(CONFIG_TOUCHSCREEN_ST1232) += st1232.o obj-$(CONFIG_TOUCHSCREEN_STMPE) += stmpe-ts.o obj-$(CONFIG_TOUCHSCREEN_SUN4I) += sun4i-ts.o diff --git a/drivers/input/touchscreen/sis_i2c.c b/drivers/input/touchscreen/sis_i2c.c new file mode 100644 index 0000000..c3869da --- /dev/null +++ b/drivers/input/touchscreen/sis_i2c.c @@ -0,0 +1,583 @@ +/* drivers/input/touchscreen/sis_i2c.c + * - I2C Touch panel driver for SiS 9200 family + * + * Copyright (C) 2011 SiS, Inc. + * Copyright (C) 2015 Nextfour Group + * + * This software is licensed under the terms of the GNU General Public + * License version 2, as published by the Free Software Foundation, and + * may be copied, distributed, and modified under those terms. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define SIS_I2C_NAME "sis_i2c_ts" +#define MAX_FINGERS 10 + +#define SIS_MAX_X 4095 +#define SIS_MAX_Y 4095 + +#define ONE_BYTE 1 +#define FIVE_BYTE 5 +#define EIGHT_BYTE 8 +#define SIXTEEN_BYTE 16 +#define PACKET_BUFFER_SIZE 128 + +#define SIS_CMD_NORMAL 0x0 +#define SIS_CMD_SOFTRESET 0x82 +#define SIS_CMD_RECALIBRATE 0x87 +#define SIS_CMD_POWERMODE 0x90 +#define MSK_TOUCHNUM 0x0f +#define MSK_HAS_CRC 0x10 +#define MSK_DATAFMT 0xe0 +#define MSK_PSTATE 0x0f +#define MSK_PID 0xf0 +#define RES_FMT 0x00 +#define FIX_FMT 0x40 + +/* for new i2c format */ +#define TOUCHDOWN 0x3 +#define TOUCHUP 0x0 +#define MAX_BYTE 64 +#define PRESSURE_MAX 255 + +/* Resolution diagonal */ +#define AREA_LENGTH_LONGER 5792 +/*((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5*/ +#define AREA_LENGTH_SHORT 5792 +#define AREA_UNIT (5792/32) + +#define FORMAT_MODE 1 + +#define MSK_NOBTN 0 +#define MSK_COMP 1 +#define MSK_BACK 2 +#define MSK_MENU 4 +#define MSK_HOME 8 + +#define P_BYTECOUNT 0 +#define ALL_IN_ONE_PACKAGE 0x10 +#define IS_TOUCH(x) (x & 0x1) +#define IS_HIDI2C(x) ((x & 0xF) == 0x06) +#define IS_AREA(x) ((x >> 4) & 0x1) +#define IS_PRESSURE(x) ((x >> 5) & 0x1) +#define IS_SCANTIME(x) ((x >> 6) & 0x1) + +#define NORMAL_LEN_PER_POINT 6 +#define AREA_LEN_PER_POINT 2 +#define PRESSURE_LEN_PER_POINT 1 + +#define TOUCH_FORMAT 0x1 +#define BUTTON_FORMAT 0x4 +#define HIDI2C_FORMAT 0x6 +#define P_REPORT_ID 2 +#define BUTTON_STATE 3 +#define BUTTON_KEY_COUNT 16 +#define BYTE_BYTECOUNT 2 +#define BYTE_COUNT 1 +#define BYTE_REPORTID 1 +#define BYTE_CRC_HIDI2C 0 +#define BYTE_CRC_I2C 2 +#define BYTE_SCANTIME 2 +#define NO_TOUCH_BYTECOUNT 0x3 + +/* CMD Define */ +#define BUF_ACK_PLACE_L 4 +#define BUF_ACK_PLACE_H 5 +#define BUF_ACK_L 0xEF +#define BUF_ACK_H 0xBE +#define BUF_NACK_L 0xAD +#define BUF_NACK_H 0xDE +#define BUF_CRC_PLACE 7 + +/* SiS i2c error code */ +#define SIS_ERR -1 +#define SIS_ERR_ACCESS_USER_MEM -11 /* Access user memory fail */ +#define SIS_ERR_ALLOCATE_KERNEL_MEM -12 /* Allocate memory fail */ +#define SIS_ERR_CLIENT -13 /* Client not created */ +#define SIS_ERR_COPY_FROM_USER -14 /* Copy data from user fail */ +#define SIS_ERR_COPY_FROM_KERNEL -19 /* Copy data from kernel fail */ +#define SIS_ERR_TRANSMIT_I2C -21 /* Transmit error in I2C */ + +struct _touchpoint { + int id; + unsigned short x, y; + uint16_t pressure; + uint16_t width; + uint16_t height; +}; + +struct sistp_driver_data { + int id; + int fingers; + uint8_t pre_keybit_state; + struct _touchpoint pt[MAX_FINGERS]; +}; + +struct sis_ts_data { + int irq_gpio; + int reset_gpio; + struct i2c_client *client; + struct input_dev *input_dev; +struct sistp_driver_data tpinfo; +}; + +static void sis_tpinfo_clear(struct sistp_driver_data *tpinfo, int max); + +static int sis_cul_unit(uint8_t report_id) +{ + int ret = NORMAL_LEN_PER_POINT; + + if (report_id != ALL_IN_ONE_PACKAGE) { + + if (IS_AREA(report_id) /*&& IS_TOUCH(report_id)*/) + ret += AREA_LEN_PER_POINT; + + if (IS_PRESSURE(report_id)) + ret += PRESSURE_LEN_PER_POINT; + } + + return ret; +} + +static int sis_readpacket(struct i2c_client *client, uint8_t cmd, uint8_t *buf) +{ + uint8_t tmpbuf[MAX_BYTE] = {0}; + int ret = SIS_ERR; + int touchnum = 0; + int p_count = 0; + int touch_format_id = 0; + int location = 0; + bool read_first = true; + +/* + * I2C touch report format + * + * buf[0] = Low 8 bits of byte count value + * buf[1] = High 8 bits of byte counte value + * buf[2] = Report ID + * buf[touch num * 6 + 2 ] = Touch informations; + * 1 touch point has 6 bytes, it could be none if no touch + * buf[touch num * 6 + 3] = Touch numbers + * + * One touch point information include 6 bytes, the order is + * + * 1. status = touch down or touch up + * 2. id = finger id + * 3. x axis low 8 bits + * 4. x axis high 8 bits + * 5. y axis low 8 bits + * 6. y axis high 8 bits + */ + do { + if (location >= PACKET_BUFFER_SIZE) { + dev_err(&client->dev, "sis_readpacket: Buf Overflow\n"); + return SIS_ERR; + } + + ret = i2c_master_recv(client, tmpbuf, MAX_BYTE); + + if (ret <= 0) { + return touchnum; + } else if (tmpbuf[P_BYTECOUNT] > MAX_BYTE) { + dev_err(&client->dev, "sis_readpacket: invalid bytecout\n"); + return SIS_ERR; + } + + if (tmpbuf[P_BYTECOUNT] < 10) + return touchnum; + + if (read_first) + if (tmpbuf[P_BYTECOUNT] == 0) + return 0; /* touchnum is 0 */ + + touch_format_id = tmpbuf[P_REPORT_ID] & 0xf; + + if ((touch_format_id != TOUCH_FORMAT) + && (touch_format_id != HIDI2C_FORMAT) + && (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) { + dev_err(&client->dev, "sis_readpacket: invalid reportid\n"); + return SIS_ERR; + } + + p_count = (int) tmpbuf[P_BYTECOUNT] - 1; /* start from 0 */ + if (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE) { + if (IS_TOUCH(tmpbuf[P_REPORT_ID])) { + p_count -= BYTE_CRC_I2C; /* delete 2 byte crc */ + } else if (IS_HIDI2C(tmpbuf[P_REPORT_ID])) { + p_count -= BYTE_CRC_HIDI2C; + } else { + dev_err(&client->dev, "sis_readpacket: delete crc error\n"); + return SIS_ERR; + } + if (IS_SCANTIME(tmpbuf[P_REPORT_ID])) + p_count -= BYTE_SCANTIME; + } + + if (read_first) + touchnum = tmpbuf[p_count]; + else { + if (tmpbuf[p_count] != 0) { + dev_err(&client->dev, "sis_readpacket: nonzero point count in tail packet\n"); + return SIS_ERR; + } + } + + if ((touch_format_id != HIDI2C_FORMAT) && + (tmpbuf[P_BYTECOUNT] > 3)) { + int crc_end = p_count + + (IS_SCANTIME(tmpbuf[P_REPORT_ID]) * 2); + u16 buf_crc = + crc_itu_t(0, tmpbuf + 2, crc_end - 1); + int l_package_crc = + (IS_SCANTIME(tmpbuf[P_REPORT_ID]) * 2) + + p_count + 1; + u16 package_crc = + get_unaligned_le16(&tmpbuf[l_package_crc]); + if (buf_crc != package_crc) { + dev_err(&client->dev, "sis_readpacket: CRC Error\n"); + return SIS_ERR; + } + } + + memcpy(&buf[location], &tmpbuf[0], 64); + /* Buf_Data [0~63] [64~128] */ + location += MAX_BYTE; + read_first = false; + } while (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE && + tmpbuf[p_count] > 5); + + return touchnum; +} + +static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id) +{ + struct sis_ts_data *ts = dev_id; + struct sistp_driver_data *tpinfo = &ts->tpinfo; + + int ret = SIS_ERR; + int point_unit; + uint8_t buf[PACKET_BUFFER_SIZE] = {0}; + uint8_t i = 0, fingers = 0; + uint8_t px = 0, py = 0, pstatus = 0; + uint8_t p_area = 0; + uint8_t p_preasure = 0; + +redo: + /* I2C or SMBUS block data read */ + ret = sis_readpacket(ts->client, SIS_CMD_NORMAL, buf); + + if (ret < 0) + goto recheck_irq; + + else if (ret == 0) { + fingers = 0; + sis_tpinfo_clear(tpinfo, MAX_FINGERS); + goto label_send_report; + /*need to report input_mt_sync()*/ + } + sis_tpinfo_clear(tpinfo, MAX_FINGERS); + + point_unit = sis_cul_unit(buf[P_REPORT_ID]); + fingers = ret; + + tpinfo->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers); + + for (i = 0; i < fingers; i++) { + if ((buf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE) && (i >= 5)) { + pstatus = BYTE_BYTECOUNT + BYTE_REPORTID + + ((i - 5) * point_unit); + pstatus += 64; + } else { + pstatus = BYTE_BYTECOUNT + BYTE_REPORTID + + (i * point_unit); + } + /* X and Y coordinate locations */ + px = pstatus + 2; + py = px + 2; + + if ((buf[pstatus]) == TOUCHUP) { + tpinfo->pt[i].width = 0; + tpinfo->pt[i].height = 0; + tpinfo->pt[i].pressure = 0; + } else if (buf[P_REPORT_ID] == ALL_IN_ONE_PACKAGE + && (buf[pstatus]) == TOUCHDOWN) { + tpinfo->pt[i].width = 1; + tpinfo->pt[i].height = 1; + tpinfo->pt[i].pressure = 1; + } else if ((buf[pstatus]) == TOUCHDOWN) { + p_area = py + 2; + p_preasure = py + 2 + (IS_AREA(buf[P_REPORT_ID]) * 2); + + if (IS_AREA(buf[P_REPORT_ID])) { + tpinfo->pt[i].width = buf[p_area]; + tpinfo->pt[i].height = buf[p_area + 1]; + } else { + tpinfo->pt[i].width = 1; + tpinfo->pt[i].height = 1; + } + + if (IS_PRESSURE(buf[P_REPORT_ID])) + tpinfo->pt[i].pressure = (buf[p_preasure]); + else + tpinfo->pt[i].pressure = 1; + } else { + dev_err(&ts->client->dev, "Touch status error\n"); + goto recheck_irq; + } + tpinfo->pt[i].id = (buf[pstatus + 1]); + tpinfo->pt[i].x = le16_to_cpu(get_unaligned_le16(&buf[px])); + tpinfo->pt[i].y = le16_to_cpu(get_unaligned_le16(&buf[py])); + } + +label_send_report: + + for (i = 0; i < tpinfo->fingers; i++) { + + int slot = input_mt_get_slot_by_key( + ts->input_dev, tpinfo->pt[i].id); + + if (slot < 0) + continue; + + input_mt_slot(ts->input_dev, slot); + input_mt_report_slot_state(ts->input_dev, + MT_TOOL_FINGER, tpinfo->pt[i].pressure); + + if (tpinfo->pt[i].pressure) { + + tpinfo->pt[i].width *= AREA_UNIT; + input_report_abs(ts->input_dev, ABS_MT_TOUCH_MAJOR, + tpinfo->pt[i].width); + tpinfo->pt[i].height *= AREA_UNIT; + input_report_abs(ts->input_dev, ABS_MT_TOUCH_MINOR, + tpinfo->pt[i].height); + input_report_abs(ts->input_dev, ABS_MT_PRESSURE, + tpinfo->pt[i].pressure); + input_report_abs(ts->input_dev, ABS_MT_POSITION_X, + tpinfo->pt[i].x); + input_report_abs(ts->input_dev, ABS_MT_POSITION_Y, + tpinfo->pt[i].y); + + } + } + + input_mt_sync_frame(ts->input_dev); + input_sync(ts->input_dev); + +recheck_irq: + + ret = gpio_get_value(ts->irq_gpio); + /* + * If interrupt pin is still LOW, + * read data until interrupt pin is released. + * + */ + if (!ret) + goto redo; + + return IRQ_HANDLED; +} + +static void sis_tpinfo_clear(struct sistp_driver_data *tpinfo, int max) +{ + int i = 0; + + for (i = 0; i < max; i++) { + tpinfo->pt[i].id = -1; + tpinfo->pt[i].x = 0; + tpinfo->pt[i].y = 0; + tpinfo->pt[i].pressure = 0; + tpinfo->pt[i].width = 0; + } + tpinfo->id = 0x0; + tpinfo->fingers = 0; +} + +static int sis_ts_configure(struct i2c_client *client, struct sis_ts_data *ts) +{ + struct device_node *np = client->dev.of_node; + int gpio; + int ret; + + if (!np) + return -ENODEV; + + gpio = of_get_named_gpio(np, "irq-gpios", 0); + if (!gpio_is_valid(gpio)) + return -ENODEV; + + ret = gpio_request(gpio, "sis_irq"); + if (ret < 0) + return ret; + + ts->irq_gpio = gpio; + + gpio = of_get_named_gpio(np, "reset-gpios", 0); + if (!gpio_is_valid(gpio)) { + gpio_free(ts->irq_gpio); + return -ENODEV; + } + + ret = gpio_request(gpio, "sis_reset"); + if (ret < 0) { + gpio_free(ts->irq_gpio); + return ret; + } + + ts->reset_gpio = gpio; + /* Get out of reset */ + gpio_direction_output(gpio, 1); + msleep(1); + gpio_direction_output(gpio, 0); + msleep(1); + gpio_direction_output(gpio, 1); + msleep(100); + return 0; + +} + +static int sis_ts_probe( + struct i2c_client *client, const struct i2c_device_id *id) +{ + int ret = 0; + struct sis_ts_data *ts = NULL; + + ts = devm_kzalloc(&client->dev, sizeof(struct sis_ts_data), GFP_KERNEL); + if (ts == NULL) { + ret = -ENOMEM; + goto err_alloc_data_failed; + } + if (sis_ts_configure(client, ts)) { + kfree(ts); + return -ENODEV; + } + + ts->client = client; + i2c_set_clientdata(client, ts); + + ts->input_dev = input_allocate_device(); + if (ts->input_dev == NULL) { + ret = -ENOMEM; + dev_err(&client->dev, "sis_ts_probe: Failed to allocate input device\n"); + goto err_input_dev_alloc_failed; + } + + ts->input_dev->name = "sis_touch"; + ts->input_dev->id.bustype = BUS_I2C; + + set_bit(EV_ABS, ts->input_dev->evbit); + set_bit(EV_KEY, ts->input_dev->evbit); + set_bit(BTN_TOUCH, ts->input_dev->keybit); + + set_bit(ABS_MT_POSITION_X, ts->input_dev->absbit); + set_bit(ABS_MT_POSITION_Y, ts->input_dev->absbit); + + set_bit(ABS_MT_PRESSURE, ts->input_dev->absbit); + set_bit(ABS_MT_TOUCH_MAJOR, ts->input_dev->absbit); + set_bit(ABS_MT_TOUCH_MINOR, ts->input_dev->absbit); + input_set_abs_params(ts->input_dev, ABS_MT_PRESSURE, + 0, PRESSURE_MAX, 0, 0); + input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR, + 0, AREA_LENGTH_LONGER, 0, 0); + input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MINOR, + 0, AREA_LENGTH_SHORT, 0, 0); + input_set_abs_params(ts->input_dev, ABS_MT_POSITION_X, + 0, SIS_MAX_X, 0, 0); + input_set_abs_params(ts->input_dev, ABS_MT_POSITION_Y, + 0, SIS_MAX_Y, 0, 0); + + input_mt_init_slots(ts->input_dev, MAX_FINGERS, + INPUT_MT_DROP_UNUSED | INPUT_MT_DIRECT); + + ret = input_register_device(ts->input_dev); + if (ret) { + dev_err(&client->dev, + "Unable to register %s input device\n", + ts->input_dev->name); + goto err_input_register_device_failed; + } + + ret = devm_request_threaded_irq(&client->dev, client->irq, NULL, + sis_ts_irq_handler, + IRQF_TRIGGER_FALLING | IRQF_ONESHOT, + client->name, ts); + + if (ret) { + dev_err(&client->dev, "request irq failed\n"); + goto err_irq_request_failed; + } + + dev_info(&client->dev, "sis_ts_probe: Started touchscreen %s\n", + ts->input_dev->name); + return 0; + +err_irq_request_failed: + input_unregister_device(ts->input_dev); +err_input_register_device_failed: + input_free_device(ts->input_dev); +err_input_dev_alloc_failed: + kfree(ts); +err_alloc_data_failed: + return ret; +} + +static int sis_ts_remove(struct i2c_client *client) +{ + struct sis_ts_data *ts = i2c_get_clientdata(client); + + input_unregister_device(ts->input_dev); + gpio_free(ts->reset_gpio); + gpio_free(ts->irq_gpio); + kfree(ts); + return 0; +} + +static const struct i2c_device_id sis_ts_id[] = { + { SIS_I2C_NAME, 0 }, + { } +}; + +MODULE_DEVICE_TABLE(i2c, sis_ts_id); + +static const struct of_device_id sis_ts_dt_ids[] = { + { .compatible = "sis,9200_ts" }, + { /* sentinel */ } +}; +MODULE_DEVICE_TABLE(of, sis_ts_dt_ids); + +static struct i2c_driver sis_ts_driver = { + .probe = sis_ts_probe, + .remove = sis_ts_remove, + + .id_table = sis_ts_id, + .driver = { + .name = SIS_I2C_NAME, + .of_match_table = sis_ts_dt_ids, + }, +}; + +module_i2c_driver(sis_ts_driver); +MODULE_DESCRIPTION("SiS 9200 Family Touchscreen Driver"); +MODULE_LICENSE("GPL v2");