Linux Audio

Check our new training course

Loading...
Note: File does not exist in v3.1.
   1// SPDX-License-Identifier: GPL-2.0-only
   2#include <linux/crc-ccitt.h>
   3#include <linux/delay.h>
   4#include <linux/gpio/consumer.h>
   5#include <linux/i2c.h>
   6#include <linux/ihex.h>
   7#include <linux/input.h>
   8#include <linux/input/mt.h>
   9#include <linux/input/touchscreen.h>
  10#include <linux/interrupt.h>
  11#include <linux/mod_devicetable.h>
  12#include <linux/module.h>
  13#include <linux/sizes.h>
  14#include <linux/slab.h>
  15#include <linux/unaligned.h>
  16
  17#define ILI2XXX_POLL_PERIOD	15
  18
  19#define ILI210X_DATA_SIZE	64
  20#define ILI211X_DATA_SIZE	43
  21#define ILI251X_DATA_SIZE1	31
  22#define ILI251X_DATA_SIZE2	20
  23
  24/* Touchscreen commands */
  25#define REG_TOUCHDATA		0x10
  26#define REG_PANEL_INFO		0x20
  27#define REG_FIRMWARE_VERSION	0x40
  28#define REG_PROTOCOL_VERSION	0x42
  29#define REG_KERNEL_VERSION	0x61
  30#define REG_IC_BUSY		0x80
  31#define REG_IC_BUSY_NOT_BUSY	0x50
  32#define REG_GET_MODE		0xc0
  33#define REG_GET_MODE_AP		0x5a
  34#define REG_GET_MODE_BL		0x55
  35#define REG_SET_MODE_AP		0xc1
  36#define REG_SET_MODE_BL		0xc2
  37#define REG_WRITE_DATA		0xc3
  38#define REG_WRITE_ENABLE	0xc4
  39#define REG_READ_DATA_CRC	0xc7
  40#define REG_CALIBRATE		0xcc
  41
  42#define ILI251X_FW_FILENAME	"ilitek/ili251x.bin"
  43
  44struct ili2xxx_chip {
  45	int (*read_reg)(struct i2c_client *client, u8 reg,
  46			void *buf, size_t len);
  47	int (*get_touch_data)(struct i2c_client *client, u8 *data);
  48	bool (*parse_touch_data)(const u8 *data, unsigned int finger,
  49				 unsigned int *x, unsigned int *y,
  50				 unsigned int *z);
  51	bool (*continue_polling)(const u8 *data, bool touch);
  52	unsigned int max_touches;
  53	unsigned int resolution;
  54	bool has_calibrate_reg;
  55	bool has_firmware_proto;
  56	bool has_pressure_reg;
  57};
  58
  59struct ili210x {
  60	struct i2c_client *client;
  61	struct input_dev *input;
  62	struct gpio_desc *reset_gpio;
  63	struct touchscreen_properties prop;
  64	const struct ili2xxx_chip *chip;
  65	u8 version_firmware[8];
  66	u8 version_kernel[5];
  67	u8 version_proto[2];
  68	u8 ic_mode[2];
  69	bool stop;
  70};
  71
  72static int ili210x_read_reg(struct i2c_client *client,
  73			    u8 reg, void *buf, size_t len)
  74{
  75	struct i2c_msg msg[] = {
  76		{
  77			.addr	= client->addr,
  78			.flags	= 0,
  79			.len	= 1,
  80			.buf	= &reg,
  81		},
  82		{
  83			.addr	= client->addr,
  84			.flags	= I2C_M_RD,
  85			.len	= len,
  86			.buf	= buf,
  87		}
  88	};
  89	int error, ret;
  90
  91	ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
  92	if (ret != ARRAY_SIZE(msg)) {
  93		error = ret < 0 ? ret : -EIO;
  94		dev_err(&client->dev, "%s failed: %d\n", __func__, error);
  95		return error;
  96	}
  97
  98	return 0;
  99}
 100
 101static int ili210x_read_touch_data(struct i2c_client *client, u8 *data)
 102{
 103	return ili210x_read_reg(client, REG_TOUCHDATA,
 104				data, ILI210X_DATA_SIZE);
 105}
 106
 107static bool ili210x_touchdata_to_coords(const u8 *touchdata,
 108					unsigned int finger,
 109					unsigned int *x, unsigned int *y,
 110					unsigned int *z)
 111{
 112	if (!(touchdata[0] & BIT(finger)))
 113		return false;
 114
 115	*x = get_unaligned_be16(touchdata + 1 + (finger * 4) + 0);
 116	*y = get_unaligned_be16(touchdata + 1 + (finger * 4) + 2);
 117
 118	return true;
 119}
 120
 121static bool ili210x_check_continue_polling(const u8 *data, bool touch)
 122{
 123	return data[0] & 0xf3;
 124}
 125
 126static const struct ili2xxx_chip ili210x_chip = {
 127	.read_reg		= ili210x_read_reg,
 128	.get_touch_data		= ili210x_read_touch_data,
 129	.parse_touch_data	= ili210x_touchdata_to_coords,
 130	.continue_polling	= ili210x_check_continue_polling,
 131	.max_touches		= 2,
 132	.has_calibrate_reg	= true,
 133};
 134
 135static int ili211x_read_touch_data(struct i2c_client *client, u8 *data)
 136{
 137	s16 sum = 0;
 138	int error;
 139	int ret;
 140	int i;
 141
 142	ret = i2c_master_recv(client, data, ILI211X_DATA_SIZE);
 143	if (ret != ILI211X_DATA_SIZE) {
 144		error = ret < 0 ? ret : -EIO;
 145		dev_err(&client->dev, "%s failed: %d\n", __func__, error);
 146		return error;
 147	}
 148
 149	/* This chip uses custom checksum at the end of data */
 150	for (i = 0; i < ILI211X_DATA_SIZE - 1; i++)
 151		sum = (sum + data[i]) & 0xff;
 152
 153	if ((-sum & 0xff) != data[ILI211X_DATA_SIZE - 1]) {
 154		dev_err(&client->dev,
 155			"CRC error (crc=0x%02x expected=0x%02x)\n",
 156			sum, data[ILI211X_DATA_SIZE - 1]);
 157		return -EIO;
 158	}
 159
 160	return 0;
 161}
 162
 163static bool ili211x_touchdata_to_coords(const u8 *touchdata,
 164					unsigned int finger,
 165					unsigned int *x, unsigned int *y,
 166					unsigned int *z)
 167{
 168	u32 data;
 169
 170	data = get_unaligned_be32(touchdata + 1 + (finger * 4) + 0);
 171	if (data == 0xffffffff)	/* Finger up */
 172		return false;
 173
 174	*x = ((touchdata[1 + (finger * 4) + 0] & 0xf0) << 4) |
 175	     touchdata[1 + (finger * 4) + 1];
 176	*y = ((touchdata[1 + (finger * 4) + 0] & 0x0f) << 8) |
 177	     touchdata[1 + (finger * 4) + 2];
 178
 179	return true;
 180}
 181
 182static bool ili211x_decline_polling(const u8 *data, bool touch)
 183{
 184	return false;
 185}
 186
 187static const struct ili2xxx_chip ili211x_chip = {
 188	.read_reg		= ili210x_read_reg,
 189	.get_touch_data		= ili211x_read_touch_data,
 190	.parse_touch_data	= ili211x_touchdata_to_coords,
 191	.continue_polling	= ili211x_decline_polling,
 192	.max_touches		= 10,
 193	.resolution		= 2048,
 194};
 195
 196static bool ili212x_touchdata_to_coords(const u8 *touchdata,
 197					unsigned int finger,
 198					unsigned int *x, unsigned int *y,
 199					unsigned int *z)
 200{
 201	u16 val;
 202
 203	val = get_unaligned_be16(touchdata + 3 + (finger * 5) + 0);
 204	if (!(val & BIT(15)))	/* Touch indication */
 205		return false;
 206
 207	*x = val & 0x3fff;
 208	*y = get_unaligned_be16(touchdata + 3 + (finger * 5) + 2);
 209
 210	return true;
 211}
 212
 213static bool ili212x_check_continue_polling(const u8 *data, bool touch)
 214{
 215	return touch;
 216}
 217
 218static const struct ili2xxx_chip ili212x_chip = {
 219	.read_reg		= ili210x_read_reg,
 220	.get_touch_data		= ili210x_read_touch_data,
 221	.parse_touch_data	= ili212x_touchdata_to_coords,
 222	.continue_polling	= ili212x_check_continue_polling,
 223	.max_touches		= 10,
 224	.has_calibrate_reg	= true,
 225};
 226
 227static int ili251x_read_reg_common(struct i2c_client *client,
 228				   u8 reg, void *buf, size_t len,
 229				   unsigned int delay)
 230{
 231	int error;
 232	int ret;
 233
 234	ret = i2c_master_send(client, &reg, 1);
 235	if (ret == 1) {
 236		if (delay)
 237			usleep_range(delay, delay + 500);
 238
 239		ret = i2c_master_recv(client, buf, len);
 240		if (ret == len)
 241			return 0;
 242	}
 243
 244	error = ret < 0 ? ret : -EIO;
 245	dev_err(&client->dev, "%s failed: %d\n", __func__, error);
 246	return ret;
 247}
 248
 249static int ili251x_read_reg(struct i2c_client *client,
 250			    u8 reg, void *buf, size_t len)
 251{
 252	return ili251x_read_reg_common(client, reg, buf, len, 5000);
 253}
 254
 255static int ili251x_read_touch_data(struct i2c_client *client, u8 *data)
 256{
 257	int error;
 258
 259	error = ili251x_read_reg_common(client, REG_TOUCHDATA,
 260					data, ILI251X_DATA_SIZE1, 0);
 261	if (!error && data[0] == 2) {
 262		error = i2c_master_recv(client, data + ILI251X_DATA_SIZE1,
 263					ILI251X_DATA_SIZE2);
 264		if (error >= 0)
 265			error = error == ILI251X_DATA_SIZE2 ? 0 : -EIO;
 266	}
 267
 268	return error;
 269}
 270
 271static bool ili251x_touchdata_to_coords(const u8 *touchdata,
 272					unsigned int finger,
 273					unsigned int *x, unsigned int *y,
 274					unsigned int *z)
 275{
 276	u16 val;
 277
 278	val = get_unaligned_be16(touchdata + 1 + (finger * 5) + 0);
 279	if (!(val & BIT(15)))	/* Touch indication */
 280		return false;
 281
 282	*x = val & 0x3fff;
 283	*y = get_unaligned_be16(touchdata + 1 + (finger * 5) + 2);
 284	*z = touchdata[1 + (finger * 5) + 4];
 285
 286	return true;
 287}
 288
 289static bool ili251x_check_continue_polling(const u8 *data, bool touch)
 290{
 291	return touch;
 292}
 293
 294static const struct ili2xxx_chip ili251x_chip = {
 295	.read_reg		= ili251x_read_reg,
 296	.get_touch_data		= ili251x_read_touch_data,
 297	.parse_touch_data	= ili251x_touchdata_to_coords,
 298	.continue_polling	= ili251x_check_continue_polling,
 299	.max_touches		= 10,
 300	.has_calibrate_reg	= true,
 301	.has_firmware_proto	= true,
 302	.has_pressure_reg	= true,
 303};
 304
 305static bool ili210x_report_events(struct ili210x *priv, u8 *touchdata)
 306{
 307	struct input_dev *input = priv->input;
 308	int i;
 309	bool contact = false, touch;
 310	unsigned int x = 0, y = 0, z = 0;
 311
 312	for (i = 0; i < priv->chip->max_touches; i++) {
 313		touch = priv->chip->parse_touch_data(touchdata, i, &x, &y, &z);
 314
 315		input_mt_slot(input, i);
 316		if (input_mt_report_slot_state(input, MT_TOOL_FINGER, touch)) {
 317			touchscreen_report_pos(input, &priv->prop, x, y, true);
 318			if (priv->chip->has_pressure_reg)
 319				input_report_abs(input, ABS_MT_PRESSURE, z);
 320			contact = true;
 321		}
 322	}
 323
 324	input_mt_report_pointer_emulation(input, false);
 325	input_sync(input);
 326
 327	return contact;
 328}
 329
 330static irqreturn_t ili210x_irq(int irq, void *irq_data)
 331{
 332	struct ili210x *priv = irq_data;
 333	struct i2c_client *client = priv->client;
 334	const struct ili2xxx_chip *chip = priv->chip;
 335	u8 touchdata[ILI210X_DATA_SIZE] = { 0 };
 336	bool keep_polling;
 337	ktime_t time_next;
 338	s64 time_delta;
 339	bool touch;
 340	int error;
 341
 342	do {
 343		time_next = ktime_add_ms(ktime_get(), ILI2XXX_POLL_PERIOD);
 344		error = chip->get_touch_data(client, touchdata);
 345		if (error) {
 346			dev_err(&client->dev,
 347				"Unable to get touch data: %d\n", error);
 348			break;
 349		}
 350
 351		touch = ili210x_report_events(priv, touchdata);
 352		keep_polling = chip->continue_polling(touchdata, touch);
 353		if (keep_polling) {
 354			time_delta = ktime_us_delta(time_next, ktime_get());
 355			if (time_delta > 0)
 356				usleep_range(time_delta, time_delta + 1000);
 357		}
 358	} while (!priv->stop && keep_polling);
 359
 360	return IRQ_HANDLED;
 361}
 362
 363static int ili251x_firmware_update_resolution(struct device *dev)
 364{
 365	struct i2c_client *client = to_i2c_client(dev);
 366	struct ili210x *priv = i2c_get_clientdata(client);
 367	u16 resx, resy;
 368	u8 rs[10];
 369	int error;
 370
 371	/* The firmware update blob might have changed the resolution. */
 372	error = priv->chip->read_reg(client, REG_PANEL_INFO, &rs, sizeof(rs));
 373	if (!error) {
 374		resx = le16_to_cpup((__le16 *)rs);
 375		resy = le16_to_cpup((__le16 *)(rs + 2));
 376
 377		/* The value reported by the firmware is invalid. */
 378		if (!resx || resx == 0xffff || !resy || resy == 0xffff)
 379			error = -EINVAL;
 380	}
 381
 382	/*
 383	 * In case of error, the firmware might be stuck in bootloader mode,
 384	 * e.g. after a failed firmware update. Set maximum resolution, but
 385	 * do not fail to probe, so the user can re-trigger the firmware
 386	 * update and recover the touch controller.
 387	 */
 388	if (error) {
 389		dev_warn(dev, "Invalid resolution reported by controller.\n");
 390		resx = 16384;
 391		resy = 16384;
 392	}
 393
 394	input_abs_set_max(priv->input, ABS_X, resx - 1);
 395	input_abs_set_max(priv->input, ABS_Y, resy - 1);
 396	input_abs_set_max(priv->input, ABS_MT_POSITION_X, resx - 1);
 397	input_abs_set_max(priv->input, ABS_MT_POSITION_Y, resy - 1);
 398
 399	return error;
 400}
 401
 402static ssize_t ili251x_firmware_update_firmware_version(struct device *dev)
 403{
 404	struct i2c_client *client = to_i2c_client(dev);
 405	struct ili210x *priv = i2c_get_clientdata(client);
 406	int error;
 407	u8 fw[8];
 408
 409	/* Get firmware version */
 410	error = priv->chip->read_reg(client, REG_FIRMWARE_VERSION,
 411				     &fw, sizeof(fw));
 412	if (!error)
 413		memcpy(priv->version_firmware, fw, sizeof(fw));
 414
 415	return error;
 416}
 417
 418static ssize_t ili251x_firmware_update_kernel_version(struct device *dev)
 419{
 420	struct i2c_client *client = to_i2c_client(dev);
 421	struct ili210x *priv = i2c_get_clientdata(client);
 422	int error;
 423	u8 kv[5];
 424
 425	/* Get kernel version */
 426	error = priv->chip->read_reg(client, REG_KERNEL_VERSION,
 427				     &kv, sizeof(kv));
 428	if (!error)
 429		memcpy(priv->version_kernel, kv, sizeof(kv));
 430
 431	return error;
 432}
 433
 434static ssize_t ili251x_firmware_update_protocol_version(struct device *dev)
 435{
 436	struct i2c_client *client = to_i2c_client(dev);
 437	struct ili210x *priv = i2c_get_clientdata(client);
 438	int error;
 439	u8 pv[2];
 440
 441	/* Get protocol version */
 442	error = priv->chip->read_reg(client, REG_PROTOCOL_VERSION,
 443				     &pv, sizeof(pv));
 444	if (!error)
 445		memcpy(priv->version_proto, pv, sizeof(pv));
 446
 447	return error;
 448}
 449
 450static ssize_t ili251x_firmware_update_ic_mode(struct device *dev)
 451{
 452	struct i2c_client *client = to_i2c_client(dev);
 453	struct ili210x *priv = i2c_get_clientdata(client);
 454	int error;
 455	u8 md[2];
 456
 457	/* Get chip boot mode */
 458	error = priv->chip->read_reg(client, REG_GET_MODE, &md, sizeof(md));
 459	if (!error)
 460		memcpy(priv->ic_mode, md, sizeof(md));
 461
 462	return error;
 463}
 464
 465static int ili251x_firmware_update_cached_state(struct device *dev)
 466{
 467	struct i2c_client *client = to_i2c_client(dev);
 468	struct ili210x *priv = i2c_get_clientdata(client);
 469	int error;
 470
 471	if (!priv->chip->has_firmware_proto)
 472		return 0;
 473
 474	/* Wait for firmware to boot and stabilize itself. */
 475	msleep(200);
 476
 477	/* Firmware does report valid information. */
 478	error = ili251x_firmware_update_resolution(dev);
 479	if (error)
 480		return error;
 481
 482	error = ili251x_firmware_update_firmware_version(dev);
 483	if (error)
 484		return error;
 485
 486	error = ili251x_firmware_update_kernel_version(dev);
 487	if (error)
 488		return error;
 489
 490	error = ili251x_firmware_update_protocol_version(dev);
 491	if (error)
 492		return error;
 493
 494	error = ili251x_firmware_update_ic_mode(dev);
 495	if (error)
 496		return error;
 497
 498	return 0;
 499}
 500
 501static ssize_t ili251x_firmware_version_show(struct device *dev,
 502					     struct device_attribute *attr,
 503					     char *buf)
 504{
 505	struct i2c_client *client = to_i2c_client(dev);
 506	struct ili210x *priv = i2c_get_clientdata(client);
 507	u8 *fw = priv->version_firmware;
 508
 509	return sysfs_emit(buf, "%02x%02x.%02x%02x.%02x%02x.%02x%02x\n",
 510			  fw[0], fw[1], fw[2], fw[3],
 511			  fw[4], fw[5], fw[6], fw[7]);
 512}
 513static DEVICE_ATTR(firmware_version, 0444, ili251x_firmware_version_show, NULL);
 514
 515static ssize_t ili251x_kernel_version_show(struct device *dev,
 516					   struct device_attribute *attr,
 517					   char *buf)
 518{
 519	struct i2c_client *client = to_i2c_client(dev);
 520	struct ili210x *priv = i2c_get_clientdata(client);
 521	u8 *kv = priv->version_kernel;
 522
 523	return sysfs_emit(buf, "%02x.%02x.%02x.%02x.%02x\n",
 524			  kv[0], kv[1], kv[2], kv[3], kv[4]);
 525}
 526static DEVICE_ATTR(kernel_version, 0444, ili251x_kernel_version_show, NULL);
 527
 528static ssize_t ili251x_protocol_version_show(struct device *dev,
 529					     struct device_attribute *attr,
 530					     char *buf)
 531{
 532	struct i2c_client *client = to_i2c_client(dev);
 533	struct ili210x *priv = i2c_get_clientdata(client);
 534	u8 *pv = priv->version_proto;
 535
 536	return sysfs_emit(buf, "%02x.%02x\n", pv[0], pv[1]);
 537}
 538static DEVICE_ATTR(protocol_version, 0444, ili251x_protocol_version_show, NULL);
 539
 540static ssize_t ili251x_mode_show(struct device *dev,
 541				 struct device_attribute *attr, char *buf)
 542{
 543	struct i2c_client *client = to_i2c_client(dev);
 544	struct ili210x *priv = i2c_get_clientdata(client);
 545	u8 *md = priv->ic_mode;
 546	char *mode = "AP";
 547
 548	if (md[0] == REG_GET_MODE_AP)		/* Application Mode */
 549		mode = "AP";
 550	else if (md[0] == REG_GET_MODE_BL)	/* BootLoader Mode */
 551		mode = "BL";
 552	else					/* Unknown Mode */
 553		mode = "??";
 554
 555	return sysfs_emit(buf, "%02x.%02x:%s\n", md[0], md[1], mode);
 556}
 557static DEVICE_ATTR(mode, 0444, ili251x_mode_show, NULL);
 558
 559static ssize_t ili210x_calibrate(struct device *dev,
 560				 struct device_attribute *attr,
 561				 const char *buf, size_t count)
 562{
 563	struct i2c_client *client = to_i2c_client(dev);
 564	struct ili210x *priv = i2c_get_clientdata(client);
 565	unsigned long calibrate;
 566	int rc;
 567	u8 cmd = REG_CALIBRATE;
 568
 569	if (kstrtoul(buf, 10, &calibrate))
 570		return -EINVAL;
 571
 572	if (calibrate > 1)
 573		return -EINVAL;
 574
 575	if (calibrate) {
 576		rc = i2c_master_send(priv->client, &cmd, sizeof(cmd));
 577		if (rc != sizeof(cmd))
 578			return -EIO;
 579	}
 580
 581	return count;
 582}
 583static DEVICE_ATTR(calibrate, S_IWUSR, NULL, ili210x_calibrate);
 584
 585static const u8 *ili251x_firmware_to_buffer(const struct firmware *fw,
 586					    u16 *ac_end, u16 *df_end)
 587{
 588	const struct ihex_binrec *rec;
 589	u32 fw_addr, fw_last_addr = 0;
 590	u16 fw_len;
 591
 592	/*
 593	 * The firmware ihex blob can never be bigger than 64 kiB, so make this
 594	 * simple -- allocate a 64 kiB buffer, iterate over the ihex blob records
 595	 * once, copy them all into this buffer at the right locations, and then
 596	 * do all operations on this linear buffer.
 597	 */
 598	u8* fw_buf __free(kvfree) = kvmalloc(SZ_64K, GFP_KERNEL);
 599	if (!fw_buf)
 600		return ERR_PTR(-ENOMEM);
 601
 602	rec = (const struct ihex_binrec *)fw->data;
 603	while (rec) {
 604		fw_addr = be32_to_cpu(rec->addr);
 605		fw_len = be16_to_cpu(rec->len);
 606
 607		/* The last 32 Byte firmware block can be 0xffe0 */
 608		if (fw_addr + fw_len > SZ_64K || fw_addr > SZ_64K - 32)
 609			return ERR_PTR(-EFBIG);
 610
 611		/* Find the last address before DF start address, that is AC end */
 612		if (fw_addr == 0xf000)
 613			*ac_end = fw_last_addr;
 614		fw_last_addr = fw_addr + fw_len;
 615
 616		memcpy(fw_buf + fw_addr, rec->data, fw_len);
 617		rec = ihex_next_binrec(rec);
 618	}
 619
 620	/* DF end address is the last address in the firmware blob */
 621	*df_end = fw_addr + fw_len;
 622
 623	return_ptr(fw_buf);
 624}
 625
 626/* Switch mode between Application and BootLoader */
 627static int ili251x_switch_ic_mode(struct i2c_client *client, u8 cmd_mode)
 628{
 629	struct ili210x *priv = i2c_get_clientdata(client);
 630	u8 cmd_wren[3] = { REG_WRITE_ENABLE, 0x5a, 0xa5 };
 631	u8 md[2];
 632	int error;
 633
 634	error = priv->chip->read_reg(client, REG_GET_MODE, md, sizeof(md));
 635	if (error)
 636		return error;
 637	/* Mode already set */
 638	if ((cmd_mode == REG_SET_MODE_AP && md[0] == REG_GET_MODE_AP) ||
 639	    (cmd_mode == REG_SET_MODE_BL && md[0] == REG_GET_MODE_BL))
 640		return 0;
 641
 642	/* Unlock writes */
 643	error = i2c_master_send(client, cmd_wren, sizeof(cmd_wren));
 644	if (error != sizeof(cmd_wren))
 645		return -EINVAL;
 646
 647	mdelay(20);
 648
 649	/* Select mode (BootLoader or Application) */
 650	error = i2c_master_send(client, &cmd_mode, 1);
 651	if (error != 1)
 652		return -EINVAL;
 653
 654	mdelay(200);	/* Reboot into bootloader takes a lot of time ... */
 655
 656	/* Read back mode */
 657	error = priv->chip->read_reg(client, REG_GET_MODE, md, sizeof(md));
 658	if (error)
 659		return error;
 660	/* Check if mode is correct now. */
 661	if ((cmd_mode == REG_SET_MODE_AP && md[0] == REG_GET_MODE_AP) ||
 662	    (cmd_mode == REG_SET_MODE_BL && md[0] == REG_GET_MODE_BL))
 663		return 0;
 664
 665	return -EINVAL;
 666}
 667
 668static int ili251x_firmware_busy(struct i2c_client *client)
 669{
 670	struct ili210x *priv = i2c_get_clientdata(client);
 671	int error, i = 0;
 672	u8 data;
 673
 674	do {
 675		/* The read_reg already contains suitable delay */
 676		error = priv->chip->read_reg(client, REG_IC_BUSY, &data, 1);
 677		if (error)
 678			return error;
 679		if (i++ == 100000)
 680			return -ETIMEDOUT;
 681	} while (data != REG_IC_BUSY_NOT_BUSY);
 682
 683	return 0;
 684}
 685
 686static int ili251x_firmware_write_to_ic(struct device *dev, const u8 *fwbuf,
 687					u16 start, u16 end, u8 dataflash)
 688{
 689	struct i2c_client *client = to_i2c_client(dev);
 690	struct ili210x *priv = i2c_get_clientdata(client);
 691	u8 cmd_crc = REG_READ_DATA_CRC;
 692	u8 crcrb[4] = { 0 };
 693	u8 fw_data[33];
 694	u16 fw_addr;
 695	int error;
 696
 697	/*
 698	 * The DF (dataflash) needs 2 bytes offset for unknown reasons,
 699	 * the AC (application) has 2 bytes CRC16-CCITT at the end.
 700	 */
 701	u16 crc = crc_ccitt(0, fwbuf + start + (dataflash ? 2 : 0),
 702			    end - start - 2);
 703
 704	/* Unlock write to either AC (application) or DF (dataflash) area */
 705	u8 cmd_wr[10] = {
 706		REG_WRITE_ENABLE, 0x5a, 0xa5, dataflash,
 707		(end >> 16) & 0xff, (end >> 8) & 0xff, end & 0xff,
 708		(crc >> 16) & 0xff, (crc >> 8) & 0xff, crc & 0xff
 709	};
 710
 711	error = i2c_master_send(client, cmd_wr, sizeof(cmd_wr));
 712	if (error != sizeof(cmd_wr))
 713		return -EINVAL;
 714
 715	error = ili251x_firmware_busy(client);
 716	if (error)
 717		return error;
 718
 719	for (fw_addr = start; fw_addr < end; fw_addr += 32) {
 720		fw_data[0] = REG_WRITE_DATA;
 721		memcpy(&(fw_data[1]), fwbuf + fw_addr, 32);
 722		error = i2c_master_send(client, fw_data, 33);
 723		if (error != sizeof(fw_data))
 724			return error;
 725		error = ili251x_firmware_busy(client);
 726		if (error)
 727			return error;
 728	}
 729
 730	error = i2c_master_send(client, &cmd_crc, 1);
 731	if (error != 1)
 732		return -EINVAL;
 733
 734	error = ili251x_firmware_busy(client);
 735	if (error)
 736		return error;
 737
 738	error = priv->chip->read_reg(client, REG_READ_DATA_CRC,
 739				   &crcrb, sizeof(crcrb));
 740	if (error)
 741		return error;
 742
 743	/* Check CRC readback */
 744	if ((crcrb[0] != (crc & 0xff)) || crcrb[1] != ((crc >> 8) & 0xff))
 745		return -EINVAL;
 746
 747	return 0;
 748}
 749
 750static int ili251x_firmware_reset(struct i2c_client *client)
 751{
 752	u8 cmd_reset[2] = { 0xf2, 0x01 };
 753	int error;
 754
 755	error = i2c_master_send(client, cmd_reset, sizeof(cmd_reset));
 756	if (error != sizeof(cmd_reset))
 757		return -EINVAL;
 758
 759	return ili251x_firmware_busy(client);
 760}
 761
 762static void ili210x_hardware_reset(struct gpio_desc *reset_gpio)
 763{
 764	/* Reset the controller */
 765	gpiod_set_value_cansleep(reset_gpio, 1);
 766	usleep_range(12000, 15000);
 767	gpiod_set_value_cansleep(reset_gpio, 0);
 768	msleep(300);
 769}
 770
 771static int ili210x_do_firmware_update(struct ili210x *priv,
 772				      const u8 *fwbuf, u16 ac_end, u16 df_end)
 773{
 774	struct i2c_client *client = priv->client;
 775	struct device *dev = &client->dev;
 776	int error;
 777	int i;
 778
 779	error = ili251x_firmware_reset(client);
 780	if (error)
 781		return error;
 782
 783	/* This may not succeed on first try, so re-try a few times. */
 784	for (i = 0; i < 5; i++) {
 785		error = ili251x_switch_ic_mode(client, REG_SET_MODE_BL);
 786		if (!error)
 787			break;
 788	}
 789
 790	if (error)
 791		return error;
 792
 793	dev_dbg(dev, "IC is now in BootLoader mode\n");
 794
 795	msleep(200);	/* The bootloader seems to need some time too. */
 796
 797	error = ili251x_firmware_write_to_ic(dev, fwbuf, 0xf000, df_end, 1);
 798	if (error) {
 799		dev_err(dev, "DF firmware update failed, error=%d\n", error);
 800		return error;
 801	}
 802
 803	dev_dbg(dev, "DataFlash firmware written\n");
 804
 805	error = ili251x_firmware_write_to_ic(dev, fwbuf, 0x2000, ac_end, 0);
 806	if (error) {
 807		dev_err(dev, "AC firmware update failed, error=%d\n", error);
 808		return error;
 809	}
 810
 811	dev_dbg(dev, "Application firmware written\n");
 812
 813	/* This may not succeed on first try, so re-try a few times. */
 814	for (i = 0; i < 5; i++) {
 815		error = ili251x_switch_ic_mode(client, REG_SET_MODE_AP);
 816		if (!error)
 817			break;
 818	}
 819
 820	if (error)
 821		return error;
 822
 823	dev_dbg(dev, "IC is now in Application mode\n");
 824
 825	error = ili251x_firmware_update_cached_state(dev);
 826	if (error)
 827		return error;
 828
 829	return 0;
 830}
 831
 832static ssize_t ili210x_firmware_update_store(struct device *dev,
 833					     struct device_attribute *attr,
 834					     const char *buf, size_t count)
 835{
 836	struct i2c_client *client = to_i2c_client(dev);
 837	struct ili210x *priv = i2c_get_clientdata(client);
 838	const char *fwname = ILI251X_FW_FILENAME;
 839	u16 ac_end, df_end;
 840	int error;
 841
 842	const struct firmware *fw __free(firmware) = NULL;
 843	error = request_ihex_firmware(&fw, fwname, dev);
 844	if (error) {
 845		dev_err(dev, "Failed to request firmware %s, error=%d\n",
 846			fwname, error);
 847		return error;
 848	}
 849
 850	const u8* fwbuf __free(kvfree) =
 851			ili251x_firmware_to_buffer(fw, &ac_end, &df_end);
 852	error = PTR_ERR_OR_ZERO(fwbuf);
 853	if (error)
 854		return error;
 855
 856	/*
 857	 * Disable touchscreen IRQ, so that we would not get spurious touch
 858	 * interrupt during firmware update, and so that the IRQ handler won't
 859	 * trigger and interfere with the firmware update. There is no bit in
 860	 * the touch controller to disable the IRQs during update, so we have
 861	 * to do it this way here.
 862	 */
 863	scoped_guard(disable_irq, &client->irq) {
 864		dev_dbg(dev, "Firmware update started, firmware=%s\n", fwname);
 865
 866		ili210x_hardware_reset(priv->reset_gpio);
 867
 868		error = ili210x_do_firmware_update(priv, fwbuf, ac_end, df_end);
 869
 870		ili210x_hardware_reset(priv->reset_gpio);
 871
 872		dev_dbg(dev, "Firmware update ended, error=%i\n", error);
 873	}
 874
 875	return error ?: count;
 876}
 877
 878static DEVICE_ATTR(firmware_update, 0200, NULL, ili210x_firmware_update_store);
 879
 880static struct attribute *ili210x_attrs[] = {
 881	&dev_attr_calibrate.attr,
 882	&dev_attr_firmware_update.attr,
 883	&dev_attr_firmware_version.attr,
 884	&dev_attr_kernel_version.attr,
 885	&dev_attr_protocol_version.attr,
 886	&dev_attr_mode.attr,
 887	NULL,
 888};
 889
 890static umode_t ili210x_attributes_visible(struct kobject *kobj,
 891					  struct attribute *attr, int index)
 892{
 893	struct device *dev = kobj_to_dev(kobj);
 894	struct i2c_client *client = to_i2c_client(dev);
 895	struct ili210x *priv = i2c_get_clientdata(client);
 896
 897	/* Calibrate is present on all ILI2xxx which have calibrate register */
 898	if (attr == &dev_attr_calibrate.attr)
 899		return priv->chip->has_calibrate_reg ? attr->mode : 0;
 900
 901	/* Firmware/Kernel/Protocol/BootMode is implemented only for ILI251x */
 902	if (!priv->chip->has_firmware_proto)
 903		return 0;
 904
 905	return attr->mode;
 906}
 907
 908static const struct attribute_group ili210x_group = {
 909	.attrs = ili210x_attrs,
 910	.is_visible = ili210x_attributes_visible,
 911};
 912__ATTRIBUTE_GROUPS(ili210x);
 913
 914static void ili210x_power_down(void *data)
 915{
 916	struct gpio_desc *reset_gpio = data;
 917
 918	gpiod_set_value_cansleep(reset_gpio, 1);
 919}
 920
 921static void ili210x_stop(void *data)
 922{
 923	struct ili210x *priv = data;
 924
 925	/* Tell ISR to quit even if there is a contact. */
 926	priv->stop = true;
 927}
 928
 929static int ili210x_i2c_probe(struct i2c_client *client)
 930{
 931	const struct i2c_device_id *id = i2c_client_get_device_id(client);
 932	struct device *dev = &client->dev;
 933	const struct ili2xxx_chip *chip;
 934	struct ili210x *priv;
 935	struct gpio_desc *reset_gpio;
 936	struct input_dev *input;
 937	int error;
 938	unsigned int max_xy;
 939
 940	dev_dbg(dev, "Probing for ILI210X I2C Touschreen driver");
 941
 942	chip = device_get_match_data(dev);
 943	if (!chip && id)
 944		chip = (const struct ili2xxx_chip *)id->driver_data;
 945	if (!chip) {
 946		dev_err(&client->dev, "unknown device model\n");
 947		return -ENODEV;
 948	}
 949
 950	if (client->irq <= 0) {
 951		dev_err(dev, "No IRQ!\n");
 952		return -EINVAL;
 953	}
 954
 955	reset_gpio = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_HIGH);
 956	if (IS_ERR(reset_gpio))
 957		return PTR_ERR(reset_gpio);
 958
 959	if (reset_gpio) {
 960		error = devm_add_action_or_reset(dev, ili210x_power_down,
 961						 reset_gpio);
 962		if (error)
 963			return error;
 964
 965		ili210x_hardware_reset(reset_gpio);
 966	}
 967
 968	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
 969	if (!priv)
 970		return -ENOMEM;
 971
 972	input = devm_input_allocate_device(dev);
 973	if (!input)
 974		return -ENOMEM;
 975
 976	priv->client = client;
 977	priv->input = input;
 978	priv->reset_gpio = reset_gpio;
 979	priv->chip = chip;
 980	i2c_set_clientdata(client, priv);
 981
 982	/* Setup input device */
 983	input->name = "ILI210x Touchscreen";
 984	input->id.bustype = BUS_I2C;
 985
 986	/* Multi touch */
 987	max_xy = (chip->resolution ?: SZ_64K) - 1;
 988	input_set_abs_params(input, ABS_MT_POSITION_X, 0, max_xy, 0, 0);
 989	input_set_abs_params(input, ABS_MT_POSITION_Y, 0, max_xy, 0, 0);
 990	if (priv->chip->has_pressure_reg)
 991		input_set_abs_params(input, ABS_MT_PRESSURE, 0, 0xa, 0, 0);
 992	error = ili251x_firmware_update_cached_state(dev);
 993	if (error)
 994		dev_warn(dev, "Unable to cache firmware information, err: %d\n",
 995			 error);
 996
 997	touchscreen_parse_properties(input, true, &priv->prop);
 998
 999	error = input_mt_init_slots(input, priv->chip->max_touches,
1000				    INPUT_MT_DIRECT);
1001	if (error) {
1002		dev_err(dev, "Unable to set up slots, err: %d\n", error);
1003		return error;
1004	}
1005
1006	error = devm_request_threaded_irq(dev, client->irq, NULL, ili210x_irq,
1007					  IRQF_ONESHOT, client->name, priv);
1008	if (error) {
1009		dev_err(dev, "Unable to request touchscreen IRQ, err: %d\n",
1010			error);
1011		return error;
1012	}
1013
1014	error = devm_add_action_or_reset(dev, ili210x_stop, priv);
1015	if (error)
1016		return error;
1017
1018	error = input_register_device(priv->input);
1019	if (error) {
1020		dev_err(dev, "Cannot register input device, err: %d\n", error);
1021		return error;
1022	}
1023
1024	return 0;
1025}
1026
1027static const struct i2c_device_id ili210x_i2c_id[] = {
1028	{ "ili210x", (long)&ili210x_chip },
1029	{ "ili2117", (long)&ili211x_chip },
1030	{ "ili2120", (long)&ili212x_chip },
1031	{ "ili251x", (long)&ili251x_chip },
1032	{ }
1033};
1034MODULE_DEVICE_TABLE(i2c, ili210x_i2c_id);
1035
1036static const struct of_device_id ili210x_dt_ids[] = {
1037	{ .compatible = "ilitek,ili210x", .data = &ili210x_chip },
1038	{ .compatible = "ilitek,ili2117", .data = &ili211x_chip },
1039	{ .compatible = "ilitek,ili2120", .data = &ili212x_chip },
1040	{ .compatible = "ilitek,ili251x", .data = &ili251x_chip },
1041	{ }
1042};
1043MODULE_DEVICE_TABLE(of, ili210x_dt_ids);
1044
1045static struct i2c_driver ili210x_ts_driver = {
1046	.driver = {
1047		.name = "ili210x_i2c",
1048		.dev_groups = ili210x_groups,
1049		.of_match_table = ili210x_dt_ids,
1050	},
1051	.id_table = ili210x_i2c_id,
1052	.probe = ili210x_i2c_probe,
1053};
1054
1055module_i2c_driver(ili210x_ts_driver);
1056
1057MODULE_AUTHOR("Olivier Sobrie <olivier@sobrie.be>");
1058MODULE_DESCRIPTION("ILI210X I2C Touchscreen Driver");
1059MODULE_LICENSE("GPL");