15b0c03e2SAlistair Francis // SPDX-License-Identifier: GPL-2.0
25b0c03e2SAlistair Francis /*
35b0c03e2SAlistair Francis  * Parade TrueTouch(TM) Standard Product V5 Module.
45b0c03e2SAlistair Francis  *
55b0c03e2SAlistair Francis  * Copyright (C) 2015 Parade Technologies
65b0c03e2SAlistair Francis  * Copyright (C) 2012-2015 Cypress Semiconductor
75b0c03e2SAlistair Francis  * Copyright (C) 2018 Bootlin
85b0c03e2SAlistair Francis  *
95b0c03e2SAlistair Francis  * Authors: Mylène Josserand <mylene.josserand@bootlin.com>
105b0c03e2SAlistair Francis  *                Alistair Francis <alistair@alistair23.me>
115b0c03e2SAlistair Francis  */
125b0c03e2SAlistair Francis 
135b0c03e2SAlistair Francis #include <linux/crc-itu-t.h>
145b0c03e2SAlistair Francis #include <linux/delay.h>
155b0c03e2SAlistair Francis #include <linux/device.h>
165b0c03e2SAlistair Francis #include <linux/gpio/consumer.h>
175b0c03e2SAlistair Francis #include <linux/input/mt.h>
185b0c03e2SAlistair Francis #include <linux/input/touchscreen.h>
195b0c03e2SAlistair Francis #include <linux/interrupt.h>
205b0c03e2SAlistair Francis #include <linux/i2c.h>
21*dbce1a7dSRob Herring #include <linux/mod_devicetable.h>
225b0c03e2SAlistair Francis #include <linux/module.h>
235b0c03e2SAlistair Francis #include <linux/regmap.h>
245b0c03e2SAlistair Francis #include <asm/unaligned.h>
255b0c03e2SAlistair Francis 
265b0c03e2SAlistair Francis #define CYTTSP5_NAME				"cyttsp5"
275b0c03e2SAlistair Francis #define CY_I2C_DATA_SIZE			(2 * 256)
285b0c03e2SAlistair Francis #define HID_VERSION				0x0100
295b0c03e2SAlistair Francis #define CY_MAX_INPUT				512
305b0c03e2SAlistair Francis #define CYTTSP5_PREALLOCATED_CMD_BUFFER		32
315b0c03e2SAlistair Francis #define CY_BITS_PER_BTN				1
3204249314SRichard Kjerstadius #define CY_NUM_BTN_EVENT_ID			GENMASK(CY_BITS_PER_BTN - 1, 0)
335b0c03e2SAlistair Francis 
345b0c03e2SAlistair Francis #define MAX_AREA				255
355b0c03e2SAlistair Francis #define HID_OUTPUT_BL_SOP			0x1
365b0c03e2SAlistair Francis #define HID_OUTPUT_BL_EOP			0x17
375b0c03e2SAlistair Francis #define HID_OUTPUT_BL_LAUNCH_APP		0x3B
385b0c03e2SAlistair Francis #define HID_OUTPUT_BL_LAUNCH_APP_SIZE		11
395b0c03e2SAlistair Francis #define HID_OUTPUT_GET_SYSINFO			0x2
405b0c03e2SAlistair Francis #define HID_OUTPUT_GET_SYSINFO_SIZE		5
415b0c03e2SAlistair Francis #define HID_OUTPUT_MAX_CMD_SIZE			12
425b0c03e2SAlistair Francis 
435b0c03e2SAlistair Francis #define HID_DESC_REG				0x1
445b0c03e2SAlistair Francis #define HID_INPUT_REG				0x3
455b0c03e2SAlistair Francis #define HID_OUTPUT_REG				0x4
463c98b8dbSMaximilian Weigand #define HID_COMMAND_REG				0x5
475b0c03e2SAlistair Francis 
485b0c03e2SAlistair Francis #define REPORT_ID_TOUCH				0x1
495b0c03e2SAlistair Francis #define REPORT_ID_BTN				0x3
505b0c03e2SAlistair Francis #define REPORT_SIZE_5				5
515b0c03e2SAlistair Francis #define REPORT_SIZE_8				8
525b0c03e2SAlistair Francis #define REPORT_SIZE_16				16
535b0c03e2SAlistair Francis 
545b0c03e2SAlistair Francis /* Touch reports offsets */
555b0c03e2SAlistair Francis /* Header offsets */
565b0c03e2SAlistair Francis #define TOUCH_REPORT_DESC_HDR_CONTACTCOUNT	16
575b0c03e2SAlistair Francis /* Record offsets */
585b0c03e2SAlistair Francis #define TOUCH_REPORT_DESC_CONTACTID		8
595b0c03e2SAlistair Francis #define TOUCH_REPORT_DESC_X			16
605b0c03e2SAlistair Francis #define TOUCH_REPORT_DESC_Y			32
615b0c03e2SAlistair Francis #define TOUCH_REPORT_DESC_P			48
625b0c03e2SAlistair Francis #define TOUCH_REPORT_DESC_MAJ			56
635b0c03e2SAlistair Francis #define TOUCH_REPORT_DESC_MIN			64
645b0c03e2SAlistair Francis 
655b0c03e2SAlistair Francis /* HID */
665b0c03e2SAlistair Francis #define HID_TOUCH_REPORT_ID			0x1
675b0c03e2SAlistair Francis #define HID_BTN_REPORT_ID			0x3
685b0c03e2SAlistair Francis #define HID_APP_RESPONSE_REPORT_ID		0x1F
695b0c03e2SAlistair Francis #define HID_APP_OUTPUT_REPORT_ID		0x2F
705b0c03e2SAlistair Francis #define HID_BL_RESPONSE_REPORT_ID		0x30
715b0c03e2SAlistair Francis #define HID_BL_OUTPUT_REPORT_ID			0x40
723c98b8dbSMaximilian Weigand #define HID_RESPONSE_REPORT_ID			0xF0
735b0c03e2SAlistair Francis 
745b0c03e2SAlistair Francis #define HID_OUTPUT_RESPONSE_REPORT_OFFSET	2
755b0c03e2SAlistair Francis #define HID_OUTPUT_RESPONSE_CMD_OFFSET		4
765b0c03e2SAlistair Francis #define HID_OUTPUT_RESPONSE_CMD_MASK		GENMASK(6, 0)
775b0c03e2SAlistair Francis 
785b0c03e2SAlistair Francis #define HID_SYSINFO_SENSING_OFFSET		33
795b0c03e2SAlistair Francis #define HID_SYSINFO_BTN_OFFSET			48
805b0c03e2SAlistair Francis #define HID_SYSINFO_BTN_MASK			GENMASK(7, 0)
815b0c03e2SAlistair Francis #define HID_SYSINFO_MAX_BTN			8
825b0c03e2SAlistair Francis 
833c98b8dbSMaximilian Weigand #define HID_CMD_SET_POWER			0x8
843c98b8dbSMaximilian Weigand 
853c98b8dbSMaximilian Weigand #define HID_POWER_ON				0x0
863c98b8dbSMaximilian Weigand #define HID_POWER_SLEEP				0x1
873c98b8dbSMaximilian Weigand 
885b0c03e2SAlistair Francis #define CY_HID_OUTPUT_TIMEOUT_MS		200
895b0c03e2SAlistair Francis #define CY_HID_OUTPUT_GET_SYSINFO_TIMEOUT_MS	3000
905b0c03e2SAlistair Francis #define CY_HID_GET_HID_DESCRIPTOR_TIMEOUT_MS	4000
913c98b8dbSMaximilian Weigand #define CY_HID_SET_POWER_TIMEOUT		500
925b0c03e2SAlistair Francis 
935b0c03e2SAlistair Francis /* maximum number of concurrent tracks */
945b0c03e2SAlistair Francis #define TOUCH_REPORT_SIZE			10
955b0c03e2SAlistair Francis #define TOUCH_INPUT_HEADER_SIZE			7
965b0c03e2SAlistair Francis #define BTN_REPORT_SIZE				9
975b0c03e2SAlistair Francis #define BTN_INPUT_HEADER_SIZE			5
985b0c03e2SAlistair Francis 
995b0c03e2SAlistair Francis #define MAX_CY_TCH_T_IDS			32
1005b0c03e2SAlistair Francis 
1015b0c03e2SAlistair Francis /* All usage pages for Touch Report */
1025b0c03e2SAlistair Francis #define TOUCH_REPORT_USAGE_PG_X			0x00010030
1035b0c03e2SAlistair Francis #define TOUCH_REPORT_USAGE_PG_Y			0x00010031
1045b0c03e2SAlistair Francis #define TOUCH_REPORT_USAGE_PG_P			0x000D0030
1055b0c03e2SAlistair Francis #define TOUCH_REPORT_USAGE_PG_CONTACTID		0x000D0051
1065b0c03e2SAlistair Francis #define TOUCH_REPORT_USAGE_PG_CONTACTCOUNT	0x000D0054
1075b0c03e2SAlistair Francis #define TOUCH_REPORT_USAGE_PG_MAJ		0xFF010062
1085b0c03e2SAlistair Francis #define TOUCH_REPORT_USAGE_PG_MIN		0xFF010063
1095b0c03e2SAlistair Francis #define TOUCH_COL_USAGE_PG			0x000D0022
1105b0c03e2SAlistair Francis 
1113c98b8dbSMaximilian Weigand #define SET_CMD_LOW(byte, bits) \
1123c98b8dbSMaximilian Weigand 	((byte) = (((byte) & 0xF0) | ((bits) & 0x0F)))
1133c98b8dbSMaximilian Weigand #define SET_CMD_HIGH(byte, bits)\
1143c98b8dbSMaximilian Weigand 	((byte) = (((byte) & 0x0F) | ((bits) & 0xF0)))
1153c98b8dbSMaximilian Weigand #define SET_CMD_OPCODE(byte, opcode) SET_CMD_LOW(byte, opcode)
1163c98b8dbSMaximilian Weigand #define SET_CMD_REPORT_TYPE(byte, type) SET_CMD_HIGH(byte, ((type) << 4))
1173c98b8dbSMaximilian Weigand #define SET_CMD_REPORT_ID(byte, id) SET_CMD_LOW(byte, id)
1183c98b8dbSMaximilian Weigand 
1195b0c03e2SAlistair Francis /* System Information interface definitions */
1205b0c03e2SAlistair Francis struct cyttsp5_sensing_conf_data_dev {
1215b0c03e2SAlistair Francis 	u8 electrodes_x;
1225b0c03e2SAlistair Francis 	u8 electrodes_y;
1235b0c03e2SAlistair Francis 	__le16 len_x;
1245b0c03e2SAlistair Francis 	__le16 len_y;
1255b0c03e2SAlistair Francis 	__le16 res_x;
1265b0c03e2SAlistair Francis 	__le16 res_y;
1275b0c03e2SAlistair Francis 	__le16 max_z;
1285b0c03e2SAlistair Francis 	u8 origin_x;
1295b0c03e2SAlistair Francis 	u8 origin_y;
1305dc63e56Shrdl 	u8 panel_id;
1315b0c03e2SAlistair Francis 	u8 btn;
1325b0c03e2SAlistair Francis 	u8 scan_mode;
1335b0c03e2SAlistair Francis 	u8 max_num_of_tch_per_refresh_cycle;
1345b0c03e2SAlistair Francis } __packed;
1355b0c03e2SAlistair Francis 
1365b0c03e2SAlistair Francis struct cyttsp5_sensing_conf_data {
1375b0c03e2SAlistair Francis 	u16 res_x;
1385b0c03e2SAlistair Francis 	u16 res_y;
1395b0c03e2SAlistair Francis 	u16 max_z;
1405b0c03e2SAlistair Francis 	u16 len_x;
1415b0c03e2SAlistair Francis 	u16 len_y;
1425b0c03e2SAlistair Francis 	u8 origin_x;
1435b0c03e2SAlistair Francis 	u8 origin_y;
1445b0c03e2SAlistair Francis 	u8 max_tch;
1455b0c03e2SAlistair Francis };
1465b0c03e2SAlistair Francis 
1475b0c03e2SAlistair Francis enum cyttsp5_tch_abs {	/* for ordering within the extracted touch data array */
1485b0c03e2SAlistair Francis 	CY_TCH_X,	/* X */
1495b0c03e2SAlistair Francis 	CY_TCH_Y,	/* Y */
1505b0c03e2SAlistair Francis 	CY_TCH_P,	/* P (Z) */
1515b0c03e2SAlistair Francis 	CY_TCH_T,	/* TOUCH ID */
1525b0c03e2SAlistair Francis 	CY_TCH_MAJ,	/* TOUCH_MAJOR */
1535b0c03e2SAlistair Francis 	CY_TCH_MIN,	/* TOUCH_MINOR */
1545b0c03e2SAlistair Francis 	CY_TCH_NUM_ABS
1555b0c03e2SAlistair Francis };
1565b0c03e2SAlistair Francis 
1575b0c03e2SAlistair Francis struct cyttsp5_tch_abs_params {
1585b0c03e2SAlistair Francis 	size_t ofs;	/* abs byte offset */
1595b0c03e2SAlistair Francis 	size_t size;	/* size in bits */
1605b0c03e2SAlistair Francis 	size_t min;	/* min value */
1615b0c03e2SAlistair Francis 	size_t max;	/* max value */
1625b0c03e2SAlistair Francis 	size_t bofs;	/* bit offset */
1635b0c03e2SAlistair Francis };
1645b0c03e2SAlistair Francis 
1655b0c03e2SAlistair Francis struct cyttsp5_touch {
1665b0c03e2SAlistair Francis 	int abs[CY_TCH_NUM_ABS];
1675b0c03e2SAlistair Francis };
1685b0c03e2SAlistair Francis 
1695b0c03e2SAlistair Francis struct cyttsp5_sysinfo {
1705b0c03e2SAlistair Francis 	struct cyttsp5_sensing_conf_data sensing_conf_data;
1715b0c03e2SAlistair Francis 	int num_btns;
1725b0c03e2SAlistair Francis 	struct cyttsp5_tch_abs_params tch_hdr;
1735b0c03e2SAlistair Francis 	struct cyttsp5_tch_abs_params tch_abs[CY_TCH_NUM_ABS];
1745b0c03e2SAlistair Francis 	u32 key_code[HID_SYSINFO_MAX_BTN];
1755b0c03e2SAlistair Francis };
1765b0c03e2SAlistair Francis 
1775b0c03e2SAlistair Francis struct cyttsp5_hid_desc {
1785b0c03e2SAlistair Francis 	__le16 hid_desc_len;
1795b0c03e2SAlistair Francis 	u8 packet_id;
1805b0c03e2SAlistair Francis 	u8 reserved_byte;
1815b0c03e2SAlistair Francis 	__le16 bcd_version;
1825b0c03e2SAlistair Francis 	__le16 report_desc_len;
1835b0c03e2SAlistair Francis 	__le16 report_desc_register;
1845b0c03e2SAlistair Francis 	__le16 input_register;
1855b0c03e2SAlistair Francis 	__le16 max_input_len;
1865b0c03e2SAlistair Francis 	__le16 output_register;
1875b0c03e2SAlistair Francis 	__le16 max_output_len;
1885b0c03e2SAlistair Francis 	__le16 command_register;
1895b0c03e2SAlistair Francis 	__le16 data_register;
1905b0c03e2SAlistair Francis 	__le16 vendor_id;
1915b0c03e2SAlistair Francis 	__le16 product_id;
1925b0c03e2SAlistair Francis 	__le16 version_id;
1935b0c03e2SAlistair Francis 	u8 reserved[4];
1945b0c03e2SAlistair Francis } __packed;
1955b0c03e2SAlistair Francis 
1965b0c03e2SAlistair Francis struct cyttsp5 {
1975b0c03e2SAlistair Francis 	struct device *dev;
1985b0c03e2SAlistair Francis 	struct completion cmd_done;
1995b0c03e2SAlistair Francis 	struct cyttsp5_sysinfo sysinfo;
2005b0c03e2SAlistair Francis 	struct cyttsp5_hid_desc hid_desc;
2015b0c03e2SAlistair Francis 	u8 cmd_buf[CYTTSP5_PREALLOCATED_CMD_BUFFER];
2025b0c03e2SAlistair Francis 	u8 input_buf[CY_MAX_INPUT];
2035b0c03e2SAlistair Francis 	u8 response_buf[CY_MAX_INPUT];
2045b0c03e2SAlistair Francis 	struct gpio_desc *reset_gpio;
2055b0c03e2SAlistair Francis 	struct input_dev *input;
2065b0c03e2SAlistair Francis 	char phys[NAME_MAX];
2075b0c03e2SAlistair Francis 	int num_prv_rec;
2085b0c03e2SAlistair Francis 	struct regmap *regmap;
2095b0c03e2SAlistair Francis 	struct touchscreen_properties prop;
2105b0c03e2SAlistair Francis 	struct regulator *vdd;
2115b0c03e2SAlistair Francis };
2125b0c03e2SAlistair Francis 
2135b0c03e2SAlistair Francis /*
2145b0c03e2SAlistair Francis  * For what is understood in the datasheet, the register does not
2155b0c03e2SAlistair Francis  * matter. For consistency, use the Input Register address
2165b0c03e2SAlistair Francis  * but it does mean anything to the device. The important data
2175b0c03e2SAlistair Francis  * to send is the I2C address
2185b0c03e2SAlistair Francis  */
cyttsp5_read(struct cyttsp5 * ts,u8 * buf,u32 max)2195b0c03e2SAlistair Francis static int cyttsp5_read(struct cyttsp5 *ts, u8 *buf, u32 max)
2205b0c03e2SAlistair Francis {
2215b0c03e2SAlistair Francis 	int error;
2225b0c03e2SAlistair Francis 	u32 size;
2235b0c03e2SAlistair Francis 	u8 temp[2];
2245b0c03e2SAlistair Francis 
2255b0c03e2SAlistair Francis 	/* Read the frame to retrieve the size */
2265b0c03e2SAlistair Francis 	error = regmap_bulk_read(ts->regmap, HID_INPUT_REG, temp, sizeof(temp));
2275b0c03e2SAlistair Francis 	if (error)
2285b0c03e2SAlistair Francis 		return error;
2295b0c03e2SAlistair Francis 
2305b0c03e2SAlistair Francis 	size = get_unaligned_le16(temp);
2315b0c03e2SAlistair Francis 	if (!size || size == 2)
2325b0c03e2SAlistair Francis 		return 0;
2335b0c03e2SAlistair Francis 
2345b0c03e2SAlistair Francis 	if (size > max)
2355b0c03e2SAlistair Francis 		return -EINVAL;
2365b0c03e2SAlistair Francis 
2375b0c03e2SAlistair Francis 	/* Get the real value */
2385b0c03e2SAlistair Francis 	return regmap_bulk_read(ts->regmap, HID_INPUT_REG, buf, size);
2395b0c03e2SAlistair Francis }
2405b0c03e2SAlistair Francis 
cyttsp5_write(struct cyttsp5 * ts,unsigned int reg,u8 * data,size_t size)2415b0c03e2SAlistair Francis static int cyttsp5_write(struct cyttsp5 *ts, unsigned int reg, u8 *data,
2425b0c03e2SAlistair Francis 			 size_t size)
2435b0c03e2SAlistair Francis {
2445b0c03e2SAlistair Francis 	u8 cmd[HID_OUTPUT_MAX_CMD_SIZE];
2455b0c03e2SAlistair Francis 
2465b0c03e2SAlistair Francis 	if (size + 1 > HID_OUTPUT_MAX_CMD_SIZE)
2475b0c03e2SAlistair Francis 		return -E2BIG;
2485b0c03e2SAlistair Francis 
2495b0c03e2SAlistair Francis 	/* High bytes of register address needed as first byte of cmd */
2505b0c03e2SAlistair Francis 	cmd[0] = (reg >> 8) & 0xFF;
2515b0c03e2SAlistair Francis 
2525b0c03e2SAlistair Francis 	/* Copy the rest of the data */
2535b0c03e2SAlistair Francis 	if (data)
2545b0c03e2SAlistair Francis 		memcpy(&cmd[1], data, size);
2555b0c03e2SAlistair Francis 
2565b0c03e2SAlistair Francis 	/*
2575b0c03e2SAlistair Francis 	 * The hardware wants to receive a frame with the address register
2585b0c03e2SAlistair Francis 	 * contained in the first two bytes. As the regmap_write function
2595b0c03e2SAlistair Francis 	 * add the register adresse in the frame, we use the low byte as
2605b0c03e2SAlistair Francis 	 * first frame byte for the address register and the first
2615b0c03e2SAlistair Francis 	 * data byte is the high register + left of the cmd to send
2625b0c03e2SAlistair Francis 	 */
2635b0c03e2SAlistair Francis 	return regmap_bulk_write(ts->regmap, reg & 0xFF, cmd, size + 1);
2645b0c03e2SAlistair Francis }
2655b0c03e2SAlistair Francis 
cyttsp5_get_touch_axis(int * axis,int size,int max,u8 * xy_data,int bofs)2665b0c03e2SAlistair Francis static void cyttsp5_get_touch_axis(int *axis, int size, int max, u8 *xy_data,
2675b0c03e2SAlistair Francis 				   int bofs)
2685b0c03e2SAlistair Francis {
2695b0c03e2SAlistair Francis 	int nbyte;
2705b0c03e2SAlistair Francis 
2715b0c03e2SAlistair Francis 	for (nbyte = 0, *axis = 0; nbyte < size; nbyte++)
2725b0c03e2SAlistair Francis 		*axis += ((xy_data[nbyte] >> bofs) << (nbyte * 8));
2735b0c03e2SAlistair Francis 
2745b0c03e2SAlistair Francis 	*axis &= max - 1;
2755b0c03e2SAlistair Francis }
2765b0c03e2SAlistair Francis 
cyttsp5_get_touch_record(struct cyttsp5 * ts,struct cyttsp5_touch * touch,u8 * xy_data)2775b0c03e2SAlistair Francis static void cyttsp5_get_touch_record(struct cyttsp5 *ts,
2785b0c03e2SAlistair Francis 				     struct cyttsp5_touch *touch, u8 *xy_data)
2795b0c03e2SAlistair Francis {
2805b0c03e2SAlistair Francis 	struct cyttsp5_sysinfo *si = &ts->sysinfo;
2815b0c03e2SAlistair Francis 	enum cyttsp5_tch_abs abs;
2825b0c03e2SAlistair Francis 
2835b0c03e2SAlistair Francis 	for (abs = CY_TCH_X; abs < CY_TCH_NUM_ABS; abs++)
2845b0c03e2SAlistair Francis 		cyttsp5_get_touch_axis(&touch->abs[abs],
2855b0c03e2SAlistair Francis 				       si->tch_abs[abs].size,
2865b0c03e2SAlistair Francis 				       si->tch_abs[abs].max,
2875b0c03e2SAlistair Francis 				       xy_data + si->tch_abs[abs].ofs,
2885b0c03e2SAlistair Francis 				       si->tch_abs[abs].bofs);
2895b0c03e2SAlistair Francis }
2905b0c03e2SAlistair Francis 
cyttsp5_get_mt_touches(struct cyttsp5 * ts,struct cyttsp5_touch * tch,int num_cur_tch)2915b0c03e2SAlistair Francis static void cyttsp5_get_mt_touches(struct cyttsp5 *ts,
2925b0c03e2SAlistair Francis 				   struct cyttsp5_touch *tch, int num_cur_tch)
2935b0c03e2SAlistair Francis {
2945b0c03e2SAlistair Francis 	struct cyttsp5_sysinfo *si = &ts->sysinfo;
2955b0c03e2SAlistair Francis 	int i, t = 0, offset = 0;
2965b0c03e2SAlistair Francis 	DECLARE_BITMAP(ids, MAX_CY_TCH_T_IDS);
2975b0c03e2SAlistair Francis 	u8 *tch_addr;
2985b0c03e2SAlistair Francis 	int tmp;
2995b0c03e2SAlistair Francis 
3005b0c03e2SAlistair Francis 	bitmap_zero(ids, MAX_CY_TCH_T_IDS);
3015b0c03e2SAlistair Francis 	memset(tch->abs, 0, sizeof(tch->abs));
3025b0c03e2SAlistair Francis 
3035b0c03e2SAlistair Francis 	switch (ts->input_buf[2]) {
3045b0c03e2SAlistair Francis 	case HID_TOUCH_REPORT_ID:
3055b0c03e2SAlistair Francis 		offset = TOUCH_INPUT_HEADER_SIZE;
3065b0c03e2SAlistair Francis 		break;
3075b0c03e2SAlistair Francis 	case HID_BTN_REPORT_ID:
3085b0c03e2SAlistair Francis 		offset = BTN_INPUT_HEADER_SIZE;
3095b0c03e2SAlistair Francis 		break;
3105b0c03e2SAlistair Francis 	}
3115b0c03e2SAlistair Francis 
3125b0c03e2SAlistair Francis 	for (i = 0; i < num_cur_tch; i++) {
3135b0c03e2SAlistair Francis 		tch_addr = ts->input_buf + offset + (i * TOUCH_REPORT_SIZE);
3145b0c03e2SAlistair Francis 		cyttsp5_get_touch_record(ts, tch, tch_addr);
3155b0c03e2SAlistair Francis 
3165b0c03e2SAlistair Francis 		/* Convert MAJOR/MINOR from mm to resolution */
3175b0c03e2SAlistair Francis 		tmp = tch->abs[CY_TCH_MAJ] * 100 * si->sensing_conf_data.res_x;
3185b0c03e2SAlistair Francis 		tch->abs[CY_TCH_MAJ] = tmp / si->sensing_conf_data.len_x;
3195b0c03e2SAlistair Francis 		tmp = tch->abs[CY_TCH_MIN] * 100 * si->sensing_conf_data.res_x;
3205b0c03e2SAlistair Francis 		tch->abs[CY_TCH_MIN] = tmp / si->sensing_conf_data.len_x;
3215b0c03e2SAlistair Francis 
3225b0c03e2SAlistair Francis 		t = tch->abs[CY_TCH_T];
3235b0c03e2SAlistair Francis 		input_mt_slot(ts->input, t);
3245b0c03e2SAlistair Francis 		input_mt_report_slot_state(ts->input, MT_TOOL_FINGER, true);
3255b0c03e2SAlistair Francis 		__set_bit(t, ids);
3265b0c03e2SAlistair Francis 
3275b0c03e2SAlistair Francis 		/* position and pressure fields */
3285b0c03e2SAlistair Francis 		touchscreen_report_pos(ts->input, &ts->prop,
3295b0c03e2SAlistair Francis 				       tch->abs[CY_TCH_X], tch->abs[CY_TCH_Y],
3305b0c03e2SAlistair Francis 				       true);
3315b0c03e2SAlistair Francis 		input_report_abs(ts->input, ABS_MT_PRESSURE,
3325b0c03e2SAlistair Francis 				 tch->abs[CY_TCH_P]);
3335b0c03e2SAlistair Francis 
3345b0c03e2SAlistair Francis 		/* Get the extended touch fields */
3355b0c03e2SAlistair Francis 		input_report_abs(ts->input, ABS_MT_TOUCH_MAJOR,
3365b0c03e2SAlistair Francis 				 tch->abs[CY_TCH_MAJ]);
3375b0c03e2SAlistair Francis 		input_report_abs(ts->input, ABS_MT_TOUCH_MINOR,
3385b0c03e2SAlistair Francis 				 tch->abs[CY_TCH_MIN]);
3395b0c03e2SAlistair Francis 	}
3405b0c03e2SAlistair Francis 
3415b0c03e2SAlistair Francis 	ts->num_prv_rec = num_cur_tch;
3425b0c03e2SAlistair Francis }
3435b0c03e2SAlistair Francis 
cyttsp5_mt_attention(struct device * dev)3445b0c03e2SAlistair Francis static int cyttsp5_mt_attention(struct device *dev)
3455b0c03e2SAlistair Francis {
3465b0c03e2SAlistair Francis 	struct cyttsp5 *ts = dev_get_drvdata(dev);
3475b0c03e2SAlistair Francis 	struct cyttsp5_sysinfo *si = &ts->sysinfo;
3485b0c03e2SAlistair Francis 	int max_tch = si->sensing_conf_data.max_tch;
3495b0c03e2SAlistair Francis 	struct cyttsp5_touch tch;
3505b0c03e2SAlistair Francis 	int num_cur_tch;
3515b0c03e2SAlistair Francis 
3525b0c03e2SAlistair Francis 	cyttsp5_get_touch_axis(&num_cur_tch, si->tch_hdr.size,
3535b0c03e2SAlistair Francis 			       si->tch_hdr.max,
3545b0c03e2SAlistair Francis 			       ts->input_buf + 3 + si->tch_hdr.ofs,
3555b0c03e2SAlistair Francis 			       si->tch_hdr.bofs);
3565b0c03e2SAlistair Francis 
3575b0c03e2SAlistair Francis 	if (num_cur_tch > max_tch) {
3585b0c03e2SAlistair Francis 		dev_err(dev, "Num touch err detected (n=%d)\n", num_cur_tch);
3595b0c03e2SAlistair Francis 		num_cur_tch = max_tch;
3605b0c03e2SAlistair Francis 	}
3615b0c03e2SAlistair Francis 
3625b0c03e2SAlistair Francis 	if (num_cur_tch == 0 && ts->num_prv_rec == 0)
3635b0c03e2SAlistair Francis 		return 0;
3645b0c03e2SAlistair Francis 
3655b0c03e2SAlistair Francis 	/* extract xy_data for all currently reported touches */
3665b0c03e2SAlistair Francis 	if (num_cur_tch)
3675b0c03e2SAlistair Francis 		cyttsp5_get_mt_touches(ts, &tch, num_cur_tch);
3685b0c03e2SAlistair Francis 
3695b0c03e2SAlistair Francis 	input_mt_sync_frame(ts->input);
3705b0c03e2SAlistair Francis 	input_sync(ts->input);
3715b0c03e2SAlistair Francis 
3725b0c03e2SAlistair Francis 	return 0;
3735b0c03e2SAlistair Francis }
3745b0c03e2SAlistair Francis 
cyttsp5_setup_input_device(struct device * dev)3755b0c03e2SAlistair Francis static int cyttsp5_setup_input_device(struct device *dev)
3765b0c03e2SAlistair Francis {
3775b0c03e2SAlistair Francis 	struct cyttsp5 *ts = dev_get_drvdata(dev);
3785b0c03e2SAlistair Francis 	struct cyttsp5_sysinfo *si = &ts->sysinfo;
3795b0c03e2SAlistair Francis 	int max_x, max_y, max_p;
3805b0c03e2SAlistair Francis 	int max_x_tmp, max_y_tmp;
3815b0c03e2SAlistair Francis 	int error;
3825b0c03e2SAlistair Francis 
3835b0c03e2SAlistair Francis 	max_x_tmp = si->sensing_conf_data.res_x;
3845b0c03e2SAlistair Francis 	max_y_tmp = si->sensing_conf_data.res_y;
3855b0c03e2SAlistair Francis 	max_x = max_x_tmp - 1;
3865b0c03e2SAlistair Francis 	max_y = max_y_tmp - 1;
3875b0c03e2SAlistair Francis 	max_p = si->sensing_conf_data.max_z;
3885b0c03e2SAlistair Francis 
3895b0c03e2SAlistair Francis 	input_set_abs_params(ts->input, ABS_MT_POSITION_X, 0, max_x, 0, 0);
3905b0c03e2SAlistair Francis 	input_set_abs_params(ts->input, ABS_MT_POSITION_Y, 0, max_y, 0, 0);
3915b0c03e2SAlistair Francis 	input_set_abs_params(ts->input, ABS_MT_PRESSURE, 0, max_p, 0, 0);
3925b0c03e2SAlistair Francis 
3935b0c03e2SAlistair Francis 	input_set_abs_params(ts->input, ABS_MT_TOUCH_MAJOR, 0, MAX_AREA, 0, 0);
3945b0c03e2SAlistair Francis 	input_set_abs_params(ts->input, ABS_MT_TOUCH_MINOR, 0, MAX_AREA, 0, 0);
3955b0c03e2SAlistair Francis 
3965b0c03e2SAlistair Francis 	error = input_mt_init_slots(ts->input, si->tch_abs[CY_TCH_T].max,
3975b0c03e2SAlistair Francis 				    INPUT_MT_DROP_UNUSED | INPUT_MT_DIRECT);
3985b0c03e2SAlistair Francis 	if (error)
3995b0c03e2SAlistair Francis 		return error;
4005b0c03e2SAlistair Francis 
4015b0c03e2SAlistair Francis 	error = input_register_device(ts->input);
4025b0c03e2SAlistair Francis 	if (error) {
4035b0c03e2SAlistair Francis 		dev_err(dev, "failed to register input device: %d\n", error);
4045b0c03e2SAlistair Francis 		return error;
4055b0c03e2SAlistair Francis 	}
4065b0c03e2SAlistair Francis 
4075b0c03e2SAlistair Francis 	return error;
4085b0c03e2SAlistair Francis }
4095b0c03e2SAlistair Francis 
cyttsp5_parse_dt_key_code(struct device * dev)4105b0c03e2SAlistair Francis static int cyttsp5_parse_dt_key_code(struct device *dev)
4115b0c03e2SAlistair Francis {
4125b0c03e2SAlistair Francis 	struct cyttsp5 *ts = dev_get_drvdata(dev);
4135b0c03e2SAlistair Francis 	struct cyttsp5_sysinfo *si = &ts->sysinfo;
4145b0c03e2SAlistair Francis 
4155b0c03e2SAlistair Francis 	if (!si->num_btns)
4165b0c03e2SAlistair Francis 		return 0;
4175b0c03e2SAlistair Francis 
4185b0c03e2SAlistair Francis 	/* Initialize the button to RESERVED */
4195b0c03e2SAlistair Francis 	memset32(si->key_code, KEY_RESERVED,  si->num_btns);
4205b0c03e2SAlistair Francis 
4215b0c03e2SAlistair Francis 	return device_property_read_u32_array(dev, "linux,keycodes",
4225b0c03e2SAlistair Francis 					      si->key_code, si->num_btns);
4235b0c03e2SAlistair Francis }
4245b0c03e2SAlistair Francis 
cyttsp5_btn_attention(struct device * dev)4255b0c03e2SAlistair Francis static int cyttsp5_btn_attention(struct device *dev)
4265b0c03e2SAlistair Francis {
4275b0c03e2SAlistair Francis 	struct cyttsp5 *ts = dev_get_drvdata(dev);
4285b0c03e2SAlistair Francis 	struct cyttsp5_sysinfo *si = &ts->sysinfo;
4295b0c03e2SAlistair Francis 	int cur_btn, offset = 0;
4305b0c03e2SAlistair Francis 	int cur_btn_state;
4315b0c03e2SAlistair Francis 
4325b0c03e2SAlistair Francis 	switch (ts->input_buf[2]) {
4335b0c03e2SAlistair Francis 	case HID_TOUCH_REPORT_ID:
4345b0c03e2SAlistair Francis 		offset = TOUCH_INPUT_HEADER_SIZE;
4355b0c03e2SAlistair Francis 		break;
4365b0c03e2SAlistair Francis 	case HID_BTN_REPORT_ID:
4375b0c03e2SAlistair Francis 		offset = BTN_INPUT_HEADER_SIZE;
4385b0c03e2SAlistair Francis 		break;
4395b0c03e2SAlistair Francis 	}
4405b0c03e2SAlistair Francis 
4415b0c03e2SAlistair Francis 	if (ts->input_buf[2] != HID_BTN_REPORT_ID)
4425b0c03e2SAlistair Francis 		return 0;
4435b0c03e2SAlistair Francis 
4445b0c03e2SAlistair Francis 	/* extract button press/release touch information */
4455b0c03e2SAlistair Francis 	for (cur_btn = 0; cur_btn < si->num_btns; cur_btn++) {
4465b0c03e2SAlistair Francis 		/* Get current button state */
4475b0c03e2SAlistair Francis 		cur_btn_state = (ts->input_buf[offset] >> (cur_btn * CY_BITS_PER_BTN))
4485b0c03e2SAlistair Francis 				& CY_NUM_BTN_EVENT_ID;
4495b0c03e2SAlistair Francis 
4505b0c03e2SAlistair Francis 		input_report_key(ts->input, si->key_code[cur_btn],
4515b0c03e2SAlistair Francis 				 cur_btn_state);
4525b0c03e2SAlistair Francis 		input_sync(ts->input);
4535b0c03e2SAlistair Francis 	}
4545b0c03e2SAlistair Francis 
4555b0c03e2SAlistair Francis 	return 0;
4565b0c03e2SAlistair Francis }
4575b0c03e2SAlistair Francis 
cyttsp5_validate_cmd_response(struct cyttsp5 * ts,u8 code)4585b0c03e2SAlistair Francis static int cyttsp5_validate_cmd_response(struct cyttsp5 *ts, u8 code)
4595b0c03e2SAlistair Francis {
4605b0c03e2SAlistair Francis 	u16 size, crc;
4615b0c03e2SAlistair Francis 	u8 status, report_id;
4625b0c03e2SAlistair Francis 	int command_code;
4635b0c03e2SAlistair Francis 
4645b0c03e2SAlistair Francis 	size = get_unaligned_le16(&ts->response_buf[0]);
4655b0c03e2SAlistair Francis 	if (!size)
4665b0c03e2SAlistair Francis 		return 0;
4675b0c03e2SAlistair Francis 
4685b0c03e2SAlistair Francis 	report_id = ts->response_buf[HID_OUTPUT_RESPONSE_REPORT_OFFSET];
4695b0c03e2SAlistair Francis 
4705b0c03e2SAlistair Francis 	switch (report_id) {
4715b0c03e2SAlistair Francis 	case HID_BL_RESPONSE_REPORT_ID:
4725b0c03e2SAlistair Francis 		if (ts->response_buf[4] != HID_OUTPUT_BL_SOP) {
4735b0c03e2SAlistair Francis 			dev_err(ts->dev, "HID output response, wrong SOP\n");
4745b0c03e2SAlistair Francis 			return -EPROTO;
4755b0c03e2SAlistair Francis 		}
4765b0c03e2SAlistair Francis 
4775b0c03e2SAlistair Francis 		if (ts->response_buf[size - 1] != HID_OUTPUT_BL_EOP) {
4785b0c03e2SAlistair Francis 			dev_err(ts->dev, "HID output response, wrong EOP\n");
4795b0c03e2SAlistair Francis 			return -EPROTO;
4805b0c03e2SAlistair Francis 		}
4815b0c03e2SAlistair Francis 
4825b0c03e2SAlistair Francis 		crc = crc_itu_t(0xFFFF, &ts->response_buf[4], size - 7);
4835b0c03e2SAlistair Francis 		if (get_unaligned_le16(&ts->response_buf[size - 3]) != crc) {
4845b0c03e2SAlistair Francis 			dev_err(ts->dev,
4855b0c03e2SAlistair Francis 				"HID output response, wrong CRC 0x%X\n",
4865b0c03e2SAlistair Francis 				crc);
4875b0c03e2SAlistair Francis 			return -EPROTO;
4885b0c03e2SAlistair Francis 		}
4895b0c03e2SAlistair Francis 
4905b0c03e2SAlistair Francis 		status = ts->response_buf[5];
4915b0c03e2SAlistair Francis 		if (status) {
4925b0c03e2SAlistair Francis 			dev_err(ts->dev, "HID output response, ERROR:%d\n",
4935b0c03e2SAlistair Francis 				status);
4945b0c03e2SAlistair Francis 			return -EPROTO;
4955b0c03e2SAlistair Francis 		}
4965b0c03e2SAlistair Francis 		break;
4975b0c03e2SAlistair Francis 
4985b0c03e2SAlistair Francis 	case HID_APP_RESPONSE_REPORT_ID:
4995b0c03e2SAlistair Francis 		command_code = ts->response_buf[HID_OUTPUT_RESPONSE_CMD_OFFSET]
5005b0c03e2SAlistair Francis 			& HID_OUTPUT_RESPONSE_CMD_MASK;
5015b0c03e2SAlistair Francis 		if (command_code != code) {
5025b0c03e2SAlistair Francis 			dev_err(ts->dev,
5035b0c03e2SAlistair Francis 				"HID output response, wrong command_code:%X\n",
5045b0c03e2SAlistair Francis 				command_code);
5055b0c03e2SAlistair Francis 			return -EPROTO;
5065b0c03e2SAlistair Francis 		}
5075b0c03e2SAlistair Francis 		break;
5085b0c03e2SAlistair Francis 	}
5095b0c03e2SAlistair Francis 
5105b0c03e2SAlistair Francis 	return 0;
5115b0c03e2SAlistair Francis }
5125b0c03e2SAlistair Francis 
cyttsp5_si_get_btn_data(struct cyttsp5 * ts)5135b0c03e2SAlistair Francis static void cyttsp5_si_get_btn_data(struct cyttsp5 *ts)
5145b0c03e2SAlistair Francis {
5155b0c03e2SAlistair Francis 	struct cyttsp5_sysinfo *si = &ts->sysinfo;
5165b0c03e2SAlistair Francis 	unsigned int btns = ts->response_buf[HID_SYSINFO_BTN_OFFSET] &
5175b0c03e2SAlistair Francis 				HID_SYSINFO_BTN_MASK;
5185b0c03e2SAlistair Francis 
5195b0c03e2SAlistair Francis 	si->num_btns = hweight8(btns);
5205b0c03e2SAlistair Francis }
5215b0c03e2SAlistair Francis 
cyttsp5_get_sysinfo_regs(struct cyttsp5 * ts)5225b0c03e2SAlistair Francis static int cyttsp5_get_sysinfo_regs(struct cyttsp5 *ts)
5235b0c03e2SAlistair Francis {
5245b0c03e2SAlistair Francis 	struct cyttsp5_sensing_conf_data *scd = &ts->sysinfo.sensing_conf_data;
5255b0c03e2SAlistair Francis 	struct cyttsp5_sensing_conf_data_dev *scd_dev =
5265b0c03e2SAlistair Francis 		(struct cyttsp5_sensing_conf_data_dev *)
5275b0c03e2SAlistair Francis 		&ts->response_buf[HID_SYSINFO_SENSING_OFFSET];
5285b0c03e2SAlistair Francis 
5295b0c03e2SAlistair Francis 	cyttsp5_si_get_btn_data(ts);
5305b0c03e2SAlistair Francis 
5315b0c03e2SAlistair Francis 	scd->max_tch = scd_dev->max_num_of_tch_per_refresh_cycle;
5325b0c03e2SAlistair Francis 	scd->res_x = get_unaligned_le16(&scd_dev->res_x);
5335b0c03e2SAlistair Francis 	scd->res_y = get_unaligned_le16(&scd_dev->res_y);
5345b0c03e2SAlistair Francis 	scd->max_z = get_unaligned_le16(&scd_dev->max_z);
5355b0c03e2SAlistair Francis 	scd->len_x = get_unaligned_le16(&scd_dev->len_x);
5365b0c03e2SAlistair Francis 	scd->len_y = get_unaligned_le16(&scd_dev->len_y);
5375b0c03e2SAlistair Francis 
5385b0c03e2SAlistair Francis 	return 0;
5395b0c03e2SAlistair Francis }
5405b0c03e2SAlistair Francis 
cyttsp5_hid_output_get_sysinfo(struct cyttsp5 * ts)5415b0c03e2SAlistair Francis static int cyttsp5_hid_output_get_sysinfo(struct cyttsp5 *ts)
5425b0c03e2SAlistair Francis {
5435b0c03e2SAlistair Francis 	int rc;
5445b0c03e2SAlistair Francis 	u8 cmd[HID_OUTPUT_GET_SYSINFO_SIZE];
5455b0c03e2SAlistair Francis 
5465b0c03e2SAlistair Francis 	/* HI bytes of Output register address */
5475b0c03e2SAlistair Francis 	put_unaligned_le16(HID_OUTPUT_GET_SYSINFO_SIZE, cmd);
5485b0c03e2SAlistair Francis 	cmd[2] = HID_APP_OUTPUT_REPORT_ID;
5495b0c03e2SAlistair Francis 	cmd[3] = 0x0; /* Reserved */
5505b0c03e2SAlistair Francis 	cmd[4] = HID_OUTPUT_GET_SYSINFO;
5515b0c03e2SAlistair Francis 
5525b0c03e2SAlistair Francis 	rc = cyttsp5_write(ts, HID_OUTPUT_REG, cmd,
5535b0c03e2SAlistair Francis 			   HID_OUTPUT_GET_SYSINFO_SIZE);
5545b0c03e2SAlistair Francis 	if (rc) {
5555b0c03e2SAlistair Francis 		dev_err(ts->dev, "Failed to write command %d", rc);
5565b0c03e2SAlistair Francis 		return rc;
5575b0c03e2SAlistair Francis 	}
5585b0c03e2SAlistair Francis 
5595b0c03e2SAlistair Francis 	rc = wait_for_completion_interruptible_timeout(&ts->cmd_done,
5605b0c03e2SAlistair Francis 						msecs_to_jiffies(CY_HID_OUTPUT_GET_SYSINFO_TIMEOUT_MS));
5615b0c03e2SAlistair Francis 	if (rc <= 0) {
5625b0c03e2SAlistair Francis 		dev_err(ts->dev, "HID output cmd execution timed out\n");
5635b0c03e2SAlistair Francis 		rc = -ETIMEDOUT;
5645b0c03e2SAlistair Francis 		return rc;
5655b0c03e2SAlistair Francis 	}
5665b0c03e2SAlistair Francis 
5675b0c03e2SAlistair Francis 	rc = cyttsp5_validate_cmd_response(ts, HID_OUTPUT_GET_SYSINFO);
5685b0c03e2SAlistair Francis 	if (rc) {
5695b0c03e2SAlistair Francis 		dev_err(ts->dev, "Validation of the response failed\n");
5705b0c03e2SAlistair Francis 		return rc;
5715b0c03e2SAlistair Francis 	}
5725b0c03e2SAlistair Francis 
5735b0c03e2SAlistair Francis 	return cyttsp5_get_sysinfo_regs(ts);
5745b0c03e2SAlistair Francis }
5755b0c03e2SAlistair Francis 
cyttsp5_power_control(struct cyttsp5 * ts,bool on)5763c98b8dbSMaximilian Weigand static int cyttsp5_power_control(struct cyttsp5 *ts, bool on)
5773c98b8dbSMaximilian Weigand {
5783c98b8dbSMaximilian Weigand 	u8 state = on ? HID_POWER_ON : HID_POWER_SLEEP;
5793c98b8dbSMaximilian Weigand 	u8 cmd[2] = { 0 };
5803c98b8dbSMaximilian Weigand 	int rc;
5813c98b8dbSMaximilian Weigand 
5823c98b8dbSMaximilian Weigand 	SET_CMD_REPORT_TYPE(cmd[0], 0);
5833c98b8dbSMaximilian Weigand 	SET_CMD_REPORT_ID(cmd[0], HID_POWER_SLEEP);
5843c98b8dbSMaximilian Weigand 	SET_CMD_OPCODE(cmd[1], HID_CMD_SET_POWER);
5853c98b8dbSMaximilian Weigand 
5863c98b8dbSMaximilian Weigand 	rc = cyttsp5_write(ts, HID_COMMAND_REG, cmd, sizeof(cmd));
5873c98b8dbSMaximilian Weigand 	if (rc) {
5883c98b8dbSMaximilian Weigand 		dev_err(ts->dev, "Failed to write power command %d", rc);
5893c98b8dbSMaximilian Weigand 		return rc;
5903c98b8dbSMaximilian Weigand 	}
5913c98b8dbSMaximilian Weigand 
5923c98b8dbSMaximilian Weigand 	rc = wait_for_completion_interruptible_timeout(&ts->cmd_done,
5933c98b8dbSMaximilian Weigand 				msecs_to_jiffies(CY_HID_SET_POWER_TIMEOUT));
5943c98b8dbSMaximilian Weigand 	if (rc <= 0) {
5953c98b8dbSMaximilian Weigand 		dev_err(ts->dev, "HID power cmd execution timed out\n");
5963c98b8dbSMaximilian Weigand 		return -ETIMEDOUT;
5973c98b8dbSMaximilian Weigand 	}
5983c98b8dbSMaximilian Weigand 
5993c98b8dbSMaximilian Weigand 	if (ts->response_buf[2] != HID_RESPONSE_REPORT_ID ||
6003c98b8dbSMaximilian Weigand 	    (ts->response_buf[3] & 0x03) != state ||
6013c98b8dbSMaximilian Weigand 	    (ts->response_buf[4] & 0x0f) != HID_CMD_SET_POWER) {
6023c98b8dbSMaximilian Weigand 		dev_err(ts->dev, "Validation of the %s response failed\n",
6033c98b8dbSMaximilian Weigand 			on ? "wakeup" : "sleep");
6043c98b8dbSMaximilian Weigand 		return -EINVAL;
6053c98b8dbSMaximilian Weigand 	}
6063c98b8dbSMaximilian Weigand 
6073c98b8dbSMaximilian Weigand 	return 0;
6083c98b8dbSMaximilian Weigand }
6093c98b8dbSMaximilian Weigand 
cyttsp5_hid_output_bl_launch_app(struct cyttsp5 * ts)6105b0c03e2SAlistair Francis static int cyttsp5_hid_output_bl_launch_app(struct cyttsp5 *ts)
6115b0c03e2SAlistair Francis {
6125b0c03e2SAlistair Francis 	int rc;
613529de2f1SMaximilian Weigand 	u8 cmd[HID_OUTPUT_BL_LAUNCH_APP_SIZE];
6145b0c03e2SAlistair Francis 	u16 crc;
6155b0c03e2SAlistair Francis 
6165b0c03e2SAlistair Francis 	put_unaligned_le16(HID_OUTPUT_BL_LAUNCH_APP_SIZE, cmd);
6175b0c03e2SAlistair Francis 	cmd[2] = HID_BL_OUTPUT_REPORT_ID;
6185b0c03e2SAlistair Francis 	cmd[3] = 0x0; /* Reserved */
6195b0c03e2SAlistair Francis 	cmd[4] = HID_OUTPUT_BL_SOP;
6205b0c03e2SAlistair Francis 	cmd[5] = HID_OUTPUT_BL_LAUNCH_APP;
6215b0c03e2SAlistair Francis 	put_unaligned_le16(0x00, &cmd[6]);
6225b0c03e2SAlistair Francis 	crc = crc_itu_t(0xFFFF, &cmd[4], 4);
6235b0c03e2SAlistair Francis 	put_unaligned_le16(crc, &cmd[8]);
6245b0c03e2SAlistair Francis 	cmd[10] = HID_OUTPUT_BL_EOP;
6255b0c03e2SAlistair Francis 
6265b0c03e2SAlistair Francis 	rc = cyttsp5_write(ts, HID_OUTPUT_REG, cmd,
6275b0c03e2SAlistair Francis 			   HID_OUTPUT_BL_LAUNCH_APP_SIZE);
6285b0c03e2SAlistair Francis 	if (rc) {
6295b0c03e2SAlistair Francis 		dev_err(ts->dev, "Failed to write command %d", rc);
6305b0c03e2SAlistair Francis 		return rc;
6315b0c03e2SAlistair Francis 	}
6325b0c03e2SAlistair Francis 
6335b0c03e2SAlistair Francis 	rc = wait_for_completion_interruptible_timeout(&ts->cmd_done,
6345b0c03e2SAlistair Francis 				msecs_to_jiffies(CY_HID_OUTPUT_TIMEOUT_MS));
6355b0c03e2SAlistair Francis 	if (rc <= 0) {
6365b0c03e2SAlistair Francis 		dev_err(ts->dev, "HID output cmd execution timed out\n");
6375b0c03e2SAlistair Francis 		rc = -ETIMEDOUT;
6385b0c03e2SAlistair Francis 		return rc;
6395b0c03e2SAlistair Francis 	}
6405b0c03e2SAlistair Francis 
6415b0c03e2SAlistair Francis 	rc = cyttsp5_validate_cmd_response(ts, HID_OUTPUT_BL_LAUNCH_APP);
6425b0c03e2SAlistair Francis 	if (rc) {
6435b0c03e2SAlistair Francis 		dev_err(ts->dev, "Validation of the response failed\n");
6445b0c03e2SAlistair Francis 		return rc;
6455b0c03e2SAlistair Francis 	}
6465b0c03e2SAlistair Francis 
6475b0c03e2SAlistair Francis 	return 0;
6485b0c03e2SAlistair Francis }
6495b0c03e2SAlistair Francis 
cyttsp5_get_hid_descriptor(struct cyttsp5 * ts,struct cyttsp5_hid_desc * desc)6505b0c03e2SAlistair Francis static int cyttsp5_get_hid_descriptor(struct cyttsp5 *ts,
6515b0c03e2SAlistair Francis 				      struct cyttsp5_hid_desc *desc)
6525b0c03e2SAlistair Francis {
6535b0c03e2SAlistair Francis 	struct device *dev = ts->dev;
6545b0c03e2SAlistair Francis 	int rc;
6555b0c03e2SAlistair Francis 
6565b0c03e2SAlistair Francis 	rc = cyttsp5_write(ts, HID_DESC_REG, NULL, 0);
6575b0c03e2SAlistair Francis 	if (rc) {
6585b0c03e2SAlistair Francis 		dev_err(dev, "Failed to get HID descriptor, rc=%d\n", rc);
6595b0c03e2SAlistair Francis 		return rc;
6605b0c03e2SAlistair Francis 	}
6615b0c03e2SAlistair Francis 
6625b0c03e2SAlistair Francis 	rc = wait_for_completion_interruptible_timeout(&ts->cmd_done,
6635b0c03e2SAlistair Francis 			msecs_to_jiffies(CY_HID_GET_HID_DESCRIPTOR_TIMEOUT_MS));
6645b0c03e2SAlistair Francis 	if (rc <= 0) {
6655b0c03e2SAlistair Francis 		dev_err(ts->dev, "HID get descriptor timed out\n");
6665b0c03e2SAlistair Francis 		rc = -ETIMEDOUT;
6675b0c03e2SAlistair Francis 		return rc;
6685b0c03e2SAlistair Francis 	}
6695b0c03e2SAlistair Francis 
6705b0c03e2SAlistair Francis 	memcpy(desc, ts->response_buf, sizeof(*desc));
6715b0c03e2SAlistair Francis 
6725b0c03e2SAlistair Francis 	/* Check HID descriptor length and version */
6735b0c03e2SAlistair Francis 	if (le16_to_cpu(desc->hid_desc_len) != sizeof(*desc) ||
6745b0c03e2SAlistair Francis 	    le16_to_cpu(desc->bcd_version) != HID_VERSION) {
6755b0c03e2SAlistair Francis 		dev_err(dev, "Unsupported HID version\n");
6765b0c03e2SAlistair Francis 		return -ENODEV;
6775b0c03e2SAlistair Francis 	}
6785b0c03e2SAlistair Francis 
6795b0c03e2SAlistair Francis 	return 0;
6805b0c03e2SAlistair Francis }
6815b0c03e2SAlistair Francis 
fill_tch_abs(struct cyttsp5_tch_abs_params * tch_abs,int report_size,int offset)6825b0c03e2SAlistair Francis static int fill_tch_abs(struct cyttsp5_tch_abs_params *tch_abs, int report_size,
6835b0c03e2SAlistair Francis 			int offset)
6845b0c03e2SAlistair Francis {
6855b0c03e2SAlistair Francis 	tch_abs->ofs = offset / 8;
6865b0c03e2SAlistair Francis 	tch_abs->size = report_size / 8;
6875b0c03e2SAlistair Francis 	if (report_size % 8)
6885b0c03e2SAlistair Francis 		tch_abs->size += 1;
6895b0c03e2SAlistair Francis 	tch_abs->min = 0;
6905b0c03e2SAlistair Francis 	tch_abs->max = 1 << report_size;
6915b0c03e2SAlistair Francis 	tch_abs->bofs = offset - (tch_abs->ofs << 3);
6925b0c03e2SAlistair Francis 
6935b0c03e2SAlistair Francis 	return 0;
6945b0c03e2SAlistair Francis }
6955b0c03e2SAlistair Francis 
cyttsp5_handle_irq(int irq,void * handle)6965b0c03e2SAlistair Francis static irqreturn_t cyttsp5_handle_irq(int irq, void *handle)
6975b0c03e2SAlistair Francis {
6985b0c03e2SAlistair Francis 	struct cyttsp5 *ts = handle;
6995b0c03e2SAlistair Francis 	int report_id;
7005b0c03e2SAlistair Francis 	int size;
7015b0c03e2SAlistair Francis 	int error;
7025b0c03e2SAlistair Francis 
7035b0c03e2SAlistair Francis 	error = cyttsp5_read(ts, ts->input_buf, CY_MAX_INPUT);
7045b0c03e2SAlistair Francis 	if (error)
7055b0c03e2SAlistair Francis 		return IRQ_HANDLED;
7065b0c03e2SAlistair Francis 
7075b0c03e2SAlistair Francis 	size = get_unaligned_le16(&ts->input_buf[0]);
7085b0c03e2SAlistair Francis 	if (size == 0) {
7095b0c03e2SAlistair Francis 		/* reset */
7105b0c03e2SAlistair Francis 		report_id = 0;
7115b0c03e2SAlistair Francis 		size = 2;
7125b0c03e2SAlistair Francis 	} else {
7135b0c03e2SAlistair Francis 		report_id = ts->input_buf[2];
7145b0c03e2SAlistair Francis 	}
7155b0c03e2SAlistair Francis 
7165b0c03e2SAlistair Francis 	switch (report_id) {
7175b0c03e2SAlistair Francis 	case HID_TOUCH_REPORT_ID:
7185b0c03e2SAlistair Francis 		cyttsp5_mt_attention(ts->dev);
7195b0c03e2SAlistair Francis 		break;
7205b0c03e2SAlistair Francis 	case HID_BTN_REPORT_ID:
7215b0c03e2SAlistair Francis 		cyttsp5_btn_attention(ts->dev);
7225b0c03e2SAlistair Francis 		break;
7233c98b8dbSMaximilian Weigand 	case HID_RESPONSE_REPORT_ID:
7243c98b8dbSMaximilian Weigand 		memcpy(ts->response_buf, ts->input_buf, size);
7253c98b8dbSMaximilian Weigand 		complete(&ts->cmd_done);
7263c98b8dbSMaximilian Weigand 		break;
7275b0c03e2SAlistair Francis 	default:
7285b0c03e2SAlistair Francis 		/* It is not an input but a command response */
7295b0c03e2SAlistair Francis 		memcpy(ts->response_buf, ts->input_buf, size);
7305b0c03e2SAlistair Francis 		complete(&ts->cmd_done);
7315b0c03e2SAlistair Francis 	}
7325b0c03e2SAlistair Francis 
7335b0c03e2SAlistair Francis 	return IRQ_HANDLED;
7345b0c03e2SAlistair Francis }
7355b0c03e2SAlistair Francis 
cyttsp5_deassert_int(struct cyttsp5 * ts)7365b0c03e2SAlistair Francis static int cyttsp5_deassert_int(struct cyttsp5 *ts)
7375b0c03e2SAlistair Francis {
7385b0c03e2SAlistair Francis 	u16 size;
7395b0c03e2SAlistair Francis 	u8 buf[2];
7405b0c03e2SAlistair Francis 	int error;
7415b0c03e2SAlistair Francis 
7425b0c03e2SAlistair Francis 	error = regmap_bulk_read(ts->regmap, HID_INPUT_REG, buf, sizeof(buf));
7435b0c03e2SAlistair Francis 	if (error < 0)
7445b0c03e2SAlistair Francis 		return error;
7455b0c03e2SAlistair Francis 
7465b0c03e2SAlistair Francis 	size = get_unaligned_le16(&buf[0]);
7475b0c03e2SAlistair Francis 	if (size == 2 || size == 0)
7485b0c03e2SAlistair Francis 		return 0;
7495b0c03e2SAlistair Francis 
7505b0c03e2SAlistair Francis 	return -EINVAL;
7515b0c03e2SAlistair Francis }
7525b0c03e2SAlistair Francis 
cyttsp5_fill_all_touch(struct cyttsp5 * ts)7535b0c03e2SAlistair Francis static int cyttsp5_fill_all_touch(struct cyttsp5 *ts)
7545b0c03e2SAlistair Francis {
7555b0c03e2SAlistair Francis 	struct cyttsp5_sysinfo *si = &ts->sysinfo;
7565b0c03e2SAlistair Francis 
7575b0c03e2SAlistair Francis 	fill_tch_abs(&si->tch_abs[CY_TCH_X], REPORT_SIZE_16,
7585b0c03e2SAlistair Francis 		     TOUCH_REPORT_DESC_X);
7595b0c03e2SAlistair Francis 	fill_tch_abs(&si->tch_abs[CY_TCH_Y], REPORT_SIZE_16,
7605b0c03e2SAlistair Francis 		     TOUCH_REPORT_DESC_Y);
7615b0c03e2SAlistair Francis 	fill_tch_abs(&si->tch_abs[CY_TCH_P], REPORT_SIZE_8,
7625b0c03e2SAlistair Francis 		     TOUCH_REPORT_DESC_P);
7635b0c03e2SAlistair Francis 	fill_tch_abs(&si->tch_abs[CY_TCH_T], REPORT_SIZE_5,
7645b0c03e2SAlistair Francis 		     TOUCH_REPORT_DESC_CONTACTID);
7655b0c03e2SAlistair Francis 	fill_tch_abs(&si->tch_hdr, REPORT_SIZE_5,
7665b0c03e2SAlistair Francis 		     TOUCH_REPORT_DESC_HDR_CONTACTCOUNT);
7675b0c03e2SAlistair Francis 	fill_tch_abs(&si->tch_abs[CY_TCH_MAJ], REPORT_SIZE_8,
7685b0c03e2SAlistair Francis 		     TOUCH_REPORT_DESC_MAJ);
7695b0c03e2SAlistair Francis 	fill_tch_abs(&si->tch_abs[CY_TCH_MIN], REPORT_SIZE_8,
7705b0c03e2SAlistair Francis 		     TOUCH_REPORT_DESC_MIN);
7715b0c03e2SAlistair Francis 
7725b0c03e2SAlistair Francis 	return 0;
7735b0c03e2SAlistair Francis }
7745b0c03e2SAlistair Francis 
cyttsp5_startup(struct cyttsp5 * ts)7755b0c03e2SAlistair Francis static int cyttsp5_startup(struct cyttsp5 *ts)
7765b0c03e2SAlistair Francis {
7775b0c03e2SAlistair Francis 	int error;
7785b0c03e2SAlistair Francis 
7795b0c03e2SAlistair Francis 	error = cyttsp5_deassert_int(ts);
7805b0c03e2SAlistair Francis 	if (error) {
7815b0c03e2SAlistair Francis 		dev_err(ts->dev, "Error on deassert int r=%d\n", error);
7825b0c03e2SAlistair Francis 		return -ENODEV;
7835b0c03e2SAlistair Francis 	}
7845b0c03e2SAlistair Francis 
7855b0c03e2SAlistair Francis 	/*
7865b0c03e2SAlistair Francis 	 * Launch the application as the device starts in bootloader mode
7875b0c03e2SAlistair Francis 	 * because of a power-on-reset
7885b0c03e2SAlistair Francis 	 */
7895b0c03e2SAlistair Francis 	error = cyttsp5_hid_output_bl_launch_app(ts);
7905b0c03e2SAlistair Francis 	if (error < 0) {
7915b0c03e2SAlistair Francis 		dev_err(ts->dev, "Error on launch app r=%d\n", error);
7925b0c03e2SAlistair Francis 		return error;
7935b0c03e2SAlistair Francis 	}
7945b0c03e2SAlistair Francis 
7955b0c03e2SAlistair Francis 	error = cyttsp5_get_hid_descriptor(ts, &ts->hid_desc);
7965b0c03e2SAlistair Francis 	if (error < 0) {
7975b0c03e2SAlistair Francis 		dev_err(ts->dev, "Error on getting HID descriptor r=%d\n", error);
7985b0c03e2SAlistair Francis 		return error;
7995b0c03e2SAlistair Francis 	}
8005b0c03e2SAlistair Francis 
8015b0c03e2SAlistair Francis 	error = cyttsp5_fill_all_touch(ts);
8025b0c03e2SAlistair Francis 	if (error < 0) {
8035b0c03e2SAlistair Francis 		dev_err(ts->dev, "Error on report descriptor r=%d\n", error);
8045b0c03e2SAlistair Francis 		return error;
8055b0c03e2SAlistair Francis 	}
8065b0c03e2SAlistair Francis 
8075b0c03e2SAlistair Francis 	error = cyttsp5_hid_output_get_sysinfo(ts);
8085b0c03e2SAlistair Francis 	if (error) {
8095b0c03e2SAlistair Francis 		dev_err(ts->dev, "Error on getting sysinfo r=%d\n", error);
8105b0c03e2SAlistair Francis 		return error;
8115b0c03e2SAlistair Francis 	}
8125b0c03e2SAlistair Francis 
8135b0c03e2SAlistair Francis 	return error;
8145b0c03e2SAlistair Francis }
8155b0c03e2SAlistair Francis 
cyttsp5_cleanup(void * data)8165b0c03e2SAlistair Francis static void cyttsp5_cleanup(void *data)
8175b0c03e2SAlistair Francis {
8185b0c03e2SAlistair Francis 	struct cyttsp5 *ts = data;
8195b0c03e2SAlistair Francis 
8205b0c03e2SAlistair Francis 	regulator_disable(ts->vdd);
8215b0c03e2SAlistair Francis }
8225b0c03e2SAlistair Francis 
cyttsp5_probe(struct device * dev,struct regmap * regmap,int irq,const char * name)8235b0c03e2SAlistair Francis static int cyttsp5_probe(struct device *dev, struct regmap *regmap, int irq,
8245b0c03e2SAlistair Francis 			 const char *name)
8255b0c03e2SAlistair Francis {
8265b0c03e2SAlistair Francis 	struct cyttsp5 *ts;
8275b0c03e2SAlistair Francis 	struct cyttsp5_sysinfo *si;
8285b0c03e2SAlistair Francis 	int error, i;
8295b0c03e2SAlistair Francis 
8305b0c03e2SAlistair Francis 	ts = devm_kzalloc(dev, sizeof(*ts), GFP_KERNEL);
8315b0c03e2SAlistair Francis 	if (!ts)
8325b0c03e2SAlistair Francis 		return -ENOMEM;
8335b0c03e2SAlistair Francis 
8345b0c03e2SAlistair Francis 	/* Initialize device info */
8355b0c03e2SAlistair Francis 	ts->regmap = regmap;
8365b0c03e2SAlistair Francis 	ts->dev = dev;
8375b0c03e2SAlistair Francis 	si = &ts->sysinfo;
8385b0c03e2SAlistair Francis 	dev_set_drvdata(dev, ts);
8395b0c03e2SAlistair Francis 
8405b0c03e2SAlistair Francis 	init_completion(&ts->cmd_done);
8415b0c03e2SAlistair Francis 
8425b0c03e2SAlistair Francis 	/* Power up the device */
8435b0c03e2SAlistair Francis 	ts->vdd = devm_regulator_get(dev, "vdd");
8445b0c03e2SAlistair Francis 	if (IS_ERR(ts->vdd)) {
8455b0c03e2SAlistair Francis 		error = PTR_ERR(ts->vdd);
8465b0c03e2SAlistair Francis 		return error;
8475b0c03e2SAlistair Francis 	}
8485b0c03e2SAlistair Francis 
8495b0c03e2SAlistair Francis 	error = devm_add_action_or_reset(dev, cyttsp5_cleanup, ts);
8505b0c03e2SAlistair Francis 	if (error)
8515b0c03e2SAlistair Francis 		return error;
8525b0c03e2SAlistair Francis 
8535b0c03e2SAlistair Francis 	error = regulator_enable(ts->vdd);
8545b0c03e2SAlistair Francis 	if (error)
8555b0c03e2SAlistair Francis 		return error;
8565b0c03e2SAlistair Francis 
8575b0c03e2SAlistair Francis 	ts->input = devm_input_allocate_device(dev);
8585b0c03e2SAlistair Francis 	if (!ts->input) {
8595b0c03e2SAlistair Francis 		dev_err(dev, "Error, failed to allocate input device\n");
8605b0c03e2SAlistair Francis 		return -ENODEV;
8615b0c03e2SAlistair Francis 	}
8625b0c03e2SAlistair Francis 
8635b0c03e2SAlistair Francis 	ts->input->name = "cyttsp5";
8645b0c03e2SAlistair Francis 	scnprintf(ts->phys, sizeof(ts->phys), "%s/input0", dev_name(dev));
8655b0c03e2SAlistair Francis 	ts->input->phys = ts->phys;
8665b0c03e2SAlistair Francis 	input_set_drvdata(ts->input, ts);
8675b0c03e2SAlistair Francis 
8685b0c03e2SAlistair Francis 	/* Reset the gpio to be in a reset state */
8695b0c03e2SAlistair Francis 	ts->reset_gpio = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_HIGH);
8705b0c03e2SAlistair Francis 	if (IS_ERR(ts->reset_gpio)) {
8715b0c03e2SAlistair Francis 		error = PTR_ERR(ts->reset_gpio);
8725b0c03e2SAlistair Francis 		dev_err(dev, "Failed to request reset gpio, error %d\n", error);
8735b0c03e2SAlistair Francis 		return error;
8745b0c03e2SAlistair Francis 	}
8755b0c03e2SAlistair Francis 	gpiod_set_value_cansleep(ts->reset_gpio, 0);
8765b0c03e2SAlistair Francis 
8775b0c03e2SAlistair Francis 	/* Need a delay to have device up */
8785b0c03e2SAlistair Francis 	msleep(20);
8795b0c03e2SAlistair Francis 
8805b0c03e2SAlistair Francis 	error = devm_request_threaded_irq(dev, irq, NULL, cyttsp5_handle_irq,
8815b0c03e2SAlistair Francis 					  IRQF_ONESHOT, name, ts);
8825b0c03e2SAlistair Francis 	if (error) {
8835b0c03e2SAlistair Francis 		dev_err(dev, "unable to request IRQ\n");
8845b0c03e2SAlistair Francis 		return error;
8855b0c03e2SAlistair Francis 	}
8865b0c03e2SAlistair Francis 
8875b0c03e2SAlistair Francis 	error = cyttsp5_startup(ts);
8885b0c03e2SAlistair Francis 	if (error) {
8895b0c03e2SAlistair Francis 		dev_err(ts->dev, "Fail initial startup r=%d\n", error);
8905b0c03e2SAlistair Francis 		return error;
8915b0c03e2SAlistair Francis 	}
8925b0c03e2SAlistair Francis 
8935b0c03e2SAlistair Francis 	error = cyttsp5_parse_dt_key_code(dev);
8945b0c03e2SAlistair Francis 	if (error < 0) {
8955b0c03e2SAlistair Francis 		dev_err(ts->dev, "Error while parsing dts %d\n", error);
8965b0c03e2SAlistair Francis 		return error;
8975b0c03e2SAlistair Francis 	}
8985b0c03e2SAlistair Francis 
8995b0c03e2SAlistair Francis 	touchscreen_parse_properties(ts->input, true, &ts->prop);
9005b0c03e2SAlistair Francis 
9015b0c03e2SAlistair Francis 	__set_bit(EV_KEY, ts->input->evbit);
9025b0c03e2SAlistair Francis 	for (i = 0; i < si->num_btns; i++)
9035b0c03e2SAlistair Francis 		__set_bit(si->key_code[i], ts->input->keybit);
9045b0c03e2SAlistair Francis 
9055b0c03e2SAlistair Francis 	return cyttsp5_setup_input_device(dev);
9065b0c03e2SAlistair Francis }
9075b0c03e2SAlistair Francis 
cyttsp5_i2c_probe(struct i2c_client * client)908eebf2bf1SUwe Kleine-König static int cyttsp5_i2c_probe(struct i2c_client *client)
9095b0c03e2SAlistair Francis {
9105b0c03e2SAlistair Francis 	struct regmap *regmap;
9115b0c03e2SAlistair Francis 	static const struct regmap_config config = {
9125b0c03e2SAlistair Francis 		.reg_bits = 8,
9135b0c03e2SAlistair Francis 		.val_bits = 8,
9145b0c03e2SAlistair Francis 	};
9155b0c03e2SAlistair Francis 
9165b0c03e2SAlistair Francis 	regmap = devm_regmap_init_i2c(client, &config);
9175b0c03e2SAlistair Francis 	if (IS_ERR(regmap)) {
9185b0c03e2SAlistair Francis 		dev_err(&client->dev, "regmap allocation failed: %ld\n",
9195b0c03e2SAlistair Francis 			PTR_ERR(regmap));
9205b0c03e2SAlistair Francis 		return PTR_ERR(regmap);
9215b0c03e2SAlistair Francis 	}
9225b0c03e2SAlistair Francis 
9235b0c03e2SAlistair Francis 	return cyttsp5_probe(&client->dev, regmap, client->irq, client->name);
9245b0c03e2SAlistair Francis }
9255b0c03e2SAlistair Francis 
9265b0c03e2SAlistair Francis static const struct of_device_id cyttsp5_of_match[] = {
9275b0c03e2SAlistair Francis 	{ .compatible = "cypress,tt21000", },
9285b0c03e2SAlistair Francis 	{ }
9295b0c03e2SAlistair Francis };
9305b0c03e2SAlistair Francis MODULE_DEVICE_TABLE(of, cyttsp5_of_match);
9315b0c03e2SAlistair Francis 
9325b0c03e2SAlistair Francis static const struct i2c_device_id cyttsp5_i2c_id[] = {
9335b0c03e2SAlistair Francis 	{ CYTTSP5_NAME, 0, },
9345b0c03e2SAlistair Francis 	{ }
9355b0c03e2SAlistair Francis };
9365b0c03e2SAlistair Francis MODULE_DEVICE_TABLE(i2c, cyttsp5_i2c_id);
9375b0c03e2SAlistair Francis 
cyttsp5_suspend(struct device * dev)9383c98b8dbSMaximilian Weigand static int __maybe_unused cyttsp5_suspend(struct device *dev)
9393c98b8dbSMaximilian Weigand {
9403c98b8dbSMaximilian Weigand 	struct cyttsp5 *ts = dev_get_drvdata(dev);
9413c98b8dbSMaximilian Weigand 
9423c98b8dbSMaximilian Weigand 	if (!device_may_wakeup(dev))
9433c98b8dbSMaximilian Weigand 		cyttsp5_power_control(ts, false);
9443c98b8dbSMaximilian Weigand 
9453c98b8dbSMaximilian Weigand 	return 0;
9463c98b8dbSMaximilian Weigand }
9473c98b8dbSMaximilian Weigand 
cyttsp5_resume(struct device * dev)9483c98b8dbSMaximilian Weigand static int __maybe_unused cyttsp5_resume(struct device *dev)
9493c98b8dbSMaximilian Weigand {
9503c98b8dbSMaximilian Weigand 	struct cyttsp5 *ts = dev_get_drvdata(dev);
9513c98b8dbSMaximilian Weigand 
9523c98b8dbSMaximilian Weigand 	if (!device_may_wakeup(dev))
9533c98b8dbSMaximilian Weigand 		cyttsp5_power_control(ts, true);
9543c98b8dbSMaximilian Weigand 
9553c98b8dbSMaximilian Weigand 	return 0;
9563c98b8dbSMaximilian Weigand }
9573c98b8dbSMaximilian Weigand 
9583c98b8dbSMaximilian Weigand static SIMPLE_DEV_PM_OPS(cyttsp5_pm, cyttsp5_suspend, cyttsp5_resume);
9593c98b8dbSMaximilian Weigand 
9605b0c03e2SAlistair Francis static struct i2c_driver cyttsp5_i2c_driver = {
9615b0c03e2SAlistair Francis 	.driver = {
9625b0c03e2SAlistair Francis 		.name = CYTTSP5_NAME,
9635b0c03e2SAlistair Francis 		.of_match_table = cyttsp5_of_match,
9643c98b8dbSMaximilian Weigand 		.pm = &cyttsp5_pm,
9655b0c03e2SAlistair Francis 	},
966d8bde56dSUwe Kleine-König 	.probe = cyttsp5_i2c_probe,
9675b0c03e2SAlistair Francis 	.id_table = cyttsp5_i2c_id,
9685b0c03e2SAlistair Francis };
9695b0c03e2SAlistair Francis module_i2c_driver(cyttsp5_i2c_driver);
9705b0c03e2SAlistair Francis 
9715b0c03e2SAlistair Francis MODULE_LICENSE("GPL");
9725b0c03e2SAlistair Francis MODULE_DESCRIPTION("Touchscreen driver for Cypress TrueTouch Gen 5 Product");
9735b0c03e2SAlistair Francis MODULE_AUTHOR("Mylène Josserand <mylene.josserand@bootlin.com>");
974