1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 26696777cSDuson Lin /* 36696777cSDuson Lin * Elan I2C/SMBus Touchpad driver 46696777cSDuson Lin * 56696777cSDuson Lin * Copyright (c) 2013 ELAN Microelectronics Corp. 66696777cSDuson Lin * 76696777cSDuson Lin * Author: 林政維 (Duson Lin) <dusonlin@emc.com.tw> 82de4fcc6SKT Liao * Author: KT Liao <kt.liao@emc.com.tw> 9a2eaf299SKT Liao * Version: 1.6.3 106696777cSDuson Lin * 116696777cSDuson Lin * Based on cyapa driver: 126696777cSDuson Lin * copyright (c) 2011-2012 Cypress Semiconductor, Inc. 136696777cSDuson Lin * copyright (c) 2011-2012 Google, Inc. 146696777cSDuson Lin * 156696777cSDuson Lin * Trademarks are the property of their respective owners. 166696777cSDuson Lin */ 176696777cSDuson Lin 186696777cSDuson Lin #include <linux/acpi.h> 196696777cSDuson Lin #include <linux/delay.h> 206696777cSDuson Lin #include <linux/device.h> 216696777cSDuson Lin #include <linux/firmware.h> 226696777cSDuson Lin #include <linux/i2c.h> 236696777cSDuson Lin #include <linux/init.h> 246696777cSDuson Lin #include <linux/input/mt.h> 256696777cSDuson Lin #include <linux/interrupt.h> 26a4b0a58bSDmitry Torokhov #include <linux/irq.h> 276696777cSDuson Lin #include <linux/module.h> 286696777cSDuson Lin #include <linux/slab.h> 296696777cSDuson Lin #include <linux/kernel.h> 306696777cSDuson Lin #include <linux/sched.h> 316696777cSDuson Lin #include <linux/input.h> 326696777cSDuson Lin #include <linux/uaccess.h> 336696777cSDuson Lin #include <linux/jiffies.h> 346696777cSDuson Lin #include <linux/completion.h> 356696777cSDuson Lin #include <linux/of.h> 36559b3df7SBenjamin Tissoires #include <linux/property.h> 370828c100SJeffrey Hugo #include <linux/input/elan-i2c-ids.h> 386696777cSDuson Lin #include <linux/regulator/consumer.h> 396696777cSDuson Lin #include <asm/unaligned.h> 406696777cSDuson Lin 416696777cSDuson Lin #include "elan_i2c.h" 426696777cSDuson Lin 436696777cSDuson Lin #define DRIVER_NAME "elan_i2c" 443eab4588SCharlie Mooney #define ELAN_VENDOR_ID 0x04f3 456696777cSDuson Lin #define ETP_MAX_PRESSURE 255 466696777cSDuson Lin #define ETP_FWIDTH_REDUCE 90 476696777cSDuson Lin #define ETP_FINGER_WIDTH 15 486696777cSDuson Lin #define ETP_RETRY_COUNT 3 496696777cSDuson Lin 506696777cSDuson Lin #define ETP_MAX_FINGERS 5 516696777cSDuson Lin #define ETP_FINGER_DATA_LEN 5 526696777cSDuson Lin #define ETP_REPORT_ID 0x5D 53559b3df7SBenjamin Tissoires #define ETP_TP_REPORT_ID 0x5E 546696777cSDuson Lin #define ETP_REPORT_ID_OFFSET 2 556696777cSDuson Lin #define ETP_TOUCH_INFO_OFFSET 3 566696777cSDuson Lin #define ETP_FINGER_DATA_OFFSET 4 57090ad325SDuson Lin #define ETP_HOVER_INFO_OFFSET 30 586696777cSDuson Lin #define ETP_MAX_REPORT_LEN 34 596696777cSDuson Lin 606696777cSDuson Lin /* The main device structure */ 616696777cSDuson Lin struct elan_tp_data { 626696777cSDuson Lin struct i2c_client *client; 636696777cSDuson Lin struct input_dev *input; 64559b3df7SBenjamin Tissoires struct input_dev *tp_input; /* trackpoint input node */ 656696777cSDuson Lin struct regulator *vcc; 666696777cSDuson Lin 676696777cSDuson Lin const struct elan_transport_ops *ops; 686696777cSDuson Lin 696696777cSDuson Lin /* for fw update */ 706696777cSDuson Lin struct completion fw_completion; 716696777cSDuson Lin bool in_fw_update; 726696777cSDuson Lin 736696777cSDuson Lin struct mutex sysfs_mutex; 746696777cSDuson Lin 756696777cSDuson Lin unsigned int max_x; 766696777cSDuson Lin unsigned int max_y; 776696777cSDuson Lin unsigned int width_x; 786696777cSDuson Lin unsigned int width_y; 796696777cSDuson Lin unsigned int x_res; 806696777cSDuson Lin unsigned int y_res; 816696777cSDuson Lin 82a2eaf299SKT Liao u8 pattern; 83ed75a14eSDuson Lin u16 product_id; 846696777cSDuson Lin u8 fw_version; 856696777cSDuson Lin u8 sm_version; 866696777cSDuson Lin u8 iap_version; 876696777cSDuson Lin u16 fw_checksum; 88b9bced0eSduson int pressure_adjustment; 896696777cSDuson Lin u8 mode; 90a2eaf299SKT Liao u16 ic_type; 91742f452bSBenson Leung u16 fw_validpage_count; 9212018ac3SDuson Lin u16 fw_signature_address; 936696777cSDuson Lin 946696777cSDuson Lin bool irq_wake; 956696777cSDuson Lin 966696777cSDuson Lin u8 min_baseline; 976696777cSDuson Lin u8 max_baseline; 986696777cSDuson Lin bool baseline_ready; 9999136881SKT Liao u8 clickpad; 100140a7952SBenjamin Tissoires bool middle_button; 1016696777cSDuson Lin }; 1026696777cSDuson Lin 103a2eaf299SKT Liao static int elan_get_fwinfo(u16 ic_type, u16 *validpage_count, 10412018ac3SDuson Lin u16 *signature_address) 10512018ac3SDuson Lin { 106a2eaf299SKT Liao switch (ic_type) { 10722ef28b4Sduson case 0x00: 10822ef28b4Sduson case 0x06: 109534fcb3bSMichele Curti case 0x08: 110742f452bSBenson Leung *validpage_count = 512; 111534fcb3bSMichele Curti break; 112c84333a1SDuson Lin case 0x03: 11322ef28b4Sduson case 0x07: 11422ef28b4Sduson case 0x09: 11522ef28b4Sduson case 0x0A: 11622ef28b4Sduson case 0x0B: 11722ef28b4Sduson case 0x0C: 118742f452bSBenson Leung *validpage_count = 768; 11912018ac3SDuson Lin break; 12012018ac3SDuson Lin case 0x0D: 121742f452bSBenson Leung *validpage_count = 896; 12212018ac3SDuson Lin break; 12322ef28b4Sduson case 0x0E: 12422ef28b4Sduson *validpage_count = 640; 12522ef28b4Sduson break; 126a2eaf299SKT Liao case 0x10: 127a2eaf299SKT Liao *validpage_count = 1024; 128a2eaf299SKT Liao break; 12912018ac3SDuson Lin default: 13012018ac3SDuson Lin /* unknown ic type clear value */ 131742f452bSBenson Leung *validpage_count = 0; 13212018ac3SDuson Lin *signature_address = 0; 13312018ac3SDuson Lin return -ENXIO; 13412018ac3SDuson Lin } 13512018ac3SDuson Lin 13612018ac3SDuson Lin *signature_address = 137742f452bSBenson Leung (*validpage_count * ETP_FW_PAGE_SIZE) - ETP_FW_SIGNATURE_SIZE; 13812018ac3SDuson Lin 13912018ac3SDuson Lin return 0; 14012018ac3SDuson Lin } 14112018ac3SDuson Lin 1426696777cSDuson Lin static int elan_enable_power(struct elan_tp_data *data) 1436696777cSDuson Lin { 1446696777cSDuson Lin int repeat = ETP_RETRY_COUNT; 1456696777cSDuson Lin int error; 1466696777cSDuson Lin 1476696777cSDuson Lin error = regulator_enable(data->vcc); 1486696777cSDuson Lin if (error) { 1496696777cSDuson Lin dev_err(&data->client->dev, 150b3beed7fSDuson Lin "failed to enable regulator: %d\n", error); 1516696777cSDuson Lin return error; 1526696777cSDuson Lin } 1536696777cSDuson Lin 1546696777cSDuson Lin do { 1556696777cSDuson Lin error = data->ops->power_control(data->client, true); 1566696777cSDuson Lin if (error >= 0) 1576696777cSDuson Lin return 0; 1586696777cSDuson Lin 1596696777cSDuson Lin msleep(30); 1606696777cSDuson Lin } while (--repeat > 0); 1616696777cSDuson Lin 162b3beed7fSDuson Lin dev_err(&data->client->dev, "failed to enable power: %d\n", error); 1636696777cSDuson Lin return error; 1646696777cSDuson Lin } 1656696777cSDuson Lin 1666696777cSDuson Lin static int elan_disable_power(struct elan_tp_data *data) 1676696777cSDuson Lin { 1686696777cSDuson Lin int repeat = ETP_RETRY_COUNT; 1696696777cSDuson Lin int error; 1706696777cSDuson Lin 1716696777cSDuson Lin do { 1726696777cSDuson Lin error = data->ops->power_control(data->client, false); 1736696777cSDuson Lin if (!error) { 1746696777cSDuson Lin error = regulator_disable(data->vcc); 1756696777cSDuson Lin if (error) { 1766696777cSDuson Lin dev_err(&data->client->dev, 177b3beed7fSDuson Lin "failed to disable regulator: %d\n", 1786696777cSDuson Lin error); 1796696777cSDuson Lin /* Attempt to power the chip back up */ 1806696777cSDuson Lin data->ops->power_control(data->client, true); 1816696777cSDuson Lin break; 1826696777cSDuson Lin } 1836696777cSDuson Lin 1846696777cSDuson Lin return 0; 1856696777cSDuson Lin } 1866696777cSDuson Lin 1876696777cSDuson Lin msleep(30); 1886696777cSDuson Lin } while (--repeat > 0); 1896696777cSDuson Lin 190b3beed7fSDuson Lin dev_err(&data->client->dev, "failed to disable power: %d\n", error); 1916696777cSDuson Lin return error; 1926696777cSDuson Lin } 1936696777cSDuson Lin 1946696777cSDuson Lin static int elan_sleep(struct elan_tp_data *data) 1956696777cSDuson Lin { 1966696777cSDuson Lin int repeat = ETP_RETRY_COUNT; 1976696777cSDuson Lin int error; 1986696777cSDuson Lin 1996696777cSDuson Lin do { 2006696777cSDuson Lin error = data->ops->sleep_control(data->client, true); 2016696777cSDuson Lin if (!error) 2026696777cSDuson Lin return 0; 2036696777cSDuson Lin 2046696777cSDuson Lin msleep(30); 2056696777cSDuson Lin } while (--repeat > 0); 2066696777cSDuson Lin 2076696777cSDuson Lin return error; 2086696777cSDuson Lin } 2096696777cSDuson Lin 2102de4fcc6SKT Liao static int elan_query_product(struct elan_tp_data *data) 2112de4fcc6SKT Liao { 2122de4fcc6SKT Liao int error; 2132de4fcc6SKT Liao 2142de4fcc6SKT Liao error = data->ops->get_product_id(data->client, &data->product_id); 2152de4fcc6SKT Liao if (error) 2162de4fcc6SKT Liao return error; 2172de4fcc6SKT Liao 2182de4fcc6SKT Liao error = data->ops->get_sm_version(data->client, &data->ic_type, 21999136881SKT Liao &data->sm_version, &data->clickpad); 2202de4fcc6SKT Liao if (error) 2212de4fcc6SKT Liao return error; 2222de4fcc6SKT Liao 2232de4fcc6SKT Liao return 0; 2242de4fcc6SKT Liao } 2252de4fcc6SKT Liao 2262de4fcc6SKT Liao static int elan_check_ASUS_special_fw(struct elan_tp_data *data) 2272de4fcc6SKT Liao { 22892ef6f97SMatjaz Hegedic if (data->ic_type == 0x0E) { 2292de4fcc6SKT Liao switch (data->product_id) { 2302de4fcc6SKT Liao case 0x05 ... 0x07: 2312de4fcc6SKT Liao case 0x09: 2322de4fcc6SKT Liao case 0x13: 2332de4fcc6SKT Liao return true; 2342de4fcc6SKT Liao } 23592ef6f97SMatjaz Hegedic } else if (data->ic_type == 0x08 && data->product_id == 0x26) { 23692ef6f97SMatjaz Hegedic /* ASUS EeeBook X205TA */ 23792ef6f97SMatjaz Hegedic return true; 23892ef6f97SMatjaz Hegedic } 23992ef6f97SMatjaz Hegedic 24092ef6f97SMatjaz Hegedic return false; 2412de4fcc6SKT Liao } 2422de4fcc6SKT Liao 2436696777cSDuson Lin static int __elan_initialize(struct elan_tp_data *data) 2446696777cSDuson Lin { 2456696777cSDuson Lin struct i2c_client *client = data->client; 2462de4fcc6SKT Liao bool woken_up = false; 2476696777cSDuson Lin int error; 2486696777cSDuson Lin 2496696777cSDuson Lin error = data->ops->initialize(client); 2506696777cSDuson Lin if (error) { 2516696777cSDuson Lin dev_err(&client->dev, "device initialize failed: %d\n", error); 2526696777cSDuson Lin return error; 2536696777cSDuson Lin } 2546696777cSDuson Lin 2552de4fcc6SKT Liao error = elan_query_product(data); 2562de4fcc6SKT Liao if (error) 2572de4fcc6SKT Liao return error; 2582de4fcc6SKT Liao 2592de4fcc6SKT Liao /* 2602de4fcc6SKT Liao * Some ASUS devices were shipped with firmware that requires 2612de4fcc6SKT Liao * touchpads to be woken up first, before attempting to switch 2622de4fcc6SKT Liao * them into absolute reporting mode. 2632de4fcc6SKT Liao */ 2642de4fcc6SKT Liao if (elan_check_ASUS_special_fw(data)) { 2652de4fcc6SKT Liao error = data->ops->sleep_control(client, false); 2662de4fcc6SKT Liao if (error) { 2672de4fcc6SKT Liao dev_err(&client->dev, 2682de4fcc6SKT Liao "failed to wake device up: %d\n", error); 2692de4fcc6SKT Liao return error; 2702de4fcc6SKT Liao } 2712de4fcc6SKT Liao 2722de4fcc6SKT Liao msleep(200); 2732de4fcc6SKT Liao woken_up = true; 2742de4fcc6SKT Liao } 2752de4fcc6SKT Liao 2766696777cSDuson Lin data->mode |= ETP_ENABLE_ABS; 2776696777cSDuson Lin error = data->ops->set_mode(client, data->mode); 2786696777cSDuson Lin if (error) { 2796696777cSDuson Lin dev_err(&client->dev, 2806696777cSDuson Lin "failed to switch to absolute mode: %d\n", error); 2816696777cSDuson Lin return error; 2826696777cSDuson Lin } 2836696777cSDuson Lin 2842de4fcc6SKT Liao if (!woken_up) { 2856696777cSDuson Lin error = data->ops->sleep_control(client, false); 2866696777cSDuson Lin if (error) { 2876696777cSDuson Lin dev_err(&client->dev, 2886696777cSDuson Lin "failed to wake device up: %d\n", error); 2896696777cSDuson Lin return error; 2906696777cSDuson Lin } 2912de4fcc6SKT Liao } 2926696777cSDuson Lin 2936696777cSDuson Lin return 0; 2946696777cSDuson Lin } 2956696777cSDuson Lin 2966696777cSDuson Lin static int elan_initialize(struct elan_tp_data *data) 2976696777cSDuson Lin { 2986696777cSDuson Lin int repeat = ETP_RETRY_COUNT; 2996696777cSDuson Lin int error; 3006696777cSDuson Lin 3016696777cSDuson Lin do { 3026696777cSDuson Lin error = __elan_initialize(data); 3036696777cSDuson Lin if (!error) 3046696777cSDuson Lin return 0; 3056696777cSDuson Lin 3066696777cSDuson Lin msleep(30); 3076696777cSDuson Lin } while (--repeat > 0); 3086696777cSDuson Lin 3096696777cSDuson Lin return error; 3106696777cSDuson Lin } 3116696777cSDuson Lin 3126696777cSDuson Lin static int elan_query_device_info(struct elan_tp_data *data) 3136696777cSDuson Lin { 3146696777cSDuson Lin int error; 315a2eaf299SKT Liao u16 ic_type; 3166696777cSDuson Lin 3176696777cSDuson Lin error = data->ops->get_version(data->client, false, &data->fw_version); 3186696777cSDuson Lin if (error) 3196696777cSDuson Lin return error; 3206696777cSDuson Lin 3216696777cSDuson Lin error = data->ops->get_checksum(data->client, false, 3226696777cSDuson Lin &data->fw_checksum); 3236696777cSDuson Lin if (error) 3246696777cSDuson Lin return error; 3256696777cSDuson Lin 3266696777cSDuson Lin error = data->ops->get_version(data->client, true, &data->iap_version); 3276696777cSDuson Lin if (error) 3286696777cSDuson Lin return error; 3296696777cSDuson Lin 330b9bced0eSduson error = data->ops->get_pressure_adjustment(data->client, 331b9bced0eSduson &data->pressure_adjustment); 332b9bced0eSduson if (error) 333b9bced0eSduson return error; 334b9bced0eSduson 335a2eaf299SKT Liao error = data->ops->get_pattern(data->client, &data->pattern); 336a2eaf299SKT Liao if (error) 337a2eaf299SKT Liao return error; 338a2eaf299SKT Liao 339a2eaf299SKT Liao if (data->pattern == 0x01) 340a2eaf299SKT Liao ic_type = data->ic_type; 341a2eaf299SKT Liao else 342a2eaf299SKT Liao ic_type = data->iap_version; 343a2eaf299SKT Liao 344a2eaf299SKT Liao error = elan_get_fwinfo(ic_type, &data->fw_validpage_count, 34512018ac3SDuson Lin &data->fw_signature_address); 3469d7b03f8SDaniel Drake if (error) 3479d7b03f8SDaniel Drake dev_warn(&data->client->dev, 3489d7b03f8SDaniel Drake "unexpected iap version %#04x (ic type: %#04x), firmware update will not work\n", 3499d7b03f8SDaniel Drake data->iap_version, data->ic_type); 35012018ac3SDuson Lin 3516696777cSDuson Lin return 0; 3526696777cSDuson Lin } 3536696777cSDuson Lin 3546696777cSDuson Lin static unsigned int elan_convert_resolution(u8 val) 3556696777cSDuson Lin { 3566696777cSDuson Lin /* 3576696777cSDuson Lin * (value from firmware) * 10 + 790 = dpi 3586696777cSDuson Lin * 3596696777cSDuson Lin * We also have to convert dpi to dots/mm (*10/254 to avoid floating 3606696777cSDuson Lin * point). 3616696777cSDuson Lin */ 3626696777cSDuson Lin 3636696777cSDuson Lin return ((int)(char)val * 10 + 790) * 10 / 254; 3646696777cSDuson Lin } 3656696777cSDuson Lin 3666696777cSDuson Lin static int elan_query_device_parameters(struct elan_tp_data *data) 3676696777cSDuson Lin { 368e3a9a129SBenjamin Tissoires struct i2c_client *client = data->client; 3696696777cSDuson Lin unsigned int x_traces, y_traces; 370e3a9a129SBenjamin Tissoires u32 x_mm, y_mm; 3716696777cSDuson Lin u8 hw_x_res, hw_y_res; 3726696777cSDuson Lin int error; 3736696777cSDuson Lin 374e3a9a129SBenjamin Tissoires if (device_property_read_u32(&client->dev, 375e3a9a129SBenjamin Tissoires "touchscreen-size-x", &data->max_x) || 376e3a9a129SBenjamin Tissoires device_property_read_u32(&client->dev, 377e3a9a129SBenjamin Tissoires "touchscreen-size-y", &data->max_y)) { 378e3a9a129SBenjamin Tissoires error = data->ops->get_max(data->client, 379e3a9a129SBenjamin Tissoires &data->max_x, 380e3a9a129SBenjamin Tissoires &data->max_y); 3816696777cSDuson Lin if (error) 3826696777cSDuson Lin return error; 383e3a9a129SBenjamin Tissoires } else { 384e3a9a129SBenjamin Tissoires /* size is the maximum + 1 */ 385e3a9a129SBenjamin Tissoires --data->max_x; 386e3a9a129SBenjamin Tissoires --data->max_y; 387e3a9a129SBenjamin Tissoires } 3886696777cSDuson Lin 389e3a9a129SBenjamin Tissoires if (device_property_read_u32(&client->dev, 390e3a9a129SBenjamin Tissoires "elan,x_traces", 391e3a9a129SBenjamin Tissoires &x_traces) || 392e3a9a129SBenjamin Tissoires device_property_read_u32(&client->dev, 393e3a9a129SBenjamin Tissoires "elan,y_traces", 394e3a9a129SBenjamin Tissoires &y_traces)) { 395e3a9a129SBenjamin Tissoires error = data->ops->get_num_traces(data->client, 396e3a9a129SBenjamin Tissoires &x_traces, &y_traces); 3976696777cSDuson Lin if (error) 3986696777cSDuson Lin return error; 399e3a9a129SBenjamin Tissoires } 4006696777cSDuson Lin data->width_x = data->max_x / x_traces; 4016696777cSDuson Lin data->width_y = data->max_y / y_traces; 4026696777cSDuson Lin 403e3a9a129SBenjamin Tissoires if (device_property_read_u32(&client->dev, 404e3a9a129SBenjamin Tissoires "touchscreen-x-mm", &x_mm) || 405e3a9a129SBenjamin Tissoires device_property_read_u32(&client->dev, 406e3a9a129SBenjamin Tissoires "touchscreen-y-mm", &y_mm)) { 407e3a9a129SBenjamin Tissoires error = data->ops->get_resolution(data->client, 408e3a9a129SBenjamin Tissoires &hw_x_res, &hw_y_res); 4096696777cSDuson Lin if (error) 4106696777cSDuson Lin return error; 4116696777cSDuson Lin 4126696777cSDuson Lin data->x_res = elan_convert_resolution(hw_x_res); 4136696777cSDuson Lin data->y_res = elan_convert_resolution(hw_y_res); 414e3a9a129SBenjamin Tissoires } else { 415e3a9a129SBenjamin Tissoires data->x_res = (data->max_x + 1) / x_mm; 416e3a9a129SBenjamin Tissoires data->y_res = (data->max_y + 1) / y_mm; 417e3a9a129SBenjamin Tissoires } 418e3a9a129SBenjamin Tissoires 419e3a9a129SBenjamin Tissoires if (device_property_read_bool(&client->dev, "elan,clickpad")) 420e3a9a129SBenjamin Tissoires data->clickpad = 1; 4216696777cSDuson Lin 422140a7952SBenjamin Tissoires if (device_property_read_bool(&client->dev, "elan,middle-button")) 423140a7952SBenjamin Tissoires data->middle_button = true; 424140a7952SBenjamin Tissoires 4256696777cSDuson Lin return 0; 4266696777cSDuson Lin } 4276696777cSDuson Lin 4286696777cSDuson Lin /* 4296696777cSDuson Lin ********************************************************** 4306696777cSDuson Lin * IAP firmware updater related routines 4316696777cSDuson Lin ********************************************************** 4326696777cSDuson Lin */ 4336696777cSDuson Lin static int elan_write_fw_block(struct elan_tp_data *data, 4346696777cSDuson Lin const u8 *page, u16 checksum, int idx) 4356696777cSDuson Lin { 4366696777cSDuson Lin int retry = ETP_RETRY_COUNT; 4376696777cSDuson Lin int error; 4386696777cSDuson Lin 4396696777cSDuson Lin do { 4406696777cSDuson Lin error = data->ops->write_fw_block(data->client, 4416696777cSDuson Lin page, checksum, idx); 4426696777cSDuson Lin if (!error) 4436696777cSDuson Lin return 0; 4446696777cSDuson Lin 4456696777cSDuson Lin dev_dbg(&data->client->dev, 4466696777cSDuson Lin "IAP retrying page %d (error: %d)\n", idx, error); 4476696777cSDuson Lin } while (--retry > 0); 4486696777cSDuson Lin 4496696777cSDuson Lin return error; 4506696777cSDuson Lin } 4516696777cSDuson Lin 4526696777cSDuson Lin static int __elan_update_firmware(struct elan_tp_data *data, 4536696777cSDuson Lin const struct firmware *fw) 4546696777cSDuson Lin { 4556696777cSDuson Lin struct i2c_client *client = data->client; 4566696777cSDuson Lin struct device *dev = &client->dev; 4576696777cSDuson Lin int i, j; 4586696777cSDuson Lin int error; 4596696777cSDuson Lin u16 iap_start_addr; 4606696777cSDuson Lin u16 boot_page_count; 4616696777cSDuson Lin u16 sw_checksum = 0, fw_checksum = 0; 4626696777cSDuson Lin 4636696777cSDuson Lin error = data->ops->prepare_fw_update(client); 4646696777cSDuson Lin if (error) 4656696777cSDuson Lin return error; 4666696777cSDuson Lin 4676696777cSDuson Lin iap_start_addr = get_unaligned_le16(&fw->data[ETP_IAP_START_ADDR * 2]); 4686696777cSDuson Lin 4696696777cSDuson Lin boot_page_count = (iap_start_addr * 2) / ETP_FW_PAGE_SIZE; 470742f452bSBenson Leung for (i = boot_page_count; i < data->fw_validpage_count; i++) { 4716696777cSDuson Lin u16 checksum = 0; 4726696777cSDuson Lin const u8 *page = &fw->data[i * ETP_FW_PAGE_SIZE]; 4736696777cSDuson Lin 4746696777cSDuson Lin for (j = 0; j < ETP_FW_PAGE_SIZE; j += 2) 4756696777cSDuson Lin checksum += ((page[j + 1] << 8) | page[j]); 4766696777cSDuson Lin 4776696777cSDuson Lin error = elan_write_fw_block(data, page, checksum, i); 4786696777cSDuson Lin if (error) { 4796696777cSDuson Lin dev_err(dev, "write page %d fail: %d\n", i, error); 4806696777cSDuson Lin return error; 4816696777cSDuson Lin } 4826696777cSDuson Lin 4836696777cSDuson Lin sw_checksum += checksum; 4846696777cSDuson Lin } 4856696777cSDuson Lin 4866696777cSDuson Lin /* Wait WDT reset and power on reset */ 4876696777cSDuson Lin msleep(600); 4886696777cSDuson Lin 4896696777cSDuson Lin error = data->ops->finish_fw_update(client, &data->fw_completion); 4906696777cSDuson Lin if (error) 4916696777cSDuson Lin return error; 4926696777cSDuson Lin 4936696777cSDuson Lin error = data->ops->get_checksum(client, true, &fw_checksum); 4946696777cSDuson Lin if (error) 4956696777cSDuson Lin return error; 4966696777cSDuson Lin 4976696777cSDuson Lin if (sw_checksum != fw_checksum) { 4986696777cSDuson Lin dev_err(dev, "checksum diff sw=[%04X], fw=[%04X]\n", 4996696777cSDuson Lin sw_checksum, fw_checksum); 5006696777cSDuson Lin return -EIO; 5016696777cSDuson Lin } 5026696777cSDuson Lin 5036696777cSDuson Lin return 0; 5046696777cSDuson Lin } 5056696777cSDuson Lin 5066696777cSDuson Lin static int elan_update_firmware(struct elan_tp_data *data, 5076696777cSDuson Lin const struct firmware *fw) 5086696777cSDuson Lin { 5096696777cSDuson Lin struct i2c_client *client = data->client; 5106696777cSDuson Lin int retval; 5116696777cSDuson Lin 5126696777cSDuson Lin dev_dbg(&client->dev, "Starting firmware update....\n"); 5136696777cSDuson Lin 5146696777cSDuson Lin disable_irq(client->irq); 5156696777cSDuson Lin data->in_fw_update = true; 5166696777cSDuson Lin 5176696777cSDuson Lin retval = __elan_update_firmware(data, fw); 5186696777cSDuson Lin if (retval) { 5196696777cSDuson Lin dev_err(&client->dev, "firmware update failed: %d\n", retval); 5206696777cSDuson Lin data->ops->iap_reset(client); 5216696777cSDuson Lin } else { 5226696777cSDuson Lin /* Reinitialize TP after fw is updated */ 5236696777cSDuson Lin elan_initialize(data); 5246696777cSDuson Lin elan_query_device_info(data); 5256696777cSDuson Lin } 5266696777cSDuson Lin 5276696777cSDuson Lin data->in_fw_update = false; 5286696777cSDuson Lin enable_irq(client->irq); 5296696777cSDuson Lin 5306696777cSDuson Lin return retval; 5316696777cSDuson Lin } 5326696777cSDuson Lin 5336696777cSDuson Lin /* 5346696777cSDuson Lin ******************************************************************* 5356696777cSDuson Lin * SYSFS attributes 5366696777cSDuson Lin ******************************************************************* 5376696777cSDuson Lin */ 5386696777cSDuson Lin static ssize_t elan_sysfs_read_fw_checksum(struct device *dev, 5396696777cSDuson Lin struct device_attribute *attr, 5406696777cSDuson Lin char *buf) 5416696777cSDuson Lin { 5426696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 5436696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 5446696777cSDuson Lin 5456696777cSDuson Lin return sprintf(buf, "0x%04x\n", data->fw_checksum); 5466696777cSDuson Lin } 5476696777cSDuson Lin 5486696777cSDuson Lin static ssize_t elan_sysfs_read_product_id(struct device *dev, 5496696777cSDuson Lin struct device_attribute *attr, 5506696777cSDuson Lin char *buf) 5516696777cSDuson Lin { 5526696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 5536696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 5546696777cSDuson Lin 5557b9f1830SCharlie Mooney return sprintf(buf, ETP_PRODUCT_ID_FORMAT_STRING "\n", 5567b9f1830SCharlie Mooney data->product_id); 5576696777cSDuson Lin } 5586696777cSDuson Lin 5596696777cSDuson Lin static ssize_t elan_sysfs_read_fw_ver(struct device *dev, 5606696777cSDuson Lin struct device_attribute *attr, 5616696777cSDuson Lin char *buf) 5626696777cSDuson Lin { 5636696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 5646696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 5656696777cSDuson Lin 5666696777cSDuson Lin return sprintf(buf, "%d.0\n", data->fw_version); 5676696777cSDuson Lin } 5686696777cSDuson Lin 5696696777cSDuson Lin static ssize_t elan_sysfs_read_sm_ver(struct device *dev, 5706696777cSDuson Lin struct device_attribute *attr, 5716696777cSDuson Lin char *buf) 5726696777cSDuson Lin { 5736696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 5746696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 5756696777cSDuson Lin 5766696777cSDuson Lin return sprintf(buf, "%d.0\n", data->sm_version); 5776696777cSDuson Lin } 5786696777cSDuson Lin 5796696777cSDuson Lin static ssize_t elan_sysfs_read_iap_ver(struct device *dev, 5806696777cSDuson Lin struct device_attribute *attr, 5816696777cSDuson Lin char *buf) 5826696777cSDuson Lin { 5836696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 5846696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 5856696777cSDuson Lin 5866696777cSDuson Lin return sprintf(buf, "%d.0\n", data->iap_version); 5876696777cSDuson Lin } 5886696777cSDuson Lin 5896696777cSDuson Lin static ssize_t elan_sysfs_update_fw(struct device *dev, 5906696777cSDuson Lin struct device_attribute *attr, 5916696777cSDuson Lin const char *buf, size_t count) 5926696777cSDuson Lin { 593bb03bf3fSDuson Lin struct elan_tp_data *data = dev_get_drvdata(dev); 5946696777cSDuson Lin const struct firmware *fw; 5957b9f1830SCharlie Mooney char *fw_name; 5966696777cSDuson Lin int error; 597bb03bf3fSDuson Lin const u8 *fw_signature; 598bb03bf3fSDuson Lin static const u8 signature[] = {0xAA, 0x55, 0xCC, 0x33, 0xFF, 0xFF}; 5996696777cSDuson Lin 6009d7b03f8SDaniel Drake if (data->fw_validpage_count == 0) 6019d7b03f8SDaniel Drake return -EINVAL; 6029d7b03f8SDaniel Drake 6037b9f1830SCharlie Mooney /* Look for a firmware with the product id appended. */ 6047b9f1830SCharlie Mooney fw_name = kasprintf(GFP_KERNEL, ETP_FW_NAME, data->product_id); 6057b9f1830SCharlie Mooney if (!fw_name) { 6067b9f1830SCharlie Mooney dev_err(dev, "failed to allocate memory for firmware name\n"); 6077b9f1830SCharlie Mooney return -ENOMEM; 6087b9f1830SCharlie Mooney } 6097b9f1830SCharlie Mooney 6107b9f1830SCharlie Mooney dev_info(dev, "requesting fw '%s'\n", fw_name); 6117b9f1830SCharlie Mooney error = request_firmware(&fw, fw_name, dev); 6127b9f1830SCharlie Mooney kfree(fw_name); 6136696777cSDuson Lin if (error) { 6147b9f1830SCharlie Mooney dev_err(dev, "failed to request firmware: %d\n", error); 6156696777cSDuson Lin return error; 6166696777cSDuson Lin } 6176696777cSDuson Lin 618bb03bf3fSDuson Lin /* Firmware file must match signature data */ 61912018ac3SDuson Lin fw_signature = &fw->data[data->fw_signature_address]; 620bb03bf3fSDuson Lin if (memcmp(fw_signature, signature, sizeof(signature)) != 0) { 621bb03bf3fSDuson Lin dev_err(dev, "signature mismatch (expected %*ph, got %*ph)\n", 622bb03bf3fSDuson Lin (int)sizeof(signature), signature, 623bb03bf3fSDuson Lin (int)sizeof(signature), fw_signature); 6246696777cSDuson Lin error = -EBADF; 6256696777cSDuson Lin goto out_release_fw; 6266696777cSDuson Lin } 6276696777cSDuson Lin 6286696777cSDuson Lin error = mutex_lock_interruptible(&data->sysfs_mutex); 6296696777cSDuson Lin if (error) 6306696777cSDuson Lin goto out_release_fw; 6316696777cSDuson Lin 6326696777cSDuson Lin error = elan_update_firmware(data, fw); 6336696777cSDuson Lin 6346696777cSDuson Lin mutex_unlock(&data->sysfs_mutex); 6356696777cSDuson Lin 6366696777cSDuson Lin out_release_fw: 6376696777cSDuson Lin release_firmware(fw); 6386696777cSDuson Lin return error ?: count; 6396696777cSDuson Lin } 6406696777cSDuson Lin 6416696777cSDuson Lin static ssize_t calibrate_store(struct device *dev, 6426696777cSDuson Lin struct device_attribute *attr, 6436696777cSDuson Lin const char *buf, size_t count) 6446696777cSDuson Lin { 6456696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 6466696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 6476696777cSDuson Lin int tries = 20; 6486696777cSDuson Lin int retval; 6496696777cSDuson Lin int error; 65050fc7b61SBen Hutchings u8 val[ETP_CALIBRATE_MAX_LEN]; 6516696777cSDuson Lin 6526696777cSDuson Lin retval = mutex_lock_interruptible(&data->sysfs_mutex); 6536696777cSDuson Lin if (retval) 6546696777cSDuson Lin return retval; 6556696777cSDuson Lin 6566696777cSDuson Lin disable_irq(client->irq); 6576696777cSDuson Lin 6586696777cSDuson Lin data->mode |= ETP_ENABLE_CALIBRATE; 6596696777cSDuson Lin retval = data->ops->set_mode(client, data->mode); 6606696777cSDuson Lin if (retval) { 6616696777cSDuson Lin dev_err(dev, "failed to enable calibration mode: %d\n", 6626696777cSDuson Lin retval); 6636696777cSDuson Lin goto out; 6646696777cSDuson Lin } 6656696777cSDuson Lin 6666696777cSDuson Lin retval = data->ops->calibrate(client); 6676696777cSDuson Lin if (retval) { 6686696777cSDuson Lin dev_err(dev, "failed to start calibration: %d\n", 6696696777cSDuson Lin retval); 6706696777cSDuson Lin goto out_disable_calibrate; 6716696777cSDuson Lin } 6726696777cSDuson Lin 6736696777cSDuson Lin val[0] = 0xff; 6746696777cSDuson Lin do { 6756696777cSDuson Lin /* Wait 250ms before checking if calibration has completed. */ 6766696777cSDuson Lin msleep(250); 6776696777cSDuson Lin 6786696777cSDuson Lin retval = data->ops->calibrate_result(client, val); 6796696777cSDuson Lin if (retval) 6806696777cSDuson Lin dev_err(dev, "failed to check calibration result: %d\n", 6816696777cSDuson Lin retval); 6826696777cSDuson Lin else if (val[0] == 0) 6836696777cSDuson Lin break; /* calibration done */ 6846696777cSDuson Lin 6856696777cSDuson Lin } while (--tries); 6866696777cSDuson Lin 6876696777cSDuson Lin if (tries == 0) { 6886696777cSDuson Lin dev_err(dev, "failed to calibrate. Timeout.\n"); 6896696777cSDuson Lin retval = -ETIMEDOUT; 6906696777cSDuson Lin } 6916696777cSDuson Lin 6926696777cSDuson Lin out_disable_calibrate: 6936696777cSDuson Lin data->mode &= ~ETP_ENABLE_CALIBRATE; 6946696777cSDuson Lin error = data->ops->set_mode(data->client, data->mode); 6956696777cSDuson Lin if (error) { 6966696777cSDuson Lin dev_err(dev, "failed to disable calibration mode: %d\n", 6976696777cSDuson Lin error); 6986696777cSDuson Lin if (!retval) 6996696777cSDuson Lin retval = error; 7006696777cSDuson Lin } 7016696777cSDuson Lin out: 7026696777cSDuson Lin enable_irq(client->irq); 7036696777cSDuson Lin mutex_unlock(&data->sysfs_mutex); 7046696777cSDuson Lin return retval ?: count; 7056696777cSDuson Lin } 7066696777cSDuson Lin 7076696777cSDuson Lin static ssize_t elan_sysfs_read_mode(struct device *dev, 7086696777cSDuson Lin struct device_attribute *attr, 7096696777cSDuson Lin char *buf) 7106696777cSDuson Lin { 7116696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 7126696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 7136696777cSDuson Lin int error; 7146696777cSDuson Lin enum tp_mode mode; 7156696777cSDuson Lin 7166696777cSDuson Lin error = mutex_lock_interruptible(&data->sysfs_mutex); 7176696777cSDuson Lin if (error) 7186696777cSDuson Lin return error; 7196696777cSDuson Lin 7206696777cSDuson Lin error = data->ops->iap_get_mode(data->client, &mode); 7216696777cSDuson Lin 7226696777cSDuson Lin mutex_unlock(&data->sysfs_mutex); 7236696777cSDuson Lin 7246696777cSDuson Lin if (error) 7256696777cSDuson Lin return error; 7266696777cSDuson Lin 7276696777cSDuson Lin return sprintf(buf, "%d\n", (int)mode); 7286696777cSDuson Lin } 7296696777cSDuson Lin 7306696777cSDuson Lin static DEVICE_ATTR(product_id, S_IRUGO, elan_sysfs_read_product_id, NULL); 7316696777cSDuson Lin static DEVICE_ATTR(firmware_version, S_IRUGO, elan_sysfs_read_fw_ver, NULL); 7326696777cSDuson Lin static DEVICE_ATTR(sample_version, S_IRUGO, elan_sysfs_read_sm_ver, NULL); 7336696777cSDuson Lin static DEVICE_ATTR(iap_version, S_IRUGO, elan_sysfs_read_iap_ver, NULL); 7346696777cSDuson Lin static DEVICE_ATTR(fw_checksum, S_IRUGO, elan_sysfs_read_fw_checksum, NULL); 7356696777cSDuson Lin static DEVICE_ATTR(mode, S_IRUGO, elan_sysfs_read_mode, NULL); 7366696777cSDuson Lin static DEVICE_ATTR(update_fw, S_IWUSR, NULL, elan_sysfs_update_fw); 7376696777cSDuson Lin 7386696777cSDuson Lin static DEVICE_ATTR_WO(calibrate); 7396696777cSDuson Lin 7406696777cSDuson Lin static struct attribute *elan_sysfs_entries[] = { 7416696777cSDuson Lin &dev_attr_product_id.attr, 7426696777cSDuson Lin &dev_attr_firmware_version.attr, 7436696777cSDuson Lin &dev_attr_sample_version.attr, 7446696777cSDuson Lin &dev_attr_iap_version.attr, 7456696777cSDuson Lin &dev_attr_fw_checksum.attr, 7466696777cSDuson Lin &dev_attr_calibrate.attr, 7476696777cSDuson Lin &dev_attr_mode.attr, 7486696777cSDuson Lin &dev_attr_update_fw.attr, 7496696777cSDuson Lin NULL, 7506696777cSDuson Lin }; 7516696777cSDuson Lin 7526696777cSDuson Lin static const struct attribute_group elan_sysfs_group = { 7536696777cSDuson Lin .attrs = elan_sysfs_entries, 7546696777cSDuson Lin }; 7556696777cSDuson Lin 7566696777cSDuson Lin static ssize_t acquire_store(struct device *dev, struct device_attribute *attr, 7576696777cSDuson Lin const char *buf, size_t count) 7586696777cSDuson Lin { 7596696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 7606696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 7616696777cSDuson Lin int error; 7626696777cSDuson Lin int retval; 7636696777cSDuson Lin 7646696777cSDuson Lin retval = mutex_lock_interruptible(&data->sysfs_mutex); 7656696777cSDuson Lin if (retval) 7666696777cSDuson Lin return retval; 7676696777cSDuson Lin 7686696777cSDuson Lin disable_irq(client->irq); 7696696777cSDuson Lin 7706696777cSDuson Lin data->baseline_ready = false; 7716696777cSDuson Lin 7726696777cSDuson Lin data->mode |= ETP_ENABLE_CALIBRATE; 7736696777cSDuson Lin retval = data->ops->set_mode(data->client, data->mode); 7746696777cSDuson Lin if (retval) { 7756696777cSDuson Lin dev_err(dev, "Failed to enable calibration mode to get baseline: %d\n", 7766696777cSDuson Lin retval); 7776696777cSDuson Lin goto out; 7786696777cSDuson Lin } 7796696777cSDuson Lin 7806696777cSDuson Lin msleep(250); 7816696777cSDuson Lin 7826696777cSDuson Lin retval = data->ops->get_baseline_data(data->client, true, 7836696777cSDuson Lin &data->max_baseline); 7846696777cSDuson Lin if (retval) { 7856696777cSDuson Lin dev_err(dev, "Failed to read max baseline form device: %d\n", 7866696777cSDuson Lin retval); 7876696777cSDuson Lin goto out_disable_calibrate; 7886696777cSDuson Lin } 7896696777cSDuson Lin 7906696777cSDuson Lin retval = data->ops->get_baseline_data(data->client, false, 7916696777cSDuson Lin &data->min_baseline); 7926696777cSDuson Lin if (retval) { 7936696777cSDuson Lin dev_err(dev, "Failed to read min baseline form device: %d\n", 7946696777cSDuson Lin retval); 7956696777cSDuson Lin goto out_disable_calibrate; 7966696777cSDuson Lin } 7976696777cSDuson Lin 7986696777cSDuson Lin data->baseline_ready = true; 7996696777cSDuson Lin 8006696777cSDuson Lin out_disable_calibrate: 8016696777cSDuson Lin data->mode &= ~ETP_ENABLE_CALIBRATE; 8026696777cSDuson Lin error = data->ops->set_mode(data->client, data->mode); 8036696777cSDuson Lin if (error) { 8046696777cSDuson Lin dev_err(dev, "Failed to disable calibration mode after acquiring baseline: %d\n", 8056696777cSDuson Lin error); 8066696777cSDuson Lin if (!retval) 8076696777cSDuson Lin retval = error; 8086696777cSDuson Lin } 8096696777cSDuson Lin out: 8106696777cSDuson Lin enable_irq(client->irq); 8116696777cSDuson Lin mutex_unlock(&data->sysfs_mutex); 8126696777cSDuson Lin return retval ?: count; 8136696777cSDuson Lin } 8146696777cSDuson Lin 8156696777cSDuson Lin static ssize_t min_show(struct device *dev, 8166696777cSDuson Lin struct device_attribute *attr, char *buf) 8176696777cSDuson Lin { 8186696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 8196696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 8206696777cSDuson Lin int retval; 8216696777cSDuson Lin 8226696777cSDuson Lin retval = mutex_lock_interruptible(&data->sysfs_mutex); 8236696777cSDuson Lin if (retval) 8246696777cSDuson Lin return retval; 8256696777cSDuson Lin 8266696777cSDuson Lin if (!data->baseline_ready) { 8276696777cSDuson Lin retval = -ENODATA; 8286696777cSDuson Lin goto out; 8296696777cSDuson Lin } 8306696777cSDuson Lin 8316696777cSDuson Lin retval = snprintf(buf, PAGE_SIZE, "%d", data->min_baseline); 8326696777cSDuson Lin 8336696777cSDuson Lin out: 8346696777cSDuson Lin mutex_unlock(&data->sysfs_mutex); 8356696777cSDuson Lin return retval; 8366696777cSDuson Lin } 8376696777cSDuson Lin 8386696777cSDuson Lin static ssize_t max_show(struct device *dev, 8396696777cSDuson Lin struct device_attribute *attr, char *buf) 8406696777cSDuson Lin { 8416696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 8426696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 8436696777cSDuson Lin int retval; 8446696777cSDuson Lin 8456696777cSDuson Lin retval = mutex_lock_interruptible(&data->sysfs_mutex); 8466696777cSDuson Lin if (retval) 8476696777cSDuson Lin return retval; 8486696777cSDuson Lin 8496696777cSDuson Lin if (!data->baseline_ready) { 8506696777cSDuson Lin retval = -ENODATA; 8516696777cSDuson Lin goto out; 8526696777cSDuson Lin } 8536696777cSDuson Lin 8546696777cSDuson Lin retval = snprintf(buf, PAGE_SIZE, "%d", data->max_baseline); 8556696777cSDuson Lin 8566696777cSDuson Lin out: 8576696777cSDuson Lin mutex_unlock(&data->sysfs_mutex); 8586696777cSDuson Lin return retval; 8596696777cSDuson Lin } 8606696777cSDuson Lin 8616696777cSDuson Lin 8626696777cSDuson Lin static DEVICE_ATTR_WO(acquire); 8636696777cSDuson Lin static DEVICE_ATTR_RO(min); 8646696777cSDuson Lin static DEVICE_ATTR_RO(max); 8656696777cSDuson Lin 8666696777cSDuson Lin static struct attribute *elan_baseline_sysfs_entries[] = { 8676696777cSDuson Lin &dev_attr_acquire.attr, 8686696777cSDuson Lin &dev_attr_min.attr, 8696696777cSDuson Lin &dev_attr_max.attr, 8706696777cSDuson Lin NULL, 8716696777cSDuson Lin }; 8726696777cSDuson Lin 8736696777cSDuson Lin static const struct attribute_group elan_baseline_sysfs_group = { 8746696777cSDuson Lin .name = "baseline", 8756696777cSDuson Lin .attrs = elan_baseline_sysfs_entries, 8766696777cSDuson Lin }; 8776696777cSDuson Lin 8786696777cSDuson Lin static const struct attribute_group *elan_sysfs_groups[] = { 8796696777cSDuson Lin &elan_sysfs_group, 8806696777cSDuson Lin &elan_baseline_sysfs_group, 8816696777cSDuson Lin NULL 8826696777cSDuson Lin }; 8836696777cSDuson Lin 8846696777cSDuson Lin /* 8856696777cSDuson Lin ****************************************************************** 8866696777cSDuson Lin * Elan isr functions 8876696777cSDuson Lin ****************************************************************** 8886696777cSDuson Lin */ 8896696777cSDuson Lin static void elan_report_contact(struct elan_tp_data *data, 8906696777cSDuson Lin int contact_num, bool contact_valid, 891539c4b88Sduson u8 *finger_data) 8926696777cSDuson Lin { 8936696777cSDuson Lin struct input_dev *input = data->input; 8946696777cSDuson Lin unsigned int pos_x, pos_y; 8956696777cSDuson Lin unsigned int pressure, mk_x, mk_y; 896b9bced0eSduson unsigned int area_x, area_y, major, minor; 897b9bced0eSduson unsigned int scaled_pressure; 8986696777cSDuson Lin 8996696777cSDuson Lin if (contact_valid) { 9006696777cSDuson Lin pos_x = ((finger_data[0] & 0xf0) << 4) | 9016696777cSDuson Lin finger_data[1]; 9026696777cSDuson Lin pos_y = ((finger_data[0] & 0x0f) << 8) | 9036696777cSDuson Lin finger_data[2]; 9046696777cSDuson Lin mk_x = (finger_data[3] & 0x0f); 9056696777cSDuson Lin mk_y = (finger_data[3] >> 4); 9066696777cSDuson Lin pressure = finger_data[4]; 9076696777cSDuson Lin 9086696777cSDuson Lin if (pos_x > data->max_x || pos_y > data->max_y) { 9096696777cSDuson Lin dev_dbg(input->dev.parent, 9106696777cSDuson Lin "[%d] x=%d y=%d over max (%d, %d)", 9116696777cSDuson Lin contact_num, pos_x, pos_y, 9126696777cSDuson Lin data->max_x, data->max_y); 9136696777cSDuson Lin return; 9146696777cSDuson Lin } 9156696777cSDuson Lin 9166696777cSDuson Lin /* 9176696777cSDuson Lin * To avoid treating large finger as palm, let's reduce the 9186696777cSDuson Lin * width x and y per trace. 9196696777cSDuson Lin */ 9206696777cSDuson Lin area_x = mk_x * (data->width_x - ETP_FWIDTH_REDUCE); 9216696777cSDuson Lin area_y = mk_y * (data->width_y - ETP_FWIDTH_REDUCE); 9226696777cSDuson Lin 9236696777cSDuson Lin major = max(area_x, area_y); 9246696777cSDuson Lin minor = min(area_x, area_y); 9256696777cSDuson Lin 926b9bced0eSduson scaled_pressure = pressure + data->pressure_adjustment; 927b9bced0eSduson 928b9bced0eSduson if (scaled_pressure > ETP_MAX_PRESSURE) 929b9bced0eSduson scaled_pressure = ETP_MAX_PRESSURE; 9306696777cSDuson Lin 9316696777cSDuson Lin input_mt_slot(input, contact_num); 9326696777cSDuson Lin input_mt_report_slot_state(input, MT_TOOL_FINGER, true); 9336696777cSDuson Lin input_report_abs(input, ABS_MT_POSITION_X, pos_x); 9346696777cSDuson Lin input_report_abs(input, ABS_MT_POSITION_Y, data->max_y - pos_y); 935539c4b88Sduson input_report_abs(input, ABS_MT_PRESSURE, scaled_pressure); 9366696777cSDuson Lin input_report_abs(input, ABS_TOOL_WIDTH, mk_x); 9376696777cSDuson Lin input_report_abs(input, ABS_MT_TOUCH_MAJOR, major); 9386696777cSDuson Lin input_report_abs(input, ABS_MT_TOUCH_MINOR, minor); 9396696777cSDuson Lin } else { 9406696777cSDuson Lin input_mt_slot(input, contact_num); 9416696777cSDuson Lin input_mt_report_slot_state(input, MT_TOOL_FINGER, false); 9426696777cSDuson Lin } 9436696777cSDuson Lin } 9446696777cSDuson Lin 9456696777cSDuson Lin static void elan_report_absolute(struct elan_tp_data *data, u8 *packet) 9466696777cSDuson Lin { 9476696777cSDuson Lin struct input_dev *input = data->input; 9486696777cSDuson Lin u8 *finger_data = &packet[ETP_FINGER_DATA_OFFSET]; 9496696777cSDuson Lin int i; 9506696777cSDuson Lin u8 tp_info = packet[ETP_TOUCH_INFO_OFFSET]; 951090ad325SDuson Lin u8 hover_info = packet[ETP_HOVER_INFO_OFFSET]; 952090ad325SDuson Lin bool contact_valid, hover_event; 9536696777cSDuson Lin 954090ad325SDuson Lin hover_event = hover_info & 0x40; 9556696777cSDuson Lin for (i = 0; i < ETP_MAX_FINGERS; i++) { 9566696777cSDuson Lin contact_valid = tp_info & (1U << (3 + i)); 957539c4b88Sduson elan_report_contact(data, i, contact_valid, finger_data); 9586696777cSDuson Lin 9596696777cSDuson Lin if (contact_valid) 9606696777cSDuson Lin finger_data += ETP_FINGER_DATA_LEN; 9616696777cSDuson Lin } 9626696777cSDuson Lin 963140a7952SBenjamin Tissoires input_report_key(input, BTN_LEFT, tp_info & BIT(0)); 964140a7952SBenjamin Tissoires input_report_key(input, BTN_MIDDLE, tp_info & BIT(2)); 965140a7952SBenjamin Tissoires input_report_key(input, BTN_RIGHT, tp_info & BIT(1)); 966539c4b88Sduson input_report_abs(input, ABS_DISTANCE, hover_event != 0); 9676696777cSDuson Lin input_mt_report_pointer_emulation(input, true); 9686696777cSDuson Lin input_sync(input); 9696696777cSDuson Lin } 9706696777cSDuson Lin 971559b3df7SBenjamin Tissoires static void elan_report_trackpoint(struct elan_tp_data *data, u8 *report) 972559b3df7SBenjamin Tissoires { 973559b3df7SBenjamin Tissoires struct input_dev *input = data->tp_input; 974559b3df7SBenjamin Tissoires u8 *packet = &report[ETP_REPORT_ID_OFFSET + 1]; 975559b3df7SBenjamin Tissoires int x, y; 976559b3df7SBenjamin Tissoires 977559b3df7SBenjamin Tissoires if (!data->tp_input) { 978559b3df7SBenjamin Tissoires dev_warn_once(&data->client->dev, 979559b3df7SBenjamin Tissoires "received a trackpoint report while no trackpoint device has been created. Please report upstream.\n"); 980559b3df7SBenjamin Tissoires return; 981559b3df7SBenjamin Tissoires } 982559b3df7SBenjamin Tissoires 983559b3df7SBenjamin Tissoires input_report_key(input, BTN_LEFT, packet[0] & 0x01); 984559b3df7SBenjamin Tissoires input_report_key(input, BTN_RIGHT, packet[0] & 0x02); 985559b3df7SBenjamin Tissoires input_report_key(input, BTN_MIDDLE, packet[0] & 0x04); 986559b3df7SBenjamin Tissoires 987559b3df7SBenjamin Tissoires if ((packet[3] & 0x0F) == 0x06) { 988559b3df7SBenjamin Tissoires x = packet[4] - (int)((packet[1] ^ 0x80) << 1); 989559b3df7SBenjamin Tissoires y = (int)((packet[2] ^ 0x80) << 1) - packet[5]; 990559b3df7SBenjamin Tissoires 991559b3df7SBenjamin Tissoires input_report_rel(input, REL_X, x); 992559b3df7SBenjamin Tissoires input_report_rel(input, REL_Y, y); 993559b3df7SBenjamin Tissoires } 994559b3df7SBenjamin Tissoires 995559b3df7SBenjamin Tissoires input_sync(input); 996559b3df7SBenjamin Tissoires } 997559b3df7SBenjamin Tissoires 9986696777cSDuson Lin static irqreturn_t elan_isr(int irq, void *dev_id) 9996696777cSDuson Lin { 10006696777cSDuson Lin struct elan_tp_data *data = dev_id; 10016696777cSDuson Lin struct device *dev = &data->client->dev; 10026696777cSDuson Lin int error; 10036696777cSDuson Lin u8 report[ETP_MAX_REPORT_LEN]; 10046696777cSDuson Lin 10056696777cSDuson Lin /* 10066696777cSDuson Lin * When device is connected to i2c bus, when all IAP page writes 10076696777cSDuson Lin * complete, the driver will receive interrupt and must read 10086696777cSDuson Lin * 0000 to confirm that IAP is finished. 10096696777cSDuson Lin */ 10106696777cSDuson Lin if (data->in_fw_update) { 10116696777cSDuson Lin complete(&data->fw_completion); 10126696777cSDuson Lin goto out; 10136696777cSDuson Lin } 10146696777cSDuson Lin 10156696777cSDuson Lin error = data->ops->get_report(data->client, report); 10166696777cSDuson Lin if (error) 10176696777cSDuson Lin goto out; 10186696777cSDuson Lin 1019145b11d1SRavi Chandra Sadineni pm_wakeup_event(dev, 0); 1020145b11d1SRavi Chandra Sadineni 1021559b3df7SBenjamin Tissoires switch (report[ETP_REPORT_ID_OFFSET]) { 1022559b3df7SBenjamin Tissoires case ETP_REPORT_ID: 1023559b3df7SBenjamin Tissoires elan_report_absolute(data, report); 1024559b3df7SBenjamin Tissoires break; 1025559b3df7SBenjamin Tissoires case ETP_TP_REPORT_ID: 1026559b3df7SBenjamin Tissoires elan_report_trackpoint(data, report); 1027559b3df7SBenjamin Tissoires break; 1028559b3df7SBenjamin Tissoires default: 10296696777cSDuson Lin dev_err(dev, "invalid report id data (%x)\n", 10306696777cSDuson Lin report[ETP_REPORT_ID_OFFSET]); 1031559b3df7SBenjamin Tissoires } 10326696777cSDuson Lin 10336696777cSDuson Lin out: 10346696777cSDuson Lin return IRQ_HANDLED; 10356696777cSDuson Lin } 10366696777cSDuson Lin 10376696777cSDuson Lin /* 10386696777cSDuson Lin ****************************************************************** 10396696777cSDuson Lin * Elan initialization functions 10406696777cSDuson Lin ****************************************************************** 10416696777cSDuson Lin */ 1042559b3df7SBenjamin Tissoires 1043559b3df7SBenjamin Tissoires static int elan_setup_trackpoint_input_device(struct elan_tp_data *data) 1044559b3df7SBenjamin Tissoires { 1045559b3df7SBenjamin Tissoires struct device *dev = &data->client->dev; 1046559b3df7SBenjamin Tissoires struct input_dev *input; 1047559b3df7SBenjamin Tissoires 1048559b3df7SBenjamin Tissoires input = devm_input_allocate_device(dev); 1049559b3df7SBenjamin Tissoires if (!input) 1050559b3df7SBenjamin Tissoires return -ENOMEM; 1051559b3df7SBenjamin Tissoires 1052559b3df7SBenjamin Tissoires input->name = "Elan TrackPoint"; 1053559b3df7SBenjamin Tissoires input->id.bustype = BUS_I2C; 1054559b3df7SBenjamin Tissoires input->id.vendor = ELAN_VENDOR_ID; 1055559b3df7SBenjamin Tissoires input->id.product = data->product_id; 1056559b3df7SBenjamin Tissoires input_set_drvdata(input, data); 1057559b3df7SBenjamin Tissoires 1058559b3df7SBenjamin Tissoires input_set_capability(input, EV_REL, REL_X); 1059559b3df7SBenjamin Tissoires input_set_capability(input, EV_REL, REL_Y); 1060559b3df7SBenjamin Tissoires input_set_capability(input, EV_KEY, BTN_LEFT); 1061559b3df7SBenjamin Tissoires input_set_capability(input, EV_KEY, BTN_RIGHT); 1062559b3df7SBenjamin Tissoires input_set_capability(input, EV_KEY, BTN_MIDDLE); 1063559b3df7SBenjamin Tissoires 1064559b3df7SBenjamin Tissoires __set_bit(INPUT_PROP_POINTER, input->propbit); 1065559b3df7SBenjamin Tissoires __set_bit(INPUT_PROP_POINTING_STICK, input->propbit); 1066559b3df7SBenjamin Tissoires 1067559b3df7SBenjamin Tissoires data->tp_input = input; 1068559b3df7SBenjamin Tissoires 1069559b3df7SBenjamin Tissoires return 0; 1070559b3df7SBenjamin Tissoires } 1071559b3df7SBenjamin Tissoires 10726696777cSDuson Lin static int elan_setup_input_device(struct elan_tp_data *data) 10736696777cSDuson Lin { 10746696777cSDuson Lin struct device *dev = &data->client->dev; 10756696777cSDuson Lin struct input_dev *input; 10766696777cSDuson Lin unsigned int max_width = max(data->width_x, data->width_y); 10776696777cSDuson Lin unsigned int min_width = min(data->width_x, data->width_y); 10786696777cSDuson Lin int error; 10796696777cSDuson Lin 10806696777cSDuson Lin input = devm_input_allocate_device(dev); 10816696777cSDuson Lin if (!input) 10826696777cSDuson Lin return -ENOMEM; 10836696777cSDuson Lin 10846696777cSDuson Lin input->name = "Elan Touchpad"; 10856696777cSDuson Lin input->id.bustype = BUS_I2C; 10863eab4588SCharlie Mooney input->id.vendor = ELAN_VENDOR_ID; 10873eab4588SCharlie Mooney input->id.product = data->product_id; 10886696777cSDuson Lin input_set_drvdata(input, data); 10896696777cSDuson Lin 10906696777cSDuson Lin error = input_mt_init_slots(input, ETP_MAX_FINGERS, 10916696777cSDuson Lin INPUT_MT_POINTER | INPUT_MT_DROP_UNUSED); 10926696777cSDuson Lin if (error) { 10936696777cSDuson Lin dev_err(dev, "failed to initialize MT slots: %d\n", error); 10946696777cSDuson Lin return error; 10956696777cSDuson Lin } 10966696777cSDuson Lin 10976696777cSDuson Lin __set_bit(EV_ABS, input->evbit); 10986696777cSDuson Lin __set_bit(INPUT_PROP_POINTER, input->propbit); 1099140a7952SBenjamin Tissoires if (data->clickpad) { 11006696777cSDuson Lin __set_bit(INPUT_PROP_BUTTONPAD, input->propbit); 1101140a7952SBenjamin Tissoires } else { 110299136881SKT Liao __set_bit(BTN_RIGHT, input->keybit); 1103140a7952SBenjamin Tissoires if (data->middle_button) 1104140a7952SBenjamin Tissoires __set_bit(BTN_MIDDLE, input->keybit); 1105140a7952SBenjamin Tissoires } 11066696777cSDuson Lin __set_bit(BTN_LEFT, input->keybit); 11076696777cSDuson Lin 11086696777cSDuson Lin /* Set up ST parameters */ 11096696777cSDuson Lin input_set_abs_params(input, ABS_X, 0, data->max_x, 0, 0); 11106696777cSDuson Lin input_set_abs_params(input, ABS_Y, 0, data->max_y, 0, 0); 11116696777cSDuson Lin input_abs_set_res(input, ABS_X, data->x_res); 11126696777cSDuson Lin input_abs_set_res(input, ABS_Y, data->y_res); 11136696777cSDuson Lin input_set_abs_params(input, ABS_PRESSURE, 0, ETP_MAX_PRESSURE, 0, 0); 11146696777cSDuson Lin input_set_abs_params(input, ABS_TOOL_WIDTH, 0, ETP_FINGER_WIDTH, 0, 0); 1115539c4b88Sduson input_set_abs_params(input, ABS_DISTANCE, 0, 1, 0, 0); 11166696777cSDuson Lin 11176696777cSDuson Lin /* And MT parameters */ 11186696777cSDuson Lin input_set_abs_params(input, ABS_MT_POSITION_X, 0, data->max_x, 0, 0); 11196696777cSDuson Lin input_set_abs_params(input, ABS_MT_POSITION_Y, 0, data->max_y, 0, 0); 11206696777cSDuson Lin input_abs_set_res(input, ABS_MT_POSITION_X, data->x_res); 11216696777cSDuson Lin input_abs_set_res(input, ABS_MT_POSITION_Y, data->y_res); 11226696777cSDuson Lin input_set_abs_params(input, ABS_MT_PRESSURE, 0, 11236696777cSDuson Lin ETP_MAX_PRESSURE, 0, 0); 11246696777cSDuson Lin input_set_abs_params(input, ABS_MT_TOUCH_MAJOR, 0, 11256696777cSDuson Lin ETP_FINGER_WIDTH * max_width, 0, 0); 11266696777cSDuson Lin input_set_abs_params(input, ABS_MT_TOUCH_MINOR, 0, 11276696777cSDuson Lin ETP_FINGER_WIDTH * min_width, 0, 0); 11286696777cSDuson Lin 11296696777cSDuson Lin data->input = input; 11306696777cSDuson Lin 11316696777cSDuson Lin return 0; 11326696777cSDuson Lin } 11336696777cSDuson Lin 11346696777cSDuson Lin static void elan_disable_regulator(void *_data) 11356696777cSDuson Lin { 11366696777cSDuson Lin struct elan_tp_data *data = _data; 11376696777cSDuson Lin 11386696777cSDuson Lin regulator_disable(data->vcc); 11396696777cSDuson Lin } 11406696777cSDuson Lin 11416696777cSDuson Lin static int elan_probe(struct i2c_client *client, 11426696777cSDuson Lin const struct i2c_device_id *dev_id) 11436696777cSDuson Lin { 11446696777cSDuson Lin const struct elan_transport_ops *transport_ops; 11456696777cSDuson Lin struct device *dev = &client->dev; 11466696777cSDuson Lin struct elan_tp_data *data; 11476696777cSDuson Lin unsigned long irqflags; 11486696777cSDuson Lin int error; 11496696777cSDuson Lin 11506696777cSDuson Lin if (IS_ENABLED(CONFIG_MOUSE_ELAN_I2C_I2C) && 11516696777cSDuson Lin i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { 11526696777cSDuson Lin transport_ops = &elan_i2c_ops; 11536696777cSDuson Lin } else if (IS_ENABLED(CONFIG_MOUSE_ELAN_I2C_SMBUS) && 11546696777cSDuson Lin i2c_check_functionality(client->adapter, 11556696777cSDuson Lin I2C_FUNC_SMBUS_BYTE_DATA | 11566696777cSDuson Lin I2C_FUNC_SMBUS_BLOCK_DATA | 11576696777cSDuson Lin I2C_FUNC_SMBUS_I2C_BLOCK)) { 11586696777cSDuson Lin transport_ops = &elan_smbus_ops; 11596696777cSDuson Lin } else { 11606696777cSDuson Lin dev_err(dev, "not a supported I2C/SMBus adapter\n"); 11616696777cSDuson Lin return -EIO; 11626696777cSDuson Lin } 11636696777cSDuson Lin 1164ad56814fSGuenter Roeck data = devm_kzalloc(dev, sizeof(struct elan_tp_data), GFP_KERNEL); 11656696777cSDuson Lin if (!data) 11666696777cSDuson Lin return -ENOMEM; 11676696777cSDuson Lin 11686696777cSDuson Lin i2c_set_clientdata(client, data); 11696696777cSDuson Lin 11706696777cSDuson Lin data->ops = transport_ops; 11716696777cSDuson Lin data->client = client; 11726696777cSDuson Lin init_completion(&data->fw_completion); 11736696777cSDuson Lin mutex_init(&data->sysfs_mutex); 11746696777cSDuson Lin 1175ad56814fSGuenter Roeck data->vcc = devm_regulator_get(dev, "vcc"); 11766696777cSDuson Lin if (IS_ERR(data->vcc)) { 11776696777cSDuson Lin error = PTR_ERR(data->vcc); 11786696777cSDuson Lin if (error != -EPROBE_DEFER) 1179ad56814fSGuenter Roeck dev_err(dev, "Failed to get 'vcc' regulator: %d\n", 11806696777cSDuson Lin error); 11816696777cSDuson Lin return error; 11826696777cSDuson Lin } 11836696777cSDuson Lin 11846696777cSDuson Lin error = regulator_enable(data->vcc); 11856696777cSDuson Lin if (error) { 1186ad56814fSGuenter Roeck dev_err(dev, "Failed to enable regulator: %d\n", error); 11876696777cSDuson Lin return error; 11886696777cSDuson Lin } 11896696777cSDuson Lin 1190ad56814fSGuenter Roeck error = devm_add_action(dev, elan_disable_regulator, data); 11916696777cSDuson Lin if (error) { 11926696777cSDuson Lin regulator_disable(data->vcc); 1193ad56814fSGuenter Roeck dev_err(dev, "Failed to add disable regulator action: %d\n", 11946696777cSDuson Lin error); 11956696777cSDuson Lin return error; 11966696777cSDuson Lin } 11976696777cSDuson Lin 1198c5928551SDmitry Torokhov /* Make sure there is something at this address */ 1199c5928551SDmitry Torokhov error = i2c_smbus_read_byte(client); 1200c5928551SDmitry Torokhov if (error < 0) { 1201c5928551SDmitry Torokhov dev_dbg(&client->dev, "nothing at this address: %d\n", error); 1202c5928551SDmitry Torokhov return -ENXIO; 1203c5928551SDmitry Torokhov } 1204c5928551SDmitry Torokhov 12056696777cSDuson Lin /* Initialize the touchpad. */ 12066696777cSDuson Lin error = elan_initialize(data); 12076696777cSDuson Lin if (error) 12086696777cSDuson Lin return error; 12096696777cSDuson Lin 12106696777cSDuson Lin error = elan_query_device_info(data); 12116696777cSDuson Lin if (error) 12126696777cSDuson Lin return error; 12136696777cSDuson Lin 12146696777cSDuson Lin error = elan_query_device_parameters(data); 12156696777cSDuson Lin if (error) 12166696777cSDuson Lin return error; 12176696777cSDuson Lin 1218ad56814fSGuenter Roeck dev_info(dev, 121939a0d75aSBenjamin Tissoires "Elan Touchpad: Module ID: 0x%04x, Firmware: 0x%04x, Sample: 0x%04x, IAP: 0x%04x\n", 12206696777cSDuson Lin data->product_id, 12216696777cSDuson Lin data->fw_version, 12226696777cSDuson Lin data->sm_version, 122339a0d75aSBenjamin Tissoires data->iap_version); 122439a0d75aSBenjamin Tissoires 1225ad56814fSGuenter Roeck dev_dbg(dev, 122639a0d75aSBenjamin Tissoires "Elan Touchpad Extra Information:\n" 122739a0d75aSBenjamin Tissoires " Max ABS X,Y: %d,%d\n" 122839a0d75aSBenjamin Tissoires " Width X,Y: %d,%d\n" 1229a2eaf299SKT Liao " Resolution X,Y: %d,%d (dots/mm)\n" 1230a2eaf299SKT Liao " ic type: 0x%x\n" 1231a2eaf299SKT Liao " info pattern: 0x%x\n", 12326696777cSDuson Lin data->max_x, data->max_y, 12336696777cSDuson Lin data->width_x, data->width_y, 1234a2eaf299SKT Liao data->x_res, data->y_res, 1235a2eaf299SKT Liao data->ic_type, data->pattern); 12366696777cSDuson Lin 12376696777cSDuson Lin /* Set up input device properties based on queried parameters. */ 12386696777cSDuson Lin error = elan_setup_input_device(data); 12396696777cSDuson Lin if (error) 12406696777cSDuson Lin return error; 12416696777cSDuson Lin 1242559b3df7SBenjamin Tissoires if (device_property_read_bool(&client->dev, "elan,trackpoint")) { 1243559b3df7SBenjamin Tissoires error = elan_setup_trackpoint_input_device(data); 1244559b3df7SBenjamin Tissoires if (error) 1245559b3df7SBenjamin Tissoires return error; 1246559b3df7SBenjamin Tissoires } 1247559b3df7SBenjamin Tissoires 12486696777cSDuson Lin /* 1249a4b0a58bSDmitry Torokhov * Platform code (ACPI, DTS) should normally set up interrupt 1250a4b0a58bSDmitry Torokhov * for us, but in case it did not let's fall back to using falling 1251a4b0a58bSDmitry Torokhov * edge to be compatible with older Chromebooks. 12526696777cSDuson Lin */ 1253a4b0a58bSDmitry Torokhov irqflags = irq_get_trigger_type(client->irq); 1254a4b0a58bSDmitry Torokhov if (!irqflags) 1255a4b0a58bSDmitry Torokhov irqflags = IRQF_TRIGGER_FALLING; 12566696777cSDuson Lin 1257ad56814fSGuenter Roeck error = devm_request_threaded_irq(dev, client->irq, NULL, elan_isr, 12586696777cSDuson Lin irqflags | IRQF_ONESHOT, 12596696777cSDuson Lin client->name, data); 12606696777cSDuson Lin if (error) { 1261ad56814fSGuenter Roeck dev_err(dev, "cannot register irq=%d\n", client->irq); 12626696777cSDuson Lin return error; 12636696777cSDuson Lin } 12646696777cSDuson Lin 12659609b904SDmitry Torokhov error = devm_device_add_groups(dev, elan_sysfs_groups); 12666696777cSDuson Lin if (error) { 1267ad56814fSGuenter Roeck dev_err(dev, "failed to create sysfs attributes: %d\n", error); 12686696777cSDuson Lin return error; 12696696777cSDuson Lin } 12706696777cSDuson Lin 12716696777cSDuson Lin error = input_register_device(data->input); 12726696777cSDuson Lin if (error) { 1273ad56814fSGuenter Roeck dev_err(dev, "failed to register input device: %d\n", error); 12746696777cSDuson Lin return error; 12756696777cSDuson Lin } 12766696777cSDuson Lin 1277559b3df7SBenjamin Tissoires if (data->tp_input) { 1278559b3df7SBenjamin Tissoires error = input_register_device(data->tp_input); 1279559b3df7SBenjamin Tissoires if (error) { 1280559b3df7SBenjamin Tissoires dev_err(&client->dev, 1281559b3df7SBenjamin Tissoires "failed to register TrackPoint input device: %d\n", 1282559b3df7SBenjamin Tissoires error); 1283559b3df7SBenjamin Tissoires return error; 1284559b3df7SBenjamin Tissoires } 1285559b3df7SBenjamin Tissoires } 1286559b3df7SBenjamin Tissoires 12876696777cSDuson Lin /* 12886696777cSDuson Lin * Systems using device tree should set up wakeup via DTS, 12896696777cSDuson Lin * the rest will configure device as wakeup source by default. 12906696777cSDuson Lin */ 1291ad56814fSGuenter Roeck if (!dev->of_node) 1292ad56814fSGuenter Roeck device_init_wakeup(dev, true); 12936696777cSDuson Lin 12946696777cSDuson Lin return 0; 12956696777cSDuson Lin } 12966696777cSDuson Lin 12976696777cSDuson Lin static int __maybe_unused elan_suspend(struct device *dev) 12986696777cSDuson Lin { 12996696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 13006696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 13016696777cSDuson Lin int ret; 13026696777cSDuson Lin 13036696777cSDuson Lin /* 13046696777cSDuson Lin * We are taking the mutex to make sure sysfs operations are 13056696777cSDuson Lin * complete before we attempt to bring the device into low[er] 13066696777cSDuson Lin * power mode. 13076696777cSDuson Lin */ 13086696777cSDuson Lin ret = mutex_lock_interruptible(&data->sysfs_mutex); 13096696777cSDuson Lin if (ret) 13106696777cSDuson Lin return ret; 13116696777cSDuson Lin 13126696777cSDuson Lin disable_irq(client->irq); 13136696777cSDuson Lin 13146696777cSDuson Lin if (device_may_wakeup(dev)) { 13156696777cSDuson Lin ret = elan_sleep(data); 13166696777cSDuson Lin /* Enable wake from IRQ */ 13176696777cSDuson Lin data->irq_wake = (enable_irq_wake(client->irq) == 0); 13186696777cSDuson Lin } else { 13196696777cSDuson Lin ret = elan_disable_power(data); 13206696777cSDuson Lin } 13216696777cSDuson Lin 13226696777cSDuson Lin mutex_unlock(&data->sysfs_mutex); 13236696777cSDuson Lin return ret; 13246696777cSDuson Lin } 13256696777cSDuson Lin 13266696777cSDuson Lin static int __maybe_unused elan_resume(struct device *dev) 13276696777cSDuson Lin { 13286696777cSDuson Lin struct i2c_client *client = to_i2c_client(dev); 13296696777cSDuson Lin struct elan_tp_data *data = i2c_get_clientdata(client); 13306696777cSDuson Lin int error; 13316696777cSDuson Lin 13326696777cSDuson Lin if (device_may_wakeup(dev) && data->irq_wake) { 13336696777cSDuson Lin disable_irq_wake(client->irq); 13346696777cSDuson Lin data->irq_wake = false; 13356696777cSDuson Lin } 13366696777cSDuson Lin 13376696777cSDuson Lin error = elan_enable_power(data); 1338b3beed7fSDuson Lin if (error) { 13396696777cSDuson Lin dev_err(dev, "power up when resuming failed: %d\n", error); 1340b3beed7fSDuson Lin goto err; 1341b3beed7fSDuson Lin } 13426696777cSDuson Lin 13436696777cSDuson Lin error = elan_initialize(data); 13446696777cSDuson Lin if (error) 13456696777cSDuson Lin dev_err(dev, "initialize when resuming failed: %d\n", error); 13466696777cSDuson Lin 1347b3beed7fSDuson Lin err: 13486696777cSDuson Lin enable_irq(data->client->irq); 1349b3beed7fSDuson Lin return error; 13506696777cSDuson Lin } 13516696777cSDuson Lin 13526696777cSDuson Lin static SIMPLE_DEV_PM_OPS(elan_pm_ops, elan_suspend, elan_resume); 13536696777cSDuson Lin 13546696777cSDuson Lin static const struct i2c_device_id elan_id[] = { 13556696777cSDuson Lin { DRIVER_NAME, 0 }, 13566696777cSDuson Lin { }, 13576696777cSDuson Lin }; 13586696777cSDuson Lin MODULE_DEVICE_TABLE(i2c, elan_id); 13596696777cSDuson Lin 13606696777cSDuson Lin #ifdef CONFIG_ACPI 13616696777cSDuson Lin MODULE_DEVICE_TABLE(acpi, elan_acpi_id); 13626696777cSDuson Lin #endif 13636696777cSDuson Lin 13646696777cSDuson Lin #ifdef CONFIG_OF 13656696777cSDuson Lin static const struct of_device_id elan_of_match[] = { 13666696777cSDuson Lin { .compatible = "elan,ekth3000" }, 13676696777cSDuson Lin { /* sentinel */ } 13686696777cSDuson Lin }; 13696696777cSDuson Lin MODULE_DEVICE_TABLE(of, elan_of_match); 13706696777cSDuson Lin #endif 13716696777cSDuson Lin 13726696777cSDuson Lin static struct i2c_driver elan_driver = { 13736696777cSDuson Lin .driver = { 13746696777cSDuson Lin .name = DRIVER_NAME, 13756696777cSDuson Lin .pm = &elan_pm_ops, 13766696777cSDuson Lin .acpi_match_table = ACPI_PTR(elan_acpi_id), 13776696777cSDuson Lin .of_match_table = of_match_ptr(elan_of_match), 137871d0f562SDmitry Torokhov .probe_type = PROBE_PREFER_ASYNCHRONOUS, 13796696777cSDuson Lin }, 13806696777cSDuson Lin .probe = elan_probe, 13816696777cSDuson Lin .id_table = elan_id, 13826696777cSDuson Lin }; 13836696777cSDuson Lin 13846696777cSDuson Lin module_i2c_driver(elan_driver); 13856696777cSDuson Lin 13866696777cSDuson Lin MODULE_AUTHOR("Duson Lin <dusonlin@emc.com.tw>"); 13876696777cSDuson Lin MODULE_DESCRIPTION("Elan I2C/SMBus Touchpad driver"); 13886696777cSDuson Lin MODULE_LICENSE("GPL"); 1389