From nobody Thu Oct 2 20:46:45 2025 Received: from mail-pg1-f172.google.com (mail-pg1-f172.google.com [209.85.215.172]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id CD1BF2DE1FE for ; Thu, 11 Sep 2025 21:20:03 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=209.85.215.172 ARC-Seal: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1757625605; cv=none; b=fJ/Uiip3MjqJLQftoiVJz9lG5be/Df6OatYzzDEJesKeJBz83MkMWmp2iPAF4AaCiXfOPQCpO8Ri1K+HaOXcE27ftVMgHkSGB3yuYtsqyagLA7w4jk3GedCnpoDnYkZ+Y5OYk7tuyPtToEoa1m7ru4AzFAlejh/Q/bgBSfsmSDw= ARC-Message-Signature: i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1757625605; c=relaxed/simple; bh=yerASv8llwk7nfBz/IRboPAwThc6WU1plfW2t44+nzY=; h=From:To:Cc:Subject:Date:Message-ID:In-Reply-To:References: MIME-Version:Content-Type; b=JLPpjIrJP1UqFg4dp+S3kPjgtJNZGh66Nl6xS727YtR++3pyhKhz/htNbxnHoQdqzwOffoF36/E8f8HfGjQYEvg6QQzUV343Gmsv0u385wouBky6rc2azuBnFU+h9nJ3/+hinJTlu62l033PUwtENzi6uoEMSzhgyDG5ZFM0Oks= ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=gmail.com; spf=pass smtp.mailfrom=gmail.com; dkim=pass (2048-bit key) header.d=gmail.com header.i=@gmail.com header.b=M0iO82UA; arc=none smtp.client-ip=209.85.215.172 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=gmail.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=gmail.com Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=gmail.com header.i=@gmail.com header.b="M0iO82UA" Received: by mail-pg1-f172.google.com with SMTP id 41be03b00d2f7-b4cb3367d87so800828a12.3 for ; Thu, 11 Sep 2025 14:20:03 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20230601; t=1757625603; x=1758230403; darn=vger.kernel.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to; bh=XaoHHj/dtuV2QsIygi49dhZfnqRkcoeVI2NypiA4XRc=; b=M0iO82UAX2RUY3P9BidsuP6DAzlm+I7aqqHXBSbJlQwIAQberwlIpS5wIljarFOx/F Hr303txCiKZEai83Upwhk+4mF7EjFK27ygBDEF/AbPi2Xa0zCGYmb5wNYj43HxMs9E/B Dk4sM1v1HGTIH4EmKR8GcmBuNqziS+n0QbbzuhnEo0dKLuDzV5GnbYE+hnJEoGDs6j6v 8367BCEd3cn1OhURUYTM+Gqzep9/1qfKhyLH99ByXP7av4V+Y4K5usX4eZk6OcOhmjIt oBi1jg7OQuPp94UJhGk1T3jM52NSRbAchjEd7QsMakVoSbVQ2LJR5ytkvhhgKyizOQ3O 7Kkw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1757625603; x=1758230403; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=XaoHHj/dtuV2QsIygi49dhZfnqRkcoeVI2NypiA4XRc=; b=GGgzHPcLHbT4Xebc6eV6eOIFk0aDlAnnVL168/GpSS/c6NJYg/kY3Re26Z7AdFMWp0 FI1Use7RdK6IbJiPFGhIdVTbDC0b4/NcSaN5Mo2s+zfA5Gvr98F9UMuo+VgqTnjOaQwe QZECLNXKUpQGCbzTVm0L9T3pRTMNHZoJ4HiTqYdpMKVBzokybc1FiGZF0o6GrHnZjXM0 x3hQXnO4ByNuW2G/+okF53KOGMuHmM6ykBPmNHT9oPWo+qs9BzceVPiQ7xVHpr+EqpG8 bQjiVglJySEYST9ZHAYJpOBjnalvL5c0S0rb32gZ4cJxbWYw8nc7IhJuwS3FgvW6cL9u 6H9g== X-Forwarded-Encrypted: i=1; AJvYcCVZ25XJCe1gyX5ZLQzAia6JfhEEoa+uGZsshJ4DXFD9mtVz1Y36unXSL4MMzne4A5uy82kd5+xAYLRKl0s=@vger.kernel.org X-Gm-Message-State: AOJu0Yzkf0oYMaFCW19p4SJgSDTSmYVhfTIQCvcV5LfU0rjbmrHfBHgL 2o3LR3QvO0Ug3A8nVmFH+4JxtBJFIulNIsEOSySoSWD23pQ5EuRxWRFd X-Gm-Gg: ASbGncsi+Fv/qDzfhnLUiezSQTL+h7Yc8hgr0/NNpOjWoBOI3VofyRVRbPdoKOJicwz dHwNLg9hRqdPxKD3fmAVapbuaLq9+S+sZAW4SFyTkZQiiLGC+LV9W4voo6bNOXKoB3bSk92tGo/ 5IFJg7hdVnOkOFv59L3rIATcnm19Q1PI2VEG12/blFnala90/gGhgt8j4bGYWsnQW90geyehndU +5BwIt0rvFzGP7aQ82qIrZQXEm+KT5fKAAQUCmty5Via1jSh2VjepQjlLkgS87VzY1F8MLe+MFO DRchwIhJ7jOcQwlpcYnV+MieIP0Wx6UJubVSUBk6BwtQ2OSE0oFw2eeVZm+0pL13kNglekMosBh i8fJu/E3qOIK1bETjNDo= X-Google-Smtp-Source: AGHT+IGwkt+vLc6KgE8wjNKkONh4wFeppiY2BztnXnboWt9dqSzgg5KymrPwRARsNkXasUwwOZpe1w== X-Received: by 2002:a17:903:4b47:b0:246:7711:87e with SMTP id d9443c01a7336-25d24da3f27mr8190985ad.21.1757625603015; Thu, 11 Sep 2025 14:20:03 -0700 (PDT) Received: from archlinux ([152.245.61.23]) by smtp.gmail.com with ESMTPSA id d9443c01a7336-25c36dbb159sm28705045ad.13.2025.09.11.14.20.00 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Thu, 11 Sep 2025 14:20:02 -0700 (PDT) From: =?UTF-8?q?Eric=20Gon=C3=A7alves?= To: Dmitry Torokhov , Henrik Rydberg , Rob Herring , Krzysztof Kozlowski , Conor Dooley Cc: Ivaylo Ivanov , linux-input@vger.kernel.org, devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, =?UTF-8?q?Eric=20Gon=C3=A7alves?= Subject: [RFC PATCH 2/2] Input: add support for the STM FTS2BA61Y touchscreen Date: Thu, 11 Sep 2025 21:19:10 +0000 Message-ID: <20250911211910.45903-3-ghatto404@gmail.com> X-Mailer: git-send-email 2.50.1 In-Reply-To: <20250911211910.45903-1-ghatto404@gmail.com> References: <20250911211910.45903-1-ghatto404@gmail.com> Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: quoted-printable The ST-Microelectronics FTS2BA61Y touchscreen is a capacitive multi-touch controller connected through SPI at 0x0, the touchscreen is typically used in mobile devices (like the Galaxy S22 series) Signed-off-by: Ivaylo Ivanov Signed-off-by: Eric Gon=C3=A7alves --- Ivaylo Ivanov originally wrote the FTS2BA61Y driver, I am upstreaming it on his behalf. --- drivers/input/touchscreen/Kconfig | 11 + drivers/input/touchscreen/Makefile | 1 + drivers/input/touchscreen/fts2ba61y.c | 588 ++++++++++++++++++++++++++ 3 files changed, 600 insertions(+) create mode 100644 drivers/input/touchscreen/fts2ba61y.c diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/= Kconfig index 196905162945..1e199191f527 100644 --- a/drivers/input/touchscreen/Kconfig +++ b/drivers/input/touchscreen/Kconfig @@ -370,6 +370,17 @@ config TOUCHSCREEN_EXC3000 To compile this driver as a module, choose M here: the module will be called exc3000. =20 +config TOUCHSCREEN_FTS2BA61Y + tristate "ST-Microelectronics FTS2BA61Y touchscreen" + depends on SPI + help + Say Y here if you have the ST-Microelectronics FTS2BA61Y touchscreen + + If unsure, say N. + + To compile this driver as a module, choose M here: the + module will be called fts2ba61y. + config TOUCHSCREEN_FUJITSU tristate "Fujitsu serial touchscreen" select SERIO diff --git a/drivers/input/touchscreen/Makefile b/drivers/input/touchscreen= /Makefile index 97a025c6a377..408a9fd5bd35 100644 --- a/drivers/input/touchscreen/Makefile +++ b/drivers/input/touchscreen/Makefile @@ -43,6 +43,7 @@ obj-$(CONFIG_TOUCHSCREEN_ELO) +=3D elo.o obj-$(CONFIG_TOUCHSCREEN_EGALAX) +=3D egalax_ts.o obj-$(CONFIG_TOUCHSCREEN_EGALAX_SERIAL) +=3D egalax_ts_serial.o obj-$(CONFIG_TOUCHSCREEN_EXC3000) +=3D exc3000.o +obj-$(CONFIG_TOUCHSCREEN_FTS2BA61Y) +=3D fts2ba61y.o obj-$(CONFIG_TOUCHSCREEN_FUJITSU) +=3D fujitsu_ts.o obj-$(CONFIG_TOUCHSCREEN_GOODIX) +=3D goodix_ts.o obj-$(CONFIG_TOUCHSCREEN_GOODIX_BERLIN_CORE) +=3D goodix_berlin_core.o diff --git a/drivers/input/touchscreen/fts2ba61y.c b/drivers/input/touchscr= een/fts2ba61y.c new file mode 100644 index 000000000000..b3b3abca5404 --- /dev/null +++ b/drivers/input/touchscreen/fts2ba61y.c @@ -0,0 +1,588 @@ +// SPDX-License-Identifier: GPL-2.0 +// Based loosely on s6sy761.c + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +/* commands */ +#define FTS2BA61Y_CMD_SENSE_ON 0x10 +#define FTS2BA61Y_CMD_SENSE_OFF 0x11 +#define FTS2BA61Y_CMD_READ_PANEL_INFO 0x23 +#define FTS2BA61Y_CMD_READ_FW_VER 0x24 +#define FTS2BA61Y_CMD_TOUCHTYPE 0x30 /* R/W for get/set */ +#define FTS2BA61Y_CMD_CLEAR_EVENTS 0x62 +#define FTS2BA61Y_CMD_READ_EVENT 0x87 +#define FTS2BA61Y_CMD_CUSTOM_W 0xC0 +#define FTS2BA61Y_CMD_CUSTOM_R 0xD1 +#define FTS2BA61Y_CMD_REG_W 0xFA +#define FTS2BA61Y_CMD_REG_R 0xFB + +/* touch type masks */ +#define FTS2BA61Y_MASK_TOUCH BIT(0) +#define FTS2BA61Y_MASK_HOVER BIT(1) +#define FTS2BA61Y_MASK_COVER BIT(2) +#define FTS2BA61Y_MASK_GLOVE BIT(3) +#define FTS2BA61Y_MASK_STYLUS BIT(4) +#define FTS2BA61Y_MASK_PALM BIT(5) +#define FTS2BA61Y_MASK_WET BIT(6) +#define FTS2BA61Y_TOUCHTYPE_DEFAULT (FTS2BA61Y_MASK_TOUCH | \ + FTS2BA61Y_MASK_PALM | \ + FTS2BA61Y_MASK_WET) + +/* event status masks */ +#define FTS2BA61Y_MASK_STYPE GENMASK(5, 2) +#define FTS2BA61Y_MASK_EVENT_ID GENMASK(1, 0) + +/* event coordinate masks */ +#define FTS2BA61Y_MASK_TCHSTA GENMASK(7, 6) +#define FTS2BA61Y_MASK_TID GENMASK(5, 2) +#define FTS2BA61Y_MASK_X_3_0 GENMASK(7, 4) +#define FTS2BA61Y_MASK_Y_3_0 GENMASK(3, 0) +#define FTS2BA61Y_MASK_Z GENMASK(5, 0) +#define FTS2BA61Y_MASK_TTYPE_3_2 GENMASK(7, 6) +#define FTS2BA61Y_MASK_TTYPE_1_0 GENMASK(1, 0) +#define FTS2BA61Y_MASK_LEFT_EVENTS GENMASK(4, 0) + +/* event error status */ +#define FTS2BA61Y_EVENT_STATUSTYPE_INFO 0x2 + +/* information report */ +#define FTS2BA61Y_INFO_READY_STATUS 0x0 + +/* event status */ +#define FTS2BA61Y_COORDINATE_EVENT 0x0 + +/* touch types */ +#define FTS2BA61Y_TOUCHTYPE_NORMAL 0x0 +#define FTS2BA61Y_TOUCHTYPE_HOVER 0x1 +#define FTS2BA61Y_TOUCHTYPE_FLIPCOVER 0x2 +#define FTS2BA61Y_TOUCHTYPE_GLOVE 0x3 +#define FTS2BA61Y_TOUCHTYPE_STYLUS 0x4 +#define FTS2BA61Y_TOUCHTYPE_PALM 0x5 +#define FTS2BA61Y_TOUCHTYPE_WET 0x6 +#define FTS2BA61Y_TOUCHTYPE_PROXIMITY 0x7 +#define FTS2BA61Y_TOUCHTYPE_JIG 0x8 + +#define FTS2BA61Y_COORDINATE_ACTION_NONE 0x0 +#define FTS2BA61Y_COORDINATE_ACTION_PRESS 0x1 +#define FTS2BA61Y_COORDINATE_ACTION_MOVE 0x2 +#define FTS2BA61Y_COORDINATE_ACTION_RELEASE 0x3 + +#define FTS2BA61Y_DEV_NAME "fts2ba61y" +#define FTS2BA61Y_EVENT_BUFF_SIZE 16 +#define FTS2BA61Y_PANEL_INFO_SIZE 11 +#define FTS2BA61Y_RESET_CMD_SIZE 5 +#define FTS2BA61Y_EVENT_COUNT 31 +#define MAX_TRANSFER_SIZE 256 + +enum fts2ba61y_regulators { + FTS2BA61Y_REGULATOR_VDD, + FTS2BA61Y_REGULATOR_AVDD, +}; + +struct fts2ba61y_data { + struct spi_device *spi; + struct regulator_bulk_data regulators[2]; + struct input_dev *input_dev; + struct mutex mutex; + struct touchscreen_properties prop; + + u8 tx_count; + + unsigned int max_x; + unsigned int max_y; +}; + +static int fts2ba61y_write(struct fts2ba61y_data *ts, + u8 *reg, int cmd_len, u8 *data, int data_len) +{ + struct spi_message msg; + struct spi_transfer xfers; + char *tx_buf; + int len; + int ret; + + tx_buf =3D kzalloc(cmd_len + data_len + 1, GFP_KERNEL); + if (!tx_buf) { + ret =3D -ENOMEM; + goto out; + } + + memset(&xfers, 0, sizeof(xfers)); + spi_message_init(&msg); + + memcpy(&tx_buf[0], reg, cmd_len); + if (data_len && data) + memcpy(&tx_buf[cmd_len], data, data_len); + + len =3D cmd_len + data_len; + + /* custom write cmd */ + if (reg[0] !=3D FTS2BA61Y_CMD_REG_W && + reg[0] !=3D FTS2BA61Y_CMD_REG_R) { + memmove(tx_buf + 1, tx_buf, len); + tx_buf[0] =3D FTS2BA61Y_CMD_CUSTOM_W; + len++; + } + + xfers.len =3D len; + xfers.tx_buf =3D tx_buf; + + spi_message_add_tail(&xfers, &msg); + + mutex_lock(&ts->mutex); + ret =3D spi_sync(ts->spi, &msg); + if (ret) + dev_err(&ts->spi->dev, "spi transfer error, %d", ret); + mutex_unlock(&ts->mutex); + +out: + kfree(tx_buf); + return ret; +} + +static int fts2ba61y_spi_raw_read(struct fts2ba61y_data *ts, + u8 *tx_buf, u8 *rx_buf, int len) +{ + struct spi_message msg; + struct spi_transfer xfer; + int ret; + + memset(&xfer, 0, sizeof(xfer)); + spi_message_init(&msg); + + xfer.len =3D len; + xfer.tx_buf =3D tx_buf; + xfer.rx_buf =3D rx_buf; + spi_message_add_tail(&xfer, &msg); + + mutex_lock(&ts->mutex); + ret =3D spi_sync(ts->spi, &msg); + if (ret) + dev_err(&ts->spi->dev, "spi transfer error, %d", ret); + mutex_unlock(&ts->mutex); + + return ret; +} + +/* + * higher-level wrapper that prepares the buffers for a read. + */ +static int fts2ba61y_read(struct fts2ba61y_data *ts, + u8 reg[], int tx_len, u8 buf[], int rx_len) +{ + char *tx_buf, *rx_buf; + int ret, mem_len; + u16 reg_val; + + if (tx_len > 3) + mem_len =3D rx_len + 1 + tx_len; + else + mem_len =3D rx_len + 4; + + tx_buf =3D kzalloc(mem_len, GFP_KERNEL); + rx_buf =3D kzalloc(mem_len, GFP_KERNEL); + if (!tx_buf || !rx_buf) { + ret =3D -ENOMEM; + goto out; + } + + switch (reg[0]) { + case FTS2BA61Y_CMD_READ_EVENT: + case FTS2BA61Y_CMD_REG_W: + case FTS2BA61Y_CMD_REG_R: + memcpy(tx_buf, reg, tx_len); + break; + + default: + tx_buf[0] =3D FTS2BA61Y_CMD_CUSTOM_R; + + if (tx_len =3D=3D 1) + reg_val =3D 0; + else if (tx_len =3D=3D 2) + reg_val =3D reg[0]; + else if (tx_len =3D=3D 3) + reg_val =3D reg[0] | (reg[1] << 8); + else { + ret =3D -EINVAL; + goto out; + } + + tx_len =3D 3; + put_unaligned_be16(reg_val, &tx_buf[1]); + + ret =3D fts2ba61y_write(ts, reg, 1, NULL, 0); + if (ret < 0) + goto out; + break; + } + + ret =3D fts2ba61y_spi_raw_read(ts, tx_buf, rx_buf, rx_len + 1 + tx_len); + if (ret < 0) + goto out; + + memcpy(buf, &rx_buf[1 + tx_len], rx_len); + +out: + kfree(tx_buf); + kfree(rx_buf); + return ret; +} + +static int fts2ba61y_wait_for_ready(struct fts2ba61y_data *ts) +{ + u8 buffer[FTS2BA61Y_EVENT_BUFF_SIZE]; + u8 cmd =3D FTS2BA61Y_CMD_READ_EVENT; + u8 status_id, stype; + int ret; + + for (int retries =3D 5; retries > 0; retries--) { + ret =3D fts2ba61y_read(ts, &cmd, 1, buffer, FTS2BA61Y_EVENT_BUFF_SIZE); + + stype =3D FIELD_GET(FTS2BA61Y_MASK_STYPE, buffer[0]); + status_id =3D buffer[1]; + + if (stype =3D=3D FTS2BA61Y_EVENT_STATUSTYPE_INFO && + status_id =3D=3D FTS2BA61Y_INFO_READY_STATUS) { + ret =3D 0; + break; + } else + ret =3D -ENODEV; + + msleep(20); + } + + return ret; +} + +static int fts2ba61y_reset(struct fts2ba61y_data *ts) +{ + u8 cmd =3D FTS2BA61Y_CMD_REG_W; + /* the following sequence is undocumented */ + u8 reset[FTS2BA61Y_RESET_CMD_SIZE] =3D { 0x20, 0x00, + 0x00, 0x24, 0x81 }; + int ret; + + disable_irq(ts->spi->irq); + + ret =3D fts2ba61y_write(ts, &cmd, 1, &reset[0], FTS2BA61Y_RESET_CMD_SIZE); + if (ret) + return ret; + msleep(30); + + ret =3D fts2ba61y_wait_for_ready(ts); + if (ret) + return ret; + + enable_irq(ts->spi->irq); + + return 0; +} + +static int fts2ba61y_set_channels(struct fts2ba61y_data *ts) +{ + int ret; + u8 cmd =3D FTS2BA61Y_CMD_READ_PANEL_INFO; + u8 data[FTS2BA61Y_PANEL_INFO_SIZE]; + + ret =3D fts2ba61y_read(ts, &cmd, 1, data, FTS2BA61Y_PANEL_INFO_SIZE); + if (ret) + return ret; + + ts->max_x =3D get_unaligned_be16(data); + ts->max_y =3D get_unaligned_be16(data + 2); + + /* if no tx channels defined, at least keep one */ + ts->tx_count =3D max_t(u8, data[8], 1); + + return 0; +} + +static int fts2ba61y_set_touch_func(struct fts2ba61y_data *ts) +{ + u8 cmd =3D FTS2BA61Y_CMD_TOUCHTYPE; + u16 touchtype =3D cpu_to_le16(FTS2BA61Y_TOUCHTYPE_DEFAULT); + + return fts2ba61y_write(ts, &cmd, 1, (u8 *)&touchtype, 2); +} + +static int fts2ba61y_hw_init(struct fts2ba61y_data *ts) +{ + int ret; + + ret =3D regulator_bulk_enable(ARRAY_SIZE(ts->regulators), + ts->regulators); + if (ret) + return ret; + + msleep(140); + + ret =3D fts2ba61y_reset(ts); + if (ret) + return ret; + + ret =3D fts2ba61y_set_channels(ts); + if (ret) + return ret; + + return fts2ba61y_set_touch_func(ts); +} + +static int fts2ba61y_get_event(struct fts2ba61y_data *ts, u8 *data, int *n= _events) +{ + int ret; + u8 cmd =3D FTS2BA61Y_CMD_READ_EVENT; + + ret =3D fts2ba61y_read(ts, &cmd, 1, data, FTS2BA61Y_EVENT_BUFF_SIZE); + if (ret < 0) + return ret; + + if (!data[0]) { + *n_events =3D 0; + return 0; + } + + *n_events =3D FIELD_GET(FTS2BA61Y_MASK_LEFT_EVENTS, data[7]); + if (unlikely(*n_events >=3D FTS2BA61Y_EVENT_COUNT)) { + cmd =3D FTS2BA61Y_CMD_CLEAR_EVENTS; + fts2ba61y_write(ts, &cmd, 1, NULL, 0); + *n_events =3D 0; + return -EINVAL; + } + + if (*n_events > 0) { + ret =3D fts2ba61y_read(ts, &cmd, 1, + &data[1 * FTS2BA61Y_EVENT_BUFF_SIZE], + FTS2BA61Y_EVENT_BUFF_SIZE * (*n_events)); + if (ret) + return ret; + } + + return 0; +} + +static void fts2ba61y_report_coordinates(struct fts2ba61y_data *ts, + u8 *event, u8 tid) +{ + u8 major =3D event[4]; + u8 minor =3D event[5]; + u8 z =3D FIELD_GET(FTS2BA61Y_MASK_Z, event[6]); + + u16 x =3D (event[1] << 4) | + FIELD_GET(FTS2BA61Y_MASK_X_3_0, event[3]); + u16 y =3D (event[2] << 4) | + FIELD_GET(FTS2BA61Y_MASK_Y_3_0, event[3]); + u16 ttype =3D (FIELD_GET(FTS2BA61Y_MASK_TTYPE_3_2, event[6]) << 2) | + (FIELD_GET(FTS2BA61Y_MASK_TTYPE_1_0, event[7]) << 0); + + if (ttype !=3D FTS2BA61Y_TOUCHTYPE_NORMAL && + ttype !=3D FTS2BA61Y_TOUCHTYPE_PALM && + ttype !=3D FTS2BA61Y_TOUCHTYPE_WET && + ttype !=3D FTS2BA61Y_TOUCHTYPE_GLOVE) + return; + + input_mt_slot(ts->input_dev, tid); + input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, true); + input_report_abs(ts->input_dev, ABS_MT_POSITION_X, x); + input_report_abs(ts->input_dev, ABS_MT_POSITION_Y, y); + input_report_abs(ts->input_dev, ABS_MT_TOUCH_MAJOR, major); + input_report_abs(ts->input_dev, ABS_MT_TOUCH_MINOR, minor); + input_report_abs(ts->input_dev, ABS_MT_PRESSURE, z); + + input_mt_sync_frame(ts->input_dev); + input_sync(ts->input_dev); +} + +static void fts2ba61y_report_release(struct fts2ba61y_data *ts, u8 tid) +{ + input_mt_slot(ts->input_dev, tid); + input_mt_report_slot_state(ts->input_dev, MT_TOOL_FINGER, false); + + input_mt_sync_frame(ts->input_dev); + input_sync(ts->input_dev); +} + +static void fts2ba61y_handle_coordinates(struct fts2ba61y_data *ts, u8 *ev= ent) +{ + u8 t_id =3D FIELD_GET(FTS2BA61Y_MASK_TID, event[0]); + u8 action =3D FIELD_GET(FTS2BA61Y_MASK_TCHSTA, event[0]); + + if (t_id > ts->tx_count) + return; + + switch (action) { + case FTS2BA61Y_COORDINATE_ACTION_PRESS: + case FTS2BA61Y_COORDINATE_ACTION_MOVE: + fts2ba61y_report_coordinates(ts, event, t_id); + break; + + case FTS2BA61Y_COORDINATE_ACTION_RELEASE: + fts2ba61y_report_release(ts, t_id); + break; + } +} + +static irqreturn_t fts2ba61y_irq_handler(int irq, void *handle) +{ + struct fts2ba61y_data *ts =3D handle; + u8 buffer[FTS2BA61Y_EVENT_COUNT * FTS2BA61Y_EVENT_BUFF_SIZE]; + u8 *event; + u8 event_id; + int n_events =3D 0; + int ret; + + usleep(1); + + ret =3D fts2ba61y_get_event(ts, buffer, &n_events); + if (ret < 0) { + dev_dbg(&ts->spi->dev, "failed to get event: %d", ret); + return IRQ_HANDLED; + } + + for (int i =3D 0; i <=3D n_events; i++) { + event =3D &buffer[i * FTS2BA61Y_EVENT_BUFF_SIZE]; + event_id =3D FIELD_GET(FTS2BA61Y_MASK_EVENT_ID, event[0]); + + if (event_id =3D=3D FTS2BA61Y_COORDINATE_EVENT) + fts2ba61y_handle_coordinates(ts, event); + } + + return IRQ_HANDLED; +} + +static int fts2ba61y_input_open(struct input_dev *dev) +{ + struct fts2ba61y_data *ts =3D input_get_drvdata(dev); + u8 cmd =3D FTS2BA61Y_CMD_SENSE_ON; + + return fts2ba61y_write(ts, &cmd, 1, NULL, 0); +} + +static void fts2ba61y_input_close(struct input_dev *dev) +{ + struct fts2ba61y_data *ts =3D input_get_drvdata(dev); + int ret; + u8 cmd =3D FTS2BA61Y_CMD_SENSE_OFF; + + ret =3D fts2ba61y_write(ts, &cmd, 1, NULL, 0); + if (ret) + dev_err(&ts->spi->dev, "failed to turn off sensing\n"); +} + +static void fts2ba61y_power_off(void *data) +{ + struct fts2ba61y_data *ts =3D data; + + disable_irq(ts->spi->irq); + regulator_bulk_disable(ARRAY_SIZE(ts->regulators), + ts->regulators); +} + +static int fts2ba61y_probe(struct spi_device *spi) { + struct fts2ba61y_data *ts; + struct input_dev *input_dev; + int error; + + ts =3D devm_kzalloc(&spi->dev, sizeof(*ts), GFP_KERNEL); + if (!ts) + return -ENOMEM; + + ts->spi =3D spi; + mutex_init(&ts->mutex); + + spi->mode =3D SPI_MODE_0; + spi->bits_per_word =3D 8; + + error =3D spi_setup(spi); + if (error) + return error; + + ts->regulators[FTS2BA61Y_REGULATOR_VDD].supply =3D "vdd"; + ts->regulators[FTS2BA61Y_REGULATOR_AVDD].supply =3D "avdd"; + error =3D devm_regulator_bulk_get(&spi->dev, + ARRAY_SIZE(ts->regulators), + ts->regulators); + if (error) + return error; + + error =3D fts2ba61y_hw_init(ts); + if (error) + return error; + + error =3D devm_add_action_or_reset(&ts->spi->dev, fts2ba61y_power_off, ts= ); + if (error) + return error; + + input_dev =3D devm_input_allocate_device(&spi->dev); + if (!input_dev) + return -ENOMEM; + + ts->input_dev =3D input_dev; + + input_dev->name =3D FTS2BA61Y_DEV_NAME; + input_dev->id.bustype =3D BUS_SPI; + input_dev->open =3D fts2ba61y_input_open; + input_dev->close =3D fts2ba61y_input_close; + + input_set_abs_params(input_dev, ABS_MT_POSITION_X, 0, ts->max_x, 0, 0); + input_set_abs_params(input_dev, ABS_MT_POSITION_Y, 0, ts->max_y, 0, 0); + input_set_abs_params(input_dev, ABS_MT_TOUCH_MAJOR, 0, 255, 0, 0); + input_set_abs_params(input_dev, ABS_MT_TOUCH_MINOR, 0, 255, 0, 0); + input_set_abs_params(input_dev, ABS_MT_PRESSURE, 0, 255, 0, 0); + + touchscreen_parse_properties(input_dev, true, &ts->prop); + + spi_set_drvdata(spi, ts); + input_set_drvdata(input_dev, ts); + + error =3D input_mt_init_slots(input_dev, ts->tx_count, INPUT_MT_DIRECT); + if (error) + return error; + + error =3D input_register_device(input_dev); + if (error) + return error; + + error =3D devm_request_threaded_irq(&spi->dev, spi->irq, NULL, + fts2ba61y_irq_handler, + IRQF_TRIGGER_LOW | IRQF_ONESHOT, + "fts2ba61y_irq", ts); + return error; +} + +#ifdef CONFIG_OF +static const struct of_device_id spi_touchscreen_dt_ids[] =3D { + { .compatible =3D "st,fts2ba61y" }, + {}, +}; +MODULE_DEVICE_TABLE(of, spi_touchscreen_dt_ids); +#endif + +static const struct spi_device_id fts2ba61y_spi_ids[] =3D { + { "fts2ba61y" }, + { }, +}; +MODULE_DEVICE_TABLE(spi, fts2ba61y_spi_ids); + +static struct spi_driver spi_touchscreen_driver =3D { + .driver =3D { + .name =3D FTS2BA61Y_DEV_NAME, + .of_match_table =3D of_match_ptr(spi_touchscreen_dt_ids), + }, + .probe =3D fts2ba61y_probe, + .id_table =3D fts2ba61y_spi_ids, +}; + +module_spi_driver(spi_touchscreen_driver); + +MODULE_AUTHOR("Ivaylo Ivanov "); +MODULE_DESCRIPTION("ST-Microelectronics FTS2BA61Y Touch Screen"); +MODULE_LICENSE("GPL"); --=20 2.50.1