cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

elan_i2c_core.c (36241B)


      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * Elan I2C/SMBus Touchpad driver
      4 *
      5 * Copyright (c) 2013 ELAN Microelectronics Corp.
      6 *
      7 * Author: 林政維 (Duson Lin) <dusonlin@emc.com.tw>
      8 * Author: KT Liao <kt.liao@emc.com.tw>
      9 * Version: 1.6.3
     10 *
     11 * Based on cyapa driver:
     12 * copyright (c) 2011-2012 Cypress Semiconductor, Inc.
     13 * copyright (c) 2011-2012 Google, Inc.
     14 *
     15 * Trademarks are the property of their respective owners.
     16 */
     17
     18#include <linux/acpi.h>
     19#include <linux/delay.h>
     20#include <linux/device.h>
     21#include <linux/firmware.h>
     22#include <linux/i2c.h>
     23#include <linux/init.h>
     24#include <linux/input/mt.h>
     25#include <linux/interrupt.h>
     26#include <linux/irq.h>
     27#include <linux/module.h>
     28#include <linux/slab.h>
     29#include <linux/kernel.h>
     30#include <linux/sched.h>
     31#include <linux/input.h>
     32#include <linux/uaccess.h>
     33#include <linux/jiffies.h>
     34#include <linux/completion.h>
     35#include <linux/of.h>
     36#include <linux/property.h>
     37#include <linux/regulator/consumer.h>
     38#include <asm/unaligned.h>
     39
     40#include "elan_i2c.h"
     41
     42#define DRIVER_NAME		"elan_i2c"
     43#define ELAN_VENDOR_ID		0x04f3
     44#define ETP_MAX_PRESSURE	255
     45#define ETP_FWIDTH_REDUCE	90
     46#define ETP_FINGER_WIDTH	15
     47#define ETP_RETRY_COUNT		3
     48
     49/* quirks to control the device */
     50#define ETP_QUIRK_QUICK_WAKEUP	BIT(0)
     51
     52/* The main device structure */
     53struct elan_tp_data {
     54	struct i2c_client	*client;
     55	struct input_dev	*input;
     56	struct input_dev	*tp_input; /* trackpoint input node */
     57	struct regulator	*vcc;
     58
     59	const struct elan_transport_ops *ops;
     60
     61	/* for fw update */
     62	struct completion	fw_completion;
     63	bool			in_fw_update;
     64
     65	struct mutex		sysfs_mutex;
     66
     67	unsigned int		max_x;
     68	unsigned int		max_y;
     69	unsigned int		width_x;
     70	unsigned int		width_y;
     71	unsigned int		x_res;
     72	unsigned int		y_res;
     73
     74	u8			pattern;
     75	u16			product_id;
     76	u8			fw_version;
     77	u8			sm_version;
     78	u8			iap_version;
     79	u16			fw_checksum;
     80	unsigned int		report_features;
     81	unsigned int		report_len;
     82	int			pressure_adjustment;
     83	u8			mode;
     84	u16			ic_type;
     85	u16			fw_validpage_count;
     86	u16			fw_page_size;
     87	u32			fw_signature_address;
     88
     89	bool			irq_wake;
     90
     91	u8			min_baseline;
     92	u8			max_baseline;
     93	bool			baseline_ready;
     94	u8			clickpad;
     95	bool			middle_button;
     96
     97	u32			quirks;		/* Various quirks */
     98};
     99
    100static u32 elan_i2c_lookup_quirks(u16 ic_type, u16 product_id)
    101{
    102	static const struct {
    103		u16 ic_type;
    104		u16 product_id;
    105		u32 quirks;
    106	} elan_i2c_quirks[] = {
    107		{ 0x0D, ETP_PRODUCT_ID_DELBIN, ETP_QUIRK_QUICK_WAKEUP },
    108		{ 0x0D, ETP_PRODUCT_ID_WHITEBOX, ETP_QUIRK_QUICK_WAKEUP },
    109		{ 0x10, ETP_PRODUCT_ID_VOXEL, ETP_QUIRK_QUICK_WAKEUP },
    110		{ 0x14, ETP_PRODUCT_ID_MAGPIE, ETP_QUIRK_QUICK_WAKEUP },
    111		{ 0x14, ETP_PRODUCT_ID_BOBBA, ETP_QUIRK_QUICK_WAKEUP },
    112	};
    113	u32 quirks = 0;
    114	int i;
    115
    116	for (i = 0; i < ARRAY_SIZE(elan_i2c_quirks); i++) {
    117		if (elan_i2c_quirks[i].ic_type == ic_type &&
    118		    elan_i2c_quirks[i].product_id == product_id) {
    119			quirks = elan_i2c_quirks[i].quirks;
    120		}
    121	}
    122
    123	if (ic_type >= 0x0D && product_id >= 0x123)
    124		quirks |= ETP_QUIRK_QUICK_WAKEUP;
    125
    126	return quirks;
    127}
    128
    129static int elan_get_fwinfo(u16 ic_type, u8 iap_version, u16 *validpage_count,
    130			   u32 *signature_address, u16 *page_size)
    131{
    132	switch (ic_type) {
    133	case 0x00:
    134	case 0x06:
    135	case 0x08:
    136		*validpage_count = 512;
    137		break;
    138	case 0x03:
    139	case 0x07:
    140	case 0x09:
    141	case 0x0A:
    142	case 0x0B:
    143	case 0x0C:
    144		*validpage_count = 768;
    145		break;
    146	case 0x0D:
    147		*validpage_count = 896;
    148		break;
    149	case 0x0E:
    150		*validpage_count = 640;
    151		break;
    152	case 0x10:
    153		*validpage_count = 1024;
    154		break;
    155	case 0x11:
    156		*validpage_count = 1280;
    157		break;
    158	case 0x13:
    159		*validpage_count = 2048;
    160		break;
    161	case 0x14:
    162	case 0x15:
    163		*validpage_count = 1024;
    164		break;
    165	default:
    166		/* unknown ic type clear value */
    167		*validpage_count = 0;
    168		*signature_address = 0;
    169		*page_size = 0;
    170		return -ENXIO;
    171	}
    172
    173	*signature_address =
    174		(*validpage_count * ETP_FW_PAGE_SIZE) - ETP_FW_SIGNATURE_SIZE;
    175
    176	if ((ic_type == 0x14 || ic_type == 0x15) && iap_version >= 2) {
    177		*validpage_count /= 8;
    178		*page_size = ETP_FW_PAGE_SIZE_512;
    179	} else if (ic_type >= 0x0D && iap_version >= 1) {
    180		*validpage_count /= 2;
    181		*page_size = ETP_FW_PAGE_SIZE_128;
    182	} else {
    183		*page_size = ETP_FW_PAGE_SIZE;
    184	}
    185
    186	return 0;
    187}
    188
    189static int elan_set_power(struct elan_tp_data *data, bool on)
    190{
    191	int repeat = ETP_RETRY_COUNT;
    192	int error;
    193
    194	do {
    195		error = data->ops->power_control(data->client, on);
    196		if (error >= 0)
    197			return 0;
    198
    199		msleep(30);
    200	} while (--repeat > 0);
    201
    202	dev_err(&data->client->dev, "failed to set power %s: %d\n",
    203		on ? "on" : "off", error);
    204	return error;
    205}
    206
    207static int elan_sleep(struct elan_tp_data *data)
    208{
    209	int repeat = ETP_RETRY_COUNT;
    210	int error;
    211
    212	do {
    213		error = data->ops->sleep_control(data->client, true);
    214		if (!error)
    215			return 0;
    216
    217		msleep(30);
    218	} while (--repeat > 0);
    219
    220	return error;
    221}
    222
    223static int elan_query_product(struct elan_tp_data *data)
    224{
    225	int error;
    226
    227	error = data->ops->get_product_id(data->client, &data->product_id);
    228	if (error)
    229		return error;
    230
    231	error = data->ops->get_pattern(data->client, &data->pattern);
    232	if (error)
    233		return error;
    234
    235	error = data->ops->get_sm_version(data->client, data->pattern,
    236					  &data->ic_type, &data->sm_version,
    237					  &data->clickpad);
    238	if (error)
    239		return error;
    240
    241	return 0;
    242}
    243
    244static int elan_check_ASUS_special_fw(struct elan_tp_data *data)
    245{
    246	if (data->ic_type == 0x0E) {
    247		switch (data->product_id) {
    248		case 0x05 ... 0x07:
    249		case 0x09:
    250		case 0x13:
    251			return true;
    252		}
    253	} else if (data->ic_type == 0x08 && data->product_id == 0x26) {
    254		/* ASUS EeeBook X205TA */
    255		return true;
    256	}
    257
    258	return false;
    259}
    260
    261static int __elan_initialize(struct elan_tp_data *data, bool skip_reset)
    262{
    263	struct i2c_client *client = data->client;
    264	bool woken_up = false;
    265	int error;
    266
    267	if (!skip_reset) {
    268		error = data->ops->initialize(client);
    269		if (error) {
    270			dev_err(&client->dev, "device initialize failed: %d\n", error);
    271			return error;
    272		}
    273	}
    274
    275	error = elan_query_product(data);
    276	if (error)
    277		return error;
    278
    279	/*
    280	 * Some ASUS devices were shipped with firmware that requires
    281	 * touchpads to be woken up first, before attempting to switch
    282	 * them into absolute reporting mode.
    283	 */
    284	if (elan_check_ASUS_special_fw(data)) {
    285		error = data->ops->sleep_control(client, false);
    286		if (error) {
    287			dev_err(&client->dev,
    288				"failed to wake device up: %d\n", error);
    289			return error;
    290		}
    291
    292		msleep(200);
    293		woken_up = true;
    294	}
    295
    296	data->mode |= ETP_ENABLE_ABS;
    297	error = data->ops->set_mode(client, data->mode);
    298	if (error) {
    299		dev_err(&client->dev,
    300			"failed to switch to absolute mode: %d\n", error);
    301		return error;
    302	}
    303
    304	if (!woken_up) {
    305		error = data->ops->sleep_control(client, false);
    306		if (error) {
    307			dev_err(&client->dev,
    308				"failed to wake device up: %d\n", error);
    309			return error;
    310		}
    311	}
    312
    313	return 0;
    314}
    315
    316static int elan_initialize(struct elan_tp_data *data, bool skip_reset)
    317{
    318	int repeat = ETP_RETRY_COUNT;
    319	int error;
    320
    321	do {
    322		error = __elan_initialize(data, skip_reset);
    323		if (!error)
    324			return 0;
    325
    326		skip_reset = false;
    327		msleep(30);
    328	} while (--repeat > 0);
    329
    330	return error;
    331}
    332
    333static int elan_query_device_info(struct elan_tp_data *data)
    334{
    335	int error;
    336
    337	error = data->ops->get_version(data->client, data->pattern, false,
    338				       &data->fw_version);
    339	if (error)
    340		return error;
    341
    342	error = data->ops->get_checksum(data->client, false,
    343					&data->fw_checksum);
    344	if (error)
    345		return error;
    346
    347	error = data->ops->get_version(data->client, data->pattern,
    348				       true, &data->iap_version);
    349	if (error)
    350		return error;
    351
    352	error = data->ops->get_pressure_adjustment(data->client,
    353						   &data->pressure_adjustment);
    354	if (error)
    355		return error;
    356
    357	error = data->ops->get_report_features(data->client, data->pattern,
    358					       &data->report_features,
    359					       &data->report_len);
    360	if (error)
    361		return error;
    362
    363	data->quirks = elan_i2c_lookup_quirks(data->ic_type, data->product_id);
    364
    365	error = elan_get_fwinfo(data->ic_type, data->iap_version,
    366				&data->fw_validpage_count,
    367				&data->fw_signature_address,
    368				&data->fw_page_size);
    369	if (error)
    370		dev_warn(&data->client->dev,
    371			 "unexpected iap version %#04x (ic type: %#04x), firmware update will not work\n",
    372			 data->iap_version, data->ic_type);
    373
    374	return 0;
    375}
    376
    377static unsigned int elan_convert_resolution(u8 val, u8 pattern)
    378{
    379	/*
    380	 * pattern <= 0x01:
    381	 *	(value from firmware) * 10 + 790 = dpi
    382	 * else
    383	 *	((value from firmware) + 3) * 100 = dpi
    384	 */
    385	int res = pattern <= 0x01 ?
    386		(int)(char)val * 10 + 790 : ((int)(char)val + 3) * 100;
    387	/*
    388	 * We also have to convert dpi to dots/mm (*10/254 to avoid floating
    389	 * point).
    390	 */
    391	return res * 10 / 254;
    392}
    393
    394static int elan_query_device_parameters(struct elan_tp_data *data)
    395{
    396	struct i2c_client *client = data->client;
    397	unsigned int x_traces, y_traces;
    398	u32 x_mm, y_mm;
    399	u8 hw_x_res, hw_y_res;
    400	int error;
    401
    402	if (device_property_read_u32(&client->dev,
    403				     "touchscreen-size-x", &data->max_x) ||
    404	    device_property_read_u32(&client->dev,
    405				     "touchscreen-size-y", &data->max_y)) {
    406		error = data->ops->get_max(data->client,
    407					   &data->max_x,
    408					   &data->max_y);
    409		if (error)
    410			return error;
    411	} else {
    412		/* size is the maximum + 1 */
    413		--data->max_x;
    414		--data->max_y;
    415	}
    416
    417	if (device_property_read_u32(&client->dev,
    418				     "elan,x_traces",
    419				     &x_traces) ||
    420	    device_property_read_u32(&client->dev,
    421				     "elan,y_traces",
    422				     &y_traces)) {
    423		error = data->ops->get_num_traces(data->client,
    424						  &x_traces, &y_traces);
    425		if (error)
    426			return error;
    427	}
    428	data->width_x = data->max_x / x_traces;
    429	data->width_y = data->max_y / y_traces;
    430
    431	if (device_property_read_u32(&client->dev,
    432				     "touchscreen-x-mm", &x_mm) ||
    433	    device_property_read_u32(&client->dev,
    434				     "touchscreen-y-mm", &y_mm)) {
    435		error = data->ops->get_resolution(data->client,
    436						  &hw_x_res, &hw_y_res);
    437		if (error)
    438			return error;
    439
    440		data->x_res = elan_convert_resolution(hw_x_res, data->pattern);
    441		data->y_res = elan_convert_resolution(hw_y_res, data->pattern);
    442	} else {
    443		data->x_res = (data->max_x + 1) / x_mm;
    444		data->y_res = (data->max_y + 1) / y_mm;
    445	}
    446
    447	if (device_property_read_bool(&client->dev, "elan,clickpad"))
    448		data->clickpad = 1;
    449
    450	if (device_property_read_bool(&client->dev, "elan,middle-button"))
    451		data->middle_button = true;
    452
    453	return 0;
    454}
    455
    456/*
    457 **********************************************************
    458 * IAP firmware updater related routines
    459 **********************************************************
    460 */
    461static int elan_write_fw_block(struct elan_tp_data *data, u16 page_size,
    462			       const u8 *page, u16 checksum, int idx)
    463{
    464	int retry = ETP_RETRY_COUNT;
    465	int error;
    466
    467	do {
    468		error = data->ops->write_fw_block(data->client, page_size,
    469						  page, checksum, idx);
    470		if (!error)
    471			return 0;
    472
    473		dev_dbg(&data->client->dev,
    474			"IAP retrying page %d (error: %d)\n", idx, error);
    475	} while (--retry > 0);
    476
    477	return error;
    478}
    479
    480static int __elan_update_firmware(struct elan_tp_data *data,
    481				  const struct firmware *fw)
    482{
    483	struct i2c_client *client = data->client;
    484	struct device *dev = &client->dev;
    485	int i, j;
    486	int error;
    487	u16 iap_start_addr;
    488	u16 boot_page_count;
    489	u16 sw_checksum = 0, fw_checksum = 0;
    490
    491	error = data->ops->prepare_fw_update(client, data->ic_type,
    492					     data->iap_version,
    493					     data->fw_page_size);
    494	if (error)
    495		return error;
    496
    497	iap_start_addr = get_unaligned_le16(&fw->data[ETP_IAP_START_ADDR * 2]);
    498
    499	boot_page_count = (iap_start_addr * 2) / data->fw_page_size;
    500	for (i = boot_page_count; i < data->fw_validpage_count; i++) {
    501		u16 checksum = 0;
    502		const u8 *page = &fw->data[i * data->fw_page_size];
    503
    504		for (j = 0; j < data->fw_page_size; j += 2)
    505			checksum += ((page[j + 1] << 8) | page[j]);
    506
    507		error = elan_write_fw_block(data, data->fw_page_size,
    508					    page, checksum, i);
    509		if (error) {
    510			dev_err(dev, "write page %d fail: %d\n", i, error);
    511			return error;
    512		}
    513
    514		sw_checksum += checksum;
    515	}
    516
    517	/* Wait WDT reset and power on reset */
    518	msleep(600);
    519
    520	error = data->ops->finish_fw_update(client, &data->fw_completion);
    521	if (error)
    522		return error;
    523
    524	error = data->ops->get_checksum(client, true, &fw_checksum);
    525	if (error)
    526		return error;
    527
    528	if (sw_checksum != fw_checksum) {
    529		dev_err(dev, "checksum diff sw=[%04X], fw=[%04X]\n",
    530			sw_checksum, fw_checksum);
    531		return -EIO;
    532	}
    533
    534	return 0;
    535}
    536
    537static int elan_update_firmware(struct elan_tp_data *data,
    538				const struct firmware *fw)
    539{
    540	struct i2c_client *client = data->client;
    541	int retval;
    542
    543	dev_dbg(&client->dev, "Starting firmware update....\n");
    544
    545	disable_irq(client->irq);
    546	data->in_fw_update = true;
    547
    548	retval = __elan_update_firmware(data, fw);
    549	if (retval) {
    550		dev_err(&client->dev, "firmware update failed: %d\n", retval);
    551		data->ops->iap_reset(client);
    552	} else {
    553		/* Reinitialize TP after fw is updated */
    554		elan_initialize(data, false);
    555		elan_query_device_info(data);
    556	}
    557
    558	data->in_fw_update = false;
    559	enable_irq(client->irq);
    560
    561	return retval;
    562}
    563
    564/*
    565 *******************************************************************
    566 * SYSFS attributes
    567 *******************************************************************
    568 */
    569static ssize_t elan_sysfs_read_fw_checksum(struct device *dev,
    570					   struct device_attribute *attr,
    571					   char *buf)
    572{
    573	struct i2c_client *client = to_i2c_client(dev);
    574	struct elan_tp_data *data = i2c_get_clientdata(client);
    575
    576	return sprintf(buf, "0x%04x\n", data->fw_checksum);
    577}
    578
    579static ssize_t elan_sysfs_read_product_id(struct device *dev,
    580					 struct device_attribute *attr,
    581					 char *buf)
    582{
    583	struct i2c_client *client = to_i2c_client(dev);
    584	struct elan_tp_data *data = i2c_get_clientdata(client);
    585
    586	return sprintf(buf, ETP_PRODUCT_ID_FORMAT_STRING "\n",
    587		       data->product_id);
    588}
    589
    590static ssize_t elan_sysfs_read_fw_ver(struct device *dev,
    591				      struct device_attribute *attr,
    592				      char *buf)
    593{
    594	struct i2c_client *client = to_i2c_client(dev);
    595	struct elan_tp_data *data = i2c_get_clientdata(client);
    596
    597	return sprintf(buf, "%d.0\n", data->fw_version);
    598}
    599
    600static ssize_t elan_sysfs_read_sm_ver(struct device *dev,
    601				      struct device_attribute *attr,
    602				      char *buf)
    603{
    604	struct i2c_client *client = to_i2c_client(dev);
    605	struct elan_tp_data *data = i2c_get_clientdata(client);
    606
    607	return sprintf(buf, "%d.0\n", data->sm_version);
    608}
    609
    610static ssize_t elan_sysfs_read_iap_ver(struct device *dev,
    611				       struct device_attribute *attr,
    612				       char *buf)
    613{
    614	struct i2c_client *client = to_i2c_client(dev);
    615	struct elan_tp_data *data = i2c_get_clientdata(client);
    616
    617	return sprintf(buf, "%d.0\n", data->iap_version);
    618}
    619
    620static ssize_t elan_sysfs_update_fw(struct device *dev,
    621				    struct device_attribute *attr,
    622				    const char *buf, size_t count)
    623{
    624	struct elan_tp_data *data = dev_get_drvdata(dev);
    625	const struct firmware *fw;
    626	char *fw_name;
    627	int error;
    628	const u8 *fw_signature;
    629	static const u8 signature[] = {0xAA, 0x55, 0xCC, 0x33, 0xFF, 0xFF};
    630
    631	if (data->fw_validpage_count == 0)
    632		return -EINVAL;
    633
    634	/* Look for a firmware with the product id appended. */
    635	fw_name = kasprintf(GFP_KERNEL, ETP_FW_NAME, data->product_id);
    636	if (!fw_name) {
    637		dev_err(dev, "failed to allocate memory for firmware name\n");
    638		return -ENOMEM;
    639	}
    640
    641	dev_info(dev, "requesting fw '%s'\n", fw_name);
    642	error = request_firmware(&fw, fw_name, dev);
    643	kfree(fw_name);
    644	if (error) {
    645		dev_err(dev, "failed to request firmware: %d\n", error);
    646		return error;
    647	}
    648
    649	/* Firmware file must match signature data */
    650	fw_signature = &fw->data[data->fw_signature_address];
    651	if (memcmp(fw_signature, signature, sizeof(signature)) != 0) {
    652		dev_err(dev, "signature mismatch (expected %*ph, got %*ph)\n",
    653			(int)sizeof(signature), signature,
    654			(int)sizeof(signature), fw_signature);
    655		error = -EBADF;
    656		goto out_release_fw;
    657	}
    658
    659	error = mutex_lock_interruptible(&data->sysfs_mutex);
    660	if (error)
    661		goto out_release_fw;
    662
    663	error = elan_update_firmware(data, fw);
    664
    665	mutex_unlock(&data->sysfs_mutex);
    666
    667out_release_fw:
    668	release_firmware(fw);
    669	return error ?: count;
    670}
    671
    672static ssize_t calibrate_store(struct device *dev,
    673			       struct device_attribute *attr,
    674			       const char *buf, size_t count)
    675{
    676	struct i2c_client *client = to_i2c_client(dev);
    677	struct elan_tp_data *data = i2c_get_clientdata(client);
    678	int tries = 20;
    679	int retval;
    680	int error;
    681	u8 val[ETP_CALIBRATE_MAX_LEN];
    682
    683	retval = mutex_lock_interruptible(&data->sysfs_mutex);
    684	if (retval)
    685		return retval;
    686
    687	disable_irq(client->irq);
    688
    689	data->mode |= ETP_ENABLE_CALIBRATE;
    690	retval = data->ops->set_mode(client, data->mode);
    691	if (retval) {
    692		dev_err(dev, "failed to enable calibration mode: %d\n",
    693			retval);
    694		goto out;
    695	}
    696
    697	retval = data->ops->calibrate(client);
    698	if (retval) {
    699		dev_err(dev, "failed to start calibration: %d\n",
    700			retval);
    701		goto out_disable_calibrate;
    702	}
    703
    704	val[0] = 0xff;
    705	do {
    706		/* Wait 250ms before checking if calibration has completed. */
    707		msleep(250);
    708
    709		retval = data->ops->calibrate_result(client, val);
    710		if (retval)
    711			dev_err(dev, "failed to check calibration result: %d\n",
    712				retval);
    713		else if (val[0] == 0)
    714			break; /* calibration done */
    715
    716	} while (--tries);
    717
    718	if (tries == 0) {
    719		dev_err(dev, "failed to calibrate. Timeout.\n");
    720		retval = -ETIMEDOUT;
    721	}
    722
    723out_disable_calibrate:
    724	data->mode &= ~ETP_ENABLE_CALIBRATE;
    725	error = data->ops->set_mode(data->client, data->mode);
    726	if (error) {
    727		dev_err(dev, "failed to disable calibration mode: %d\n",
    728			error);
    729		if (!retval)
    730			retval = error;
    731	}
    732out:
    733	enable_irq(client->irq);
    734	mutex_unlock(&data->sysfs_mutex);
    735	return retval ?: count;
    736}
    737
    738static ssize_t elan_sysfs_read_mode(struct device *dev,
    739				    struct device_attribute *attr,
    740				    char *buf)
    741{
    742	struct i2c_client *client = to_i2c_client(dev);
    743	struct elan_tp_data *data = i2c_get_clientdata(client);
    744	int error;
    745	enum tp_mode mode;
    746
    747	error = mutex_lock_interruptible(&data->sysfs_mutex);
    748	if (error)
    749		return error;
    750
    751	error = data->ops->iap_get_mode(data->client, &mode);
    752
    753	mutex_unlock(&data->sysfs_mutex);
    754
    755	if (error)
    756		return error;
    757
    758	return sprintf(buf, "%d\n", (int)mode);
    759}
    760
    761static DEVICE_ATTR(product_id, S_IRUGO, elan_sysfs_read_product_id, NULL);
    762static DEVICE_ATTR(firmware_version, S_IRUGO, elan_sysfs_read_fw_ver, NULL);
    763static DEVICE_ATTR(sample_version, S_IRUGO, elan_sysfs_read_sm_ver, NULL);
    764static DEVICE_ATTR(iap_version, S_IRUGO, elan_sysfs_read_iap_ver, NULL);
    765static DEVICE_ATTR(fw_checksum, S_IRUGO, elan_sysfs_read_fw_checksum, NULL);
    766static DEVICE_ATTR(mode, S_IRUGO, elan_sysfs_read_mode, NULL);
    767static DEVICE_ATTR(update_fw, S_IWUSR, NULL, elan_sysfs_update_fw);
    768
    769static DEVICE_ATTR_WO(calibrate);
    770
    771static struct attribute *elan_sysfs_entries[] = {
    772	&dev_attr_product_id.attr,
    773	&dev_attr_firmware_version.attr,
    774	&dev_attr_sample_version.attr,
    775	&dev_attr_iap_version.attr,
    776	&dev_attr_fw_checksum.attr,
    777	&dev_attr_calibrate.attr,
    778	&dev_attr_mode.attr,
    779	&dev_attr_update_fw.attr,
    780	NULL,
    781};
    782
    783static const struct attribute_group elan_sysfs_group = {
    784	.attrs = elan_sysfs_entries,
    785};
    786
    787static ssize_t acquire_store(struct device *dev, struct device_attribute *attr,
    788			     const char *buf, size_t count)
    789{
    790	struct i2c_client *client = to_i2c_client(dev);
    791	struct elan_tp_data *data = i2c_get_clientdata(client);
    792	int error;
    793	int retval;
    794
    795	retval = mutex_lock_interruptible(&data->sysfs_mutex);
    796	if (retval)
    797		return retval;
    798
    799	disable_irq(client->irq);
    800
    801	data->baseline_ready = false;
    802
    803	data->mode |= ETP_ENABLE_CALIBRATE;
    804	retval = data->ops->set_mode(data->client, data->mode);
    805	if (retval) {
    806		dev_err(dev, "Failed to enable calibration mode to get baseline: %d\n",
    807			retval);
    808		goto out;
    809	}
    810
    811	msleep(250);
    812
    813	retval = data->ops->get_baseline_data(data->client, true,
    814					      &data->max_baseline);
    815	if (retval) {
    816		dev_err(dev, "Failed to read max baseline form device: %d\n",
    817			retval);
    818		goto out_disable_calibrate;
    819	}
    820
    821	retval = data->ops->get_baseline_data(data->client, false,
    822					      &data->min_baseline);
    823	if (retval) {
    824		dev_err(dev, "Failed to read min baseline form device: %d\n",
    825			retval);
    826		goto out_disable_calibrate;
    827	}
    828
    829	data->baseline_ready = true;
    830
    831out_disable_calibrate:
    832	data->mode &= ~ETP_ENABLE_CALIBRATE;
    833	error = data->ops->set_mode(data->client, data->mode);
    834	if (error) {
    835		dev_err(dev, "Failed to disable calibration mode after acquiring baseline: %d\n",
    836			error);
    837		if (!retval)
    838			retval = error;
    839	}
    840out:
    841	enable_irq(client->irq);
    842	mutex_unlock(&data->sysfs_mutex);
    843	return retval ?: count;
    844}
    845
    846static ssize_t min_show(struct device *dev,
    847			struct device_attribute *attr, char *buf)
    848{
    849	struct i2c_client *client = to_i2c_client(dev);
    850	struct elan_tp_data *data = i2c_get_clientdata(client);
    851	int retval;
    852
    853	retval = mutex_lock_interruptible(&data->sysfs_mutex);
    854	if (retval)
    855		return retval;
    856
    857	if (!data->baseline_ready) {
    858		retval = -ENODATA;
    859		goto out;
    860	}
    861
    862	retval = snprintf(buf, PAGE_SIZE, "%d", data->min_baseline);
    863
    864out:
    865	mutex_unlock(&data->sysfs_mutex);
    866	return retval;
    867}
    868
    869static ssize_t max_show(struct device *dev,
    870			struct device_attribute *attr, char *buf)
    871{
    872	struct i2c_client *client = to_i2c_client(dev);
    873	struct elan_tp_data *data = i2c_get_clientdata(client);
    874	int retval;
    875
    876	retval = mutex_lock_interruptible(&data->sysfs_mutex);
    877	if (retval)
    878		return retval;
    879
    880	if (!data->baseline_ready) {
    881		retval = -ENODATA;
    882		goto out;
    883	}
    884
    885	retval = snprintf(buf, PAGE_SIZE, "%d", data->max_baseline);
    886
    887out:
    888	mutex_unlock(&data->sysfs_mutex);
    889	return retval;
    890}
    891
    892
    893static DEVICE_ATTR_WO(acquire);
    894static DEVICE_ATTR_RO(min);
    895static DEVICE_ATTR_RO(max);
    896
    897static struct attribute *elan_baseline_sysfs_entries[] = {
    898	&dev_attr_acquire.attr,
    899	&dev_attr_min.attr,
    900	&dev_attr_max.attr,
    901	NULL,
    902};
    903
    904static const struct attribute_group elan_baseline_sysfs_group = {
    905	.name = "baseline",
    906	.attrs = elan_baseline_sysfs_entries,
    907};
    908
    909static const struct attribute_group *elan_sysfs_groups[] = {
    910	&elan_sysfs_group,
    911	&elan_baseline_sysfs_group,
    912	NULL
    913};
    914
    915/*
    916 ******************************************************************
    917 * Elan isr functions
    918 ******************************************************************
    919 */
    920static void elan_report_contact(struct elan_tp_data *data, int contact_num,
    921				bool contact_valid, bool high_precision,
    922				u8 *packet, u8 *finger_data)
    923{
    924	struct input_dev *input = data->input;
    925	unsigned int pos_x, pos_y;
    926	unsigned int pressure, scaled_pressure;
    927
    928	if (contact_valid) {
    929		if (high_precision) {
    930			pos_x = get_unaligned_be16(&finger_data[0]);
    931			pos_y = get_unaligned_be16(&finger_data[2]);
    932		} else {
    933			pos_x = ((finger_data[0] & 0xf0) << 4) | finger_data[1];
    934			pos_y = ((finger_data[0] & 0x0f) << 8) | finger_data[2];
    935		}
    936
    937		if (pos_x > data->max_x || pos_y > data->max_y) {
    938			dev_dbg(input->dev.parent,
    939				"[%d] x=%d y=%d over max (%d, %d)",
    940				contact_num, pos_x, pos_y,
    941				data->max_x, data->max_y);
    942			return;
    943		}
    944
    945		pressure = finger_data[4];
    946		scaled_pressure = pressure + data->pressure_adjustment;
    947		if (scaled_pressure > ETP_MAX_PRESSURE)
    948			scaled_pressure = ETP_MAX_PRESSURE;
    949
    950		input_mt_slot(input, contact_num);
    951		input_mt_report_slot_state(input, MT_TOOL_FINGER, true);
    952		input_report_abs(input, ABS_MT_POSITION_X, pos_x);
    953		input_report_abs(input, ABS_MT_POSITION_Y, data->max_y - pos_y);
    954		input_report_abs(input, ABS_MT_PRESSURE, scaled_pressure);
    955
    956		if (data->report_features & ETP_FEATURE_REPORT_MK) {
    957			unsigned int mk_x, mk_y, area_x, area_y;
    958			u8 mk_data = high_precision ?
    959				packet[ETP_MK_DATA_OFFSET + contact_num] :
    960				finger_data[3];
    961
    962			mk_x = mk_data & 0x0f;
    963			mk_y = mk_data >> 4;
    964
    965			/*
    966			 * To avoid treating large finger as palm, let's reduce
    967			 * the width x and y per trace.
    968			 */
    969			area_x = mk_x * (data->width_x - ETP_FWIDTH_REDUCE);
    970			area_y = mk_y * (data->width_y - ETP_FWIDTH_REDUCE);
    971
    972			input_report_abs(input, ABS_TOOL_WIDTH, mk_x);
    973			input_report_abs(input, ABS_MT_TOUCH_MAJOR,
    974					 max(area_x, area_y));
    975			input_report_abs(input, ABS_MT_TOUCH_MINOR,
    976					 min(area_x, area_y));
    977		}
    978	} else {
    979		input_mt_slot(input, contact_num);
    980		input_mt_report_slot_inactive(input);
    981	}
    982}
    983
    984static void elan_report_absolute(struct elan_tp_data *data, u8 *packet,
    985				 bool high_precision)
    986{
    987	struct input_dev *input = data->input;
    988	u8 *finger_data = &packet[ETP_FINGER_DATA_OFFSET];
    989	int i;
    990	u8 tp_info = packet[ETP_TOUCH_INFO_OFFSET];
    991	u8 hover_info = packet[ETP_HOVER_INFO_OFFSET];
    992	bool contact_valid, hover_event;
    993
    994	pm_wakeup_event(&data->client->dev, 0);
    995
    996	hover_event = hover_info & BIT(6);
    997
    998	for (i = 0; i < ETP_MAX_FINGERS; i++) {
    999		contact_valid = tp_info & BIT(3 + i);
   1000		elan_report_contact(data, i, contact_valid, high_precision,
   1001				    packet, finger_data);
   1002		if (contact_valid)
   1003			finger_data += ETP_FINGER_DATA_LEN;
   1004	}
   1005
   1006	input_report_key(input, BTN_LEFT,   tp_info & BIT(0));
   1007	input_report_key(input, BTN_MIDDLE, tp_info & BIT(2));
   1008	input_report_key(input, BTN_RIGHT,  tp_info & BIT(1));
   1009	input_report_abs(input, ABS_DISTANCE, hover_event != 0);
   1010	input_mt_report_pointer_emulation(input, true);
   1011	input_sync(input);
   1012}
   1013
   1014static void elan_report_trackpoint(struct elan_tp_data *data, u8 *report)
   1015{
   1016	struct input_dev *input = data->tp_input;
   1017	u8 *packet = &report[ETP_REPORT_ID_OFFSET + 1];
   1018	int x, y;
   1019
   1020	pm_wakeup_event(&data->client->dev, 0);
   1021
   1022	if (!data->tp_input) {
   1023		dev_warn_once(&data->client->dev,
   1024			      "received a trackpoint report while no trackpoint device has been created. Please report upstream.\n");
   1025		return;
   1026	}
   1027
   1028	input_report_key(input, BTN_LEFT, packet[0] & 0x01);
   1029	input_report_key(input, BTN_RIGHT, packet[0] & 0x02);
   1030	input_report_key(input, BTN_MIDDLE, packet[0] & 0x04);
   1031
   1032	if ((packet[3] & 0x0F) == 0x06) {
   1033		x = packet[4] - (int)((packet[1] ^ 0x80) << 1);
   1034		y = (int)((packet[2] ^ 0x80) << 1) - packet[5];
   1035
   1036		input_report_rel(input, REL_X, x);
   1037		input_report_rel(input, REL_Y, y);
   1038	}
   1039
   1040	input_sync(input);
   1041}
   1042
   1043static irqreturn_t elan_isr(int irq, void *dev_id)
   1044{
   1045	struct elan_tp_data *data = dev_id;
   1046	int error;
   1047	u8 report[ETP_MAX_REPORT_LEN];
   1048
   1049	/*
   1050	 * When device is connected to i2c bus, when all IAP page writes
   1051	 * complete, the driver will receive interrupt and must read
   1052	 * 0000 to confirm that IAP is finished.
   1053	*/
   1054	if (data->in_fw_update) {
   1055		complete(&data->fw_completion);
   1056		goto out;
   1057	}
   1058
   1059	error = data->ops->get_report(data->client, report, data->report_len);
   1060	if (error)
   1061		goto out;
   1062
   1063	switch (report[ETP_REPORT_ID_OFFSET]) {
   1064	case ETP_REPORT_ID:
   1065		elan_report_absolute(data, report, false);
   1066		break;
   1067	case ETP_REPORT_ID2:
   1068		elan_report_absolute(data, report, true);
   1069		break;
   1070	case ETP_TP_REPORT_ID:
   1071	case ETP_TP_REPORT_ID2:
   1072		elan_report_trackpoint(data, report);
   1073		break;
   1074	default:
   1075		dev_err(&data->client->dev, "invalid report id data (%x)\n",
   1076			report[ETP_REPORT_ID_OFFSET]);
   1077	}
   1078
   1079out:
   1080	return IRQ_HANDLED;
   1081}
   1082
   1083/*
   1084 ******************************************************************
   1085 * Elan initialization functions
   1086 ******************************************************************
   1087 */
   1088
   1089static int elan_setup_trackpoint_input_device(struct elan_tp_data *data)
   1090{
   1091	struct device *dev = &data->client->dev;
   1092	struct input_dev *input;
   1093
   1094	input = devm_input_allocate_device(dev);
   1095	if (!input)
   1096		return -ENOMEM;
   1097
   1098	input->name = "Elan TrackPoint";
   1099	input->id.bustype = BUS_I2C;
   1100	input->id.vendor = ELAN_VENDOR_ID;
   1101	input->id.product = data->product_id;
   1102	input_set_drvdata(input, data);
   1103
   1104	input_set_capability(input, EV_REL, REL_X);
   1105	input_set_capability(input, EV_REL, REL_Y);
   1106	input_set_capability(input, EV_KEY, BTN_LEFT);
   1107	input_set_capability(input, EV_KEY, BTN_RIGHT);
   1108	input_set_capability(input, EV_KEY, BTN_MIDDLE);
   1109
   1110	__set_bit(INPUT_PROP_POINTER, input->propbit);
   1111	__set_bit(INPUT_PROP_POINTING_STICK, input->propbit);
   1112
   1113	data->tp_input = input;
   1114
   1115	return 0;
   1116}
   1117
   1118static int elan_setup_input_device(struct elan_tp_data *data)
   1119{
   1120	struct device *dev = &data->client->dev;
   1121	struct input_dev *input;
   1122	unsigned int max_width = max(data->width_x, data->width_y);
   1123	unsigned int min_width = min(data->width_x, data->width_y);
   1124	int error;
   1125
   1126	input = devm_input_allocate_device(dev);
   1127	if (!input)
   1128		return -ENOMEM;
   1129
   1130	input->name = "Elan Touchpad";
   1131	input->id.bustype = BUS_I2C;
   1132	input->id.vendor = ELAN_VENDOR_ID;
   1133	input->id.product = data->product_id;
   1134	input_set_drvdata(input, data);
   1135
   1136	error = input_mt_init_slots(input, ETP_MAX_FINGERS,
   1137				    INPUT_MT_POINTER | INPUT_MT_DROP_UNUSED);
   1138	if (error) {
   1139		dev_err(dev, "failed to initialize MT slots: %d\n", error);
   1140		return error;
   1141	}
   1142
   1143	__set_bit(EV_ABS, input->evbit);
   1144	__set_bit(INPUT_PROP_POINTER, input->propbit);
   1145	if (data->clickpad) {
   1146		__set_bit(INPUT_PROP_BUTTONPAD, input->propbit);
   1147	} else {
   1148		__set_bit(BTN_RIGHT, input->keybit);
   1149		if (data->middle_button)
   1150			__set_bit(BTN_MIDDLE, input->keybit);
   1151	}
   1152	__set_bit(BTN_LEFT, input->keybit);
   1153
   1154	/* Set up ST parameters */
   1155	input_set_abs_params(input, ABS_X, 0, data->max_x, 0, 0);
   1156	input_set_abs_params(input, ABS_Y, 0, data->max_y, 0, 0);
   1157	input_abs_set_res(input, ABS_X, data->x_res);
   1158	input_abs_set_res(input, ABS_Y, data->y_res);
   1159	input_set_abs_params(input, ABS_PRESSURE, 0, ETP_MAX_PRESSURE, 0, 0);
   1160	if (data->report_features & ETP_FEATURE_REPORT_MK)
   1161		input_set_abs_params(input, ABS_TOOL_WIDTH,
   1162				     0, ETP_FINGER_WIDTH, 0, 0);
   1163	input_set_abs_params(input, ABS_DISTANCE, 0, 1, 0, 0);
   1164
   1165	/* And MT parameters */
   1166	input_set_abs_params(input, ABS_MT_POSITION_X, 0, data->max_x, 0, 0);
   1167	input_set_abs_params(input, ABS_MT_POSITION_Y, 0, data->max_y, 0, 0);
   1168	input_abs_set_res(input, ABS_MT_POSITION_X, data->x_res);
   1169	input_abs_set_res(input, ABS_MT_POSITION_Y, data->y_res);
   1170	input_set_abs_params(input, ABS_MT_PRESSURE, 0,
   1171			     ETP_MAX_PRESSURE, 0, 0);
   1172	if (data->report_features & ETP_FEATURE_REPORT_MK) {
   1173		input_set_abs_params(input, ABS_MT_TOUCH_MAJOR,
   1174				     0, ETP_FINGER_WIDTH * max_width, 0, 0);
   1175		input_set_abs_params(input, ABS_MT_TOUCH_MINOR,
   1176				     0, ETP_FINGER_WIDTH * min_width, 0, 0);
   1177	}
   1178
   1179	data->input = input;
   1180
   1181	return 0;
   1182}
   1183
   1184static void elan_disable_regulator(void *_data)
   1185{
   1186	struct elan_tp_data *data = _data;
   1187
   1188	regulator_disable(data->vcc);
   1189}
   1190
   1191static int elan_probe(struct i2c_client *client,
   1192		      const struct i2c_device_id *dev_id)
   1193{
   1194	const struct elan_transport_ops *transport_ops;
   1195	struct device *dev = &client->dev;
   1196	struct elan_tp_data *data;
   1197	unsigned long irqflags;
   1198	int error;
   1199
   1200	if (IS_ENABLED(CONFIG_MOUSE_ELAN_I2C_I2C) &&
   1201	    i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
   1202		transport_ops = &elan_i2c_ops;
   1203	} else if (IS_ENABLED(CONFIG_MOUSE_ELAN_I2C_SMBUS) &&
   1204		   i2c_check_functionality(client->adapter,
   1205					   I2C_FUNC_SMBUS_BYTE_DATA |
   1206						I2C_FUNC_SMBUS_BLOCK_DATA |
   1207						I2C_FUNC_SMBUS_I2C_BLOCK)) {
   1208		transport_ops = &elan_smbus_ops;
   1209	} else {
   1210		dev_err(dev, "not a supported I2C/SMBus adapter\n");
   1211		return -EIO;
   1212	}
   1213
   1214	data = devm_kzalloc(dev, sizeof(struct elan_tp_data), GFP_KERNEL);
   1215	if (!data)
   1216		return -ENOMEM;
   1217
   1218	i2c_set_clientdata(client, data);
   1219
   1220	data->ops = transport_ops;
   1221	data->client = client;
   1222	init_completion(&data->fw_completion);
   1223	mutex_init(&data->sysfs_mutex);
   1224
   1225	data->vcc = devm_regulator_get(dev, "vcc");
   1226	if (IS_ERR(data->vcc)) {
   1227		error = PTR_ERR(data->vcc);
   1228		if (error != -EPROBE_DEFER)
   1229			dev_err(dev, "Failed to get 'vcc' regulator: %d\n",
   1230				error);
   1231		return error;
   1232	}
   1233
   1234	error = regulator_enable(data->vcc);
   1235	if (error) {
   1236		dev_err(dev, "Failed to enable regulator: %d\n", error);
   1237		return error;
   1238	}
   1239
   1240	error = devm_add_action_or_reset(dev, elan_disable_regulator, data);
   1241	if (error) {
   1242		dev_err(dev, "Failed to add disable regulator action: %d\n",
   1243			error);
   1244		return error;
   1245	}
   1246
   1247	/* Make sure there is something at this address */
   1248	error = i2c_smbus_read_byte(client);
   1249	if (error < 0) {
   1250		dev_dbg(&client->dev, "nothing at this address: %d\n", error);
   1251		return -ENXIO;
   1252	}
   1253
   1254	/* Initialize the touchpad. */
   1255	error = elan_initialize(data, false);
   1256	if (error)
   1257		return error;
   1258
   1259	error = elan_query_device_info(data);
   1260	if (error)
   1261		return error;
   1262
   1263	error = elan_query_device_parameters(data);
   1264	if (error)
   1265		return error;
   1266
   1267	dev_info(dev,
   1268		 "Elan Touchpad: Module ID: 0x%04x, Firmware: 0x%04x, Sample: 0x%04x, IAP: 0x%04x\n",
   1269		 data->product_id,
   1270		 data->fw_version,
   1271		 data->sm_version,
   1272		 data->iap_version);
   1273
   1274	dev_dbg(dev,
   1275		"Elan Touchpad Extra Information:\n"
   1276		"    Max ABS X,Y:   %d,%d\n"
   1277		"    Width X,Y:   %d,%d\n"
   1278		"    Resolution X,Y:   %d,%d (dots/mm)\n"
   1279		"    ic type: 0x%x\n"
   1280		"    info pattern: 0x%x\n",
   1281		data->max_x, data->max_y,
   1282		data->width_x, data->width_y,
   1283		data->x_res, data->y_res,
   1284		data->ic_type, data->pattern);
   1285
   1286	/* Set up input device properties based on queried parameters. */
   1287	error = elan_setup_input_device(data);
   1288	if (error)
   1289		return error;
   1290
   1291	if (device_property_read_bool(&client->dev, "elan,trackpoint")) {
   1292		error = elan_setup_trackpoint_input_device(data);
   1293		if (error)
   1294			return error;
   1295	}
   1296
   1297	/*
   1298	 * Platform code (ACPI, DTS) should normally set up interrupt
   1299	 * for us, but in case it did not let's fall back to using falling
   1300	 * edge to be compatible with older Chromebooks.
   1301	 */
   1302	irqflags = irq_get_trigger_type(client->irq);
   1303	if (!irqflags)
   1304		irqflags = IRQF_TRIGGER_FALLING;
   1305
   1306	error = devm_request_threaded_irq(dev, client->irq, NULL, elan_isr,
   1307					  irqflags | IRQF_ONESHOT,
   1308					  client->name, data);
   1309	if (error) {
   1310		dev_err(dev, "cannot register irq=%d\n", client->irq);
   1311		return error;
   1312	}
   1313
   1314	error = devm_device_add_groups(dev, elan_sysfs_groups);
   1315	if (error) {
   1316		dev_err(dev, "failed to create sysfs attributes: %d\n", error);
   1317		return error;
   1318	}
   1319
   1320	error = input_register_device(data->input);
   1321	if (error) {
   1322		dev_err(dev, "failed to register input device: %d\n", error);
   1323		return error;
   1324	}
   1325
   1326	if (data->tp_input) {
   1327		error = input_register_device(data->tp_input);
   1328		if (error) {
   1329			dev_err(&client->dev,
   1330				"failed to register TrackPoint input device: %d\n",
   1331				error);
   1332			return error;
   1333		}
   1334	}
   1335
   1336	/*
   1337	 * Systems using device tree should set up wakeup via DTS,
   1338	 * the rest will configure device as wakeup source by default.
   1339	 */
   1340	if (!dev->of_node)
   1341		device_init_wakeup(dev, true);
   1342
   1343	return 0;
   1344}
   1345
   1346static int __maybe_unused elan_suspend(struct device *dev)
   1347{
   1348	struct i2c_client *client = to_i2c_client(dev);
   1349	struct elan_tp_data *data = i2c_get_clientdata(client);
   1350	int ret;
   1351
   1352	/*
   1353	 * We are taking the mutex to make sure sysfs operations are
   1354	 * complete before we attempt to bring the device into low[er]
   1355	 * power mode.
   1356	 */
   1357	ret = mutex_lock_interruptible(&data->sysfs_mutex);
   1358	if (ret)
   1359		return ret;
   1360
   1361	disable_irq(client->irq);
   1362
   1363	if (device_may_wakeup(dev)) {
   1364		ret = elan_sleep(data);
   1365		/* Enable wake from IRQ */
   1366		data->irq_wake = (enable_irq_wake(client->irq) == 0);
   1367	} else {
   1368		ret = elan_set_power(data, false);
   1369		if (ret)
   1370			goto err;
   1371
   1372		ret = regulator_disable(data->vcc);
   1373		if (ret) {
   1374			dev_err(dev, "error %d disabling regulator\n", ret);
   1375			/* Attempt to power the chip back up */
   1376			elan_set_power(data, true);
   1377		}
   1378	}
   1379
   1380err:
   1381	mutex_unlock(&data->sysfs_mutex);
   1382	return ret;
   1383}
   1384
   1385static int __maybe_unused elan_resume(struct device *dev)
   1386{
   1387	struct i2c_client *client = to_i2c_client(dev);
   1388	struct elan_tp_data *data = i2c_get_clientdata(client);
   1389	int error;
   1390
   1391	if (!device_may_wakeup(dev)) {
   1392		error = regulator_enable(data->vcc);
   1393		if (error) {
   1394			dev_err(dev, "error %d enabling regulator\n", error);
   1395			goto err;
   1396		}
   1397	} else if (data->irq_wake) {
   1398		disable_irq_wake(client->irq);
   1399		data->irq_wake = false;
   1400	}
   1401
   1402	error = elan_set_power(data, true);
   1403	if (error) {
   1404		dev_err(dev, "power up when resuming failed: %d\n", error);
   1405		goto err;
   1406	}
   1407
   1408	error = elan_initialize(data, data->quirks & ETP_QUIRK_QUICK_WAKEUP);
   1409	if (error)
   1410		dev_err(dev, "initialize when resuming failed: %d\n", error);
   1411
   1412err:
   1413	enable_irq(data->client->irq);
   1414	return error;
   1415}
   1416
   1417static SIMPLE_DEV_PM_OPS(elan_pm_ops, elan_suspend, elan_resume);
   1418
   1419static const struct i2c_device_id elan_id[] = {
   1420	{ DRIVER_NAME, 0 },
   1421	{ },
   1422};
   1423MODULE_DEVICE_TABLE(i2c, elan_id);
   1424
   1425#ifdef CONFIG_ACPI
   1426#include <linux/input/elan-i2c-ids.h>
   1427MODULE_DEVICE_TABLE(acpi, elan_acpi_id);
   1428#endif
   1429
   1430#ifdef CONFIG_OF
   1431static const struct of_device_id elan_of_match[] = {
   1432	{ .compatible = "elan,ekth3000" },
   1433	{ /* sentinel */ }
   1434};
   1435MODULE_DEVICE_TABLE(of, elan_of_match);
   1436#endif
   1437
   1438static struct i2c_driver elan_driver = {
   1439	.driver = {
   1440		.name	= DRIVER_NAME,
   1441		.pm	= &elan_pm_ops,
   1442		.acpi_match_table = ACPI_PTR(elan_acpi_id),
   1443		.of_match_table = of_match_ptr(elan_of_match),
   1444		.probe_type = PROBE_PREFER_ASYNCHRONOUS,
   1445	},
   1446	.probe		= elan_probe,
   1447	.id_table	= elan_id,
   1448};
   1449
   1450module_i2c_driver(elan_driver);
   1451
   1452MODULE_AUTHOR("Duson Lin <dusonlin@emc.com.tw>");
   1453MODULE_DESCRIPTION("Elan I2C/SMBus Touchpad driver");
   1454MODULE_LICENSE("GPL");