16696777cSDuson Lin /* 26696777cSDuson Lin * Elan I2C/SMBus Touchpad driver - SMBus interface 36696777cSDuson Lin * 46696777cSDuson Lin * Copyright (c) 2013 ELAN Microelectronics Corp. 56696777cSDuson Lin * 66696777cSDuson Lin * Author: 林政維 (Duson Lin) <dusonlin@emc.com.tw> 76696777cSDuson Lin * 86696777cSDuson Lin * Based on cyapa driver: 96696777cSDuson Lin * copyright (c) 2011-2012 Cypress Semiconductor, Inc. 106696777cSDuson Lin * copyright (c) 2011-2012 Google, Inc. 116696777cSDuson Lin * 126696777cSDuson Lin * This program is free software; you can redistribute it and/or modify it 136696777cSDuson Lin * under the terms of the GNU General Public License version 2 as published 146696777cSDuson Lin * by the Free Software Foundation. 156696777cSDuson Lin * 166696777cSDuson Lin * Trademarks are the property of their respective owners. 176696777cSDuson Lin */ 186696777cSDuson Lin 196696777cSDuson Lin #include <linux/delay.h> 206696777cSDuson Lin #include <linux/i2c.h> 216696777cSDuson Lin #include <linux/init.h> 226696777cSDuson Lin #include <linux/kernel.h> 236696777cSDuson Lin 246696777cSDuson Lin #include "elan_i2c.h" 256696777cSDuson Lin 266696777cSDuson Lin /* Elan SMbus commands */ 276696777cSDuson Lin #define ETP_SMBUS_IAP_CMD 0x00 286696777cSDuson Lin #define ETP_SMBUS_ENABLE_TP 0x20 296696777cSDuson Lin #define ETP_SMBUS_SLEEP_CMD 0x21 306696777cSDuson Lin #define ETP_SMBUS_IAP_PASSWORD_WRITE 0x29 316696777cSDuson Lin #define ETP_SMBUS_IAP_PASSWORD_READ 0x80 326696777cSDuson Lin #define ETP_SMBUS_WRITE_FW_BLOCK 0x2A 336696777cSDuson Lin #define ETP_SMBUS_IAP_RESET_CMD 0x2B 346696777cSDuson Lin #define ETP_SMBUS_RANGE_CMD 0xA0 356696777cSDuson Lin #define ETP_SMBUS_FW_VERSION_CMD 0xA1 366696777cSDuson Lin #define ETP_SMBUS_XY_TRACENUM_CMD 0xA2 376696777cSDuson Lin #define ETP_SMBUS_SM_VERSION_CMD 0xA3 386696777cSDuson Lin #define ETP_SMBUS_UNIQUEID_CMD 0xA3 396696777cSDuson Lin #define ETP_SMBUS_RESOLUTION_CMD 0xA4 406696777cSDuson Lin #define ETP_SMBUS_HELLOPACKET_CMD 0xA7 416696777cSDuson Lin #define ETP_SMBUS_PACKET_QUERY 0xA8 426696777cSDuson Lin #define ETP_SMBUS_IAP_VERSION_CMD 0xAC 436696777cSDuson Lin #define ETP_SMBUS_IAP_CTRL_CMD 0xAD 446696777cSDuson Lin #define ETP_SMBUS_IAP_CHECKSUM_CMD 0xAE 456696777cSDuson Lin #define ETP_SMBUS_FW_CHECKSUM_CMD 0xAF 466696777cSDuson Lin #define ETP_SMBUS_MAX_BASELINE_CMD 0xC3 476696777cSDuson Lin #define ETP_SMBUS_MIN_BASELINE_CMD 0xC4 486696777cSDuson Lin #define ETP_SMBUS_CALIBRATE_QUERY 0xC5 496696777cSDuson Lin 506696777cSDuson Lin #define ETP_SMBUS_REPORT_LEN 32 516696777cSDuson Lin #define ETP_SMBUS_REPORT_OFFSET 2 526696777cSDuson Lin #define ETP_SMBUS_HELLOPACKET_LEN 5 536696777cSDuson Lin #define ETP_SMBUS_IAP_PASSWORD 0x1234 546696777cSDuson Lin #define ETP_SMBUS_IAP_MODE_ON (1 << 6) 556696777cSDuson Lin 566696777cSDuson Lin static int elan_smbus_initialize(struct i2c_client *client) 576696777cSDuson Lin { 586696777cSDuson Lin u8 check[ETP_SMBUS_HELLOPACKET_LEN] = { 0x55, 0x55, 0x55, 0x55, 0x55 }; 596696777cSDuson Lin u8 values[ETP_SMBUS_HELLOPACKET_LEN] = { 0, 0, 0, 0, 0 }; 606696777cSDuson Lin int len, error; 616696777cSDuson Lin 626696777cSDuson Lin /* Get hello packet */ 636696777cSDuson Lin len = i2c_smbus_read_block_data(client, 646696777cSDuson Lin ETP_SMBUS_HELLOPACKET_CMD, values); 656696777cSDuson Lin if (len != ETP_SMBUS_HELLOPACKET_LEN) { 666696777cSDuson Lin dev_err(&client->dev, "hello packet length fail: %d\n", len); 676696777cSDuson Lin error = len < 0 ? len : -EIO; 686696777cSDuson Lin return error; 696696777cSDuson Lin } 706696777cSDuson Lin 716696777cSDuson Lin /* compare hello packet */ 726696777cSDuson Lin if (memcmp(values, check, ETP_SMBUS_HELLOPACKET_LEN)) { 73*98a4a59eSRasmus Villemoes dev_err(&client->dev, "hello packet fail [%*ph]\n", 746696777cSDuson Lin ETP_SMBUS_HELLOPACKET_LEN, values); 756696777cSDuson Lin return -ENXIO; 766696777cSDuson Lin } 776696777cSDuson Lin 786696777cSDuson Lin /* enable tp */ 796696777cSDuson Lin error = i2c_smbus_write_byte(client, ETP_SMBUS_ENABLE_TP); 806696777cSDuson Lin if (error) { 816696777cSDuson Lin dev_err(&client->dev, "failed to enable touchpad: %d\n", error); 826696777cSDuson Lin return error; 836696777cSDuson Lin } 846696777cSDuson Lin 856696777cSDuson Lin return 0; 866696777cSDuson Lin } 876696777cSDuson Lin 886696777cSDuson Lin static int elan_smbus_set_mode(struct i2c_client *client, u8 mode) 896696777cSDuson Lin { 906696777cSDuson Lin u8 cmd[4] = { 0x00, 0x07, 0x00, mode }; 916696777cSDuson Lin 926696777cSDuson Lin return i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD, 936696777cSDuson Lin sizeof(cmd), cmd); 946696777cSDuson Lin } 956696777cSDuson Lin 966696777cSDuson Lin static int elan_smbus_sleep_control(struct i2c_client *client, bool sleep) 976696777cSDuson Lin { 986696777cSDuson Lin if (sleep) 996696777cSDuson Lin return i2c_smbus_write_byte(client, ETP_SMBUS_SLEEP_CMD); 1006696777cSDuson Lin else 1016696777cSDuson Lin return 0; /* XXX should we send ETP_SMBUS_ENABLE_TP here? */ 1026696777cSDuson Lin } 1036696777cSDuson Lin 1046696777cSDuson Lin static int elan_smbus_power_control(struct i2c_client *client, bool enable) 1056696777cSDuson Lin { 1066696777cSDuson Lin return 0; /* A no-op */ 1076696777cSDuson Lin } 1086696777cSDuson Lin 1096696777cSDuson Lin static int elan_smbus_calibrate(struct i2c_client *client) 1106696777cSDuson Lin { 1116696777cSDuson Lin u8 cmd[4] = { 0x00, 0x08, 0x00, 0x01 }; 1126696777cSDuson Lin 1136696777cSDuson Lin return i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD, 1146696777cSDuson Lin sizeof(cmd), cmd); 1156696777cSDuson Lin } 1166696777cSDuson Lin 1176696777cSDuson Lin static int elan_smbus_calibrate_result(struct i2c_client *client, u8 *val) 1186696777cSDuson Lin { 1196696777cSDuson Lin int error; 1206696777cSDuson Lin 1216696777cSDuson Lin error = i2c_smbus_read_block_data(client, 1226696777cSDuson Lin ETP_SMBUS_CALIBRATE_QUERY, val); 1236696777cSDuson Lin if (error < 0) 1246696777cSDuson Lin return error; 1256696777cSDuson Lin 1266696777cSDuson Lin return 0; 1276696777cSDuson Lin } 1286696777cSDuson Lin 1296696777cSDuson Lin static int elan_smbus_get_baseline_data(struct i2c_client *client, 1306696777cSDuson Lin bool max_baseline, u8 *value) 1316696777cSDuson Lin { 1326696777cSDuson Lin int error; 1336696777cSDuson Lin u8 val[3]; 1346696777cSDuson Lin 1356696777cSDuson Lin error = i2c_smbus_read_block_data(client, 1366696777cSDuson Lin max_baseline ? 1376696777cSDuson Lin ETP_SMBUS_MAX_BASELINE_CMD : 1386696777cSDuson Lin ETP_SMBUS_MIN_BASELINE_CMD, 1396696777cSDuson Lin val); 1406696777cSDuson Lin if (error < 0) 1416696777cSDuson Lin return error; 1426696777cSDuson Lin 1436696777cSDuson Lin *value = be16_to_cpup((__be16 *)val); 1446696777cSDuson Lin 1456696777cSDuson Lin return 0; 1466696777cSDuson Lin } 1476696777cSDuson Lin 1486696777cSDuson Lin static int elan_smbus_get_version(struct i2c_client *client, 1496696777cSDuson Lin bool iap, u8 *version) 1506696777cSDuson Lin { 1516696777cSDuson Lin int error; 1526696777cSDuson Lin u8 val[3]; 1536696777cSDuson Lin 1546696777cSDuson Lin error = i2c_smbus_read_block_data(client, 1556696777cSDuson Lin iap ? ETP_SMBUS_IAP_VERSION_CMD : 1566696777cSDuson Lin ETP_SMBUS_FW_VERSION_CMD, 1576696777cSDuson Lin val); 1586696777cSDuson Lin if (error < 0) { 1596696777cSDuson Lin dev_err(&client->dev, "failed to get %s version: %d\n", 1606696777cSDuson Lin iap ? "IAP" : "FW", error); 1616696777cSDuson Lin return error; 1626696777cSDuson Lin } 1636696777cSDuson Lin 1646696777cSDuson Lin *version = val[2]; 1656696777cSDuson Lin return 0; 1666696777cSDuson Lin } 1676696777cSDuson Lin 1686696777cSDuson Lin static int elan_smbus_get_sm_version(struct i2c_client *client, u8 *version) 1696696777cSDuson Lin { 1706696777cSDuson Lin int error; 1716696777cSDuson Lin u8 val[3]; 1726696777cSDuson Lin 1736696777cSDuson Lin error = i2c_smbus_read_block_data(client, 1746696777cSDuson Lin ETP_SMBUS_SM_VERSION_CMD, val); 1756696777cSDuson Lin if (error < 0) { 1766696777cSDuson Lin dev_err(&client->dev, "failed to get SM version: %d\n", error); 1776696777cSDuson Lin return error; 1786696777cSDuson Lin } 1796696777cSDuson Lin 1806696777cSDuson Lin *version = val[0]; /* XXX Why 0 and not 2 as in IAP/FW versions? */ 1816696777cSDuson Lin return 0; 1826696777cSDuson Lin } 1836696777cSDuson Lin 1846696777cSDuson Lin static int elan_smbus_get_product_id(struct i2c_client *client, u8 *id) 1856696777cSDuson Lin { 1866696777cSDuson Lin int error; 1876696777cSDuson Lin u8 val[3]; 1886696777cSDuson Lin 1896696777cSDuson Lin error = i2c_smbus_read_block_data(client, 1906696777cSDuson Lin ETP_SMBUS_UNIQUEID_CMD, val); 1916696777cSDuson Lin if (error < 0) { 1926696777cSDuson Lin dev_err(&client->dev, "failed to get product ID: %d\n", error); 1936696777cSDuson Lin return error; 1946696777cSDuson Lin } 1956696777cSDuson Lin 1966696777cSDuson Lin *id = val[1]; 1976696777cSDuson Lin return 0; 1986696777cSDuson Lin } 1996696777cSDuson Lin 2006696777cSDuson Lin static int elan_smbus_get_checksum(struct i2c_client *client, 2016696777cSDuson Lin bool iap, u16 *csum) 2026696777cSDuson Lin { 2036696777cSDuson Lin int error; 2046696777cSDuson Lin u8 val[3]; 2056696777cSDuson Lin 2066696777cSDuson Lin error = i2c_smbus_read_block_data(client, 2076696777cSDuson Lin iap ? ETP_SMBUS_FW_CHECKSUM_CMD : 2086696777cSDuson Lin ETP_SMBUS_IAP_CHECKSUM_CMD, 2096696777cSDuson Lin val); 2106696777cSDuson Lin if (error < 0) { 2116696777cSDuson Lin dev_err(&client->dev, "failed to get %s checksum: %d\n", 2126696777cSDuson Lin iap ? "IAP" : "FW", error); 2136696777cSDuson Lin return error; 2146696777cSDuson Lin } 2156696777cSDuson Lin 2166696777cSDuson Lin *csum = be16_to_cpup((__be16 *)val); 2176696777cSDuson Lin return 0; 2186696777cSDuson Lin } 2196696777cSDuson Lin 2206696777cSDuson Lin static int elan_smbus_get_max(struct i2c_client *client, 2216696777cSDuson Lin unsigned int *max_x, unsigned int *max_y) 2226696777cSDuson Lin { 2236696777cSDuson Lin int error; 2246696777cSDuson Lin u8 val[3]; 2256696777cSDuson Lin 2266696777cSDuson Lin error = i2c_smbus_read_block_data(client, ETP_SMBUS_RANGE_CMD, val); 2276696777cSDuson Lin if (error) { 2286696777cSDuson Lin dev_err(&client->dev, "failed to get dimensions: %d\n", error); 2296696777cSDuson Lin return error; 2306696777cSDuson Lin } 2316696777cSDuson Lin 2326696777cSDuson Lin *max_x = (0x0f & val[0]) << 8 | val[1]; 2336696777cSDuson Lin *max_y = (0xf0 & val[0]) << 4 | val[2]; 2346696777cSDuson Lin 2356696777cSDuson Lin return 0; 2366696777cSDuson Lin } 2376696777cSDuson Lin 2386696777cSDuson Lin static int elan_smbus_get_resolution(struct i2c_client *client, 2396696777cSDuson Lin u8 *hw_res_x, u8 *hw_res_y) 2406696777cSDuson Lin { 2416696777cSDuson Lin int error; 2426696777cSDuson Lin u8 val[3]; 2436696777cSDuson Lin 2446696777cSDuson Lin error = i2c_smbus_read_block_data(client, 2456696777cSDuson Lin ETP_SMBUS_RESOLUTION_CMD, val); 2466696777cSDuson Lin if (error) { 2476696777cSDuson Lin dev_err(&client->dev, "failed to get resolution: %d\n", error); 2486696777cSDuson Lin return error; 2496696777cSDuson Lin } 2506696777cSDuson Lin 2516696777cSDuson Lin *hw_res_x = val[1] & 0x0F; 2526696777cSDuson Lin *hw_res_y = (val[1] & 0xF0) >> 4; 2536696777cSDuson Lin 2546696777cSDuson Lin return 0; 2556696777cSDuson Lin } 2566696777cSDuson Lin 2576696777cSDuson Lin static int elan_smbus_get_num_traces(struct i2c_client *client, 2586696777cSDuson Lin unsigned int *x_traces, 2596696777cSDuson Lin unsigned int *y_traces) 2606696777cSDuson Lin { 2616696777cSDuson Lin int error; 2626696777cSDuson Lin u8 val[3]; 2636696777cSDuson Lin 2646696777cSDuson Lin error = i2c_smbus_read_block_data(client, 2656696777cSDuson Lin ETP_SMBUS_XY_TRACENUM_CMD, val); 2666696777cSDuson Lin if (error) { 2676696777cSDuson Lin dev_err(&client->dev, "failed to get trace info: %d\n", error); 2686696777cSDuson Lin return error; 2696696777cSDuson Lin } 2706696777cSDuson Lin 2716696777cSDuson Lin *x_traces = val[1] - 1; 2726696777cSDuson Lin *y_traces = val[2] - 1; 2736696777cSDuson Lin 2746696777cSDuson Lin return 0; 2756696777cSDuson Lin } 2766696777cSDuson Lin 2776696777cSDuson Lin static int elan_smbus_iap_get_mode(struct i2c_client *client, 2786696777cSDuson Lin enum tp_mode *mode) 2796696777cSDuson Lin { 2806696777cSDuson Lin int error; 2816696777cSDuson Lin u16 constant; 2826696777cSDuson Lin u8 val[3]; 2836696777cSDuson Lin 2846696777cSDuson Lin error = i2c_smbus_read_block_data(client, ETP_SMBUS_IAP_CTRL_CMD, val); 2856696777cSDuson Lin if (error < 0) { 2866696777cSDuson Lin dev_err(&client->dev, "failed to read iap ctrol register: %d\n", 2876696777cSDuson Lin error); 2886696777cSDuson Lin return error; 2896696777cSDuson Lin } 2906696777cSDuson Lin 2916696777cSDuson Lin constant = be16_to_cpup((__be16 *)val); 2926696777cSDuson Lin dev_dbg(&client->dev, "iap control reg: 0x%04x.\n", constant); 2936696777cSDuson Lin 2946696777cSDuson Lin *mode = (constant & ETP_SMBUS_IAP_MODE_ON) ? IAP_MODE : MAIN_MODE; 2956696777cSDuson Lin 2966696777cSDuson Lin return 0; 2976696777cSDuson Lin } 2986696777cSDuson Lin 2996696777cSDuson Lin static int elan_smbus_iap_reset(struct i2c_client *client) 3006696777cSDuson Lin { 3016696777cSDuson Lin int error; 3026696777cSDuson Lin 3036696777cSDuson Lin error = i2c_smbus_write_byte(client, ETP_SMBUS_IAP_RESET_CMD); 3046696777cSDuson Lin if (error) { 3056696777cSDuson Lin dev_err(&client->dev, "cannot reset IC: %d\n", error); 3066696777cSDuson Lin return error; 3076696777cSDuson Lin } 3086696777cSDuson Lin 3096696777cSDuson Lin return 0; 3106696777cSDuson Lin } 3116696777cSDuson Lin 3126696777cSDuson Lin static int elan_smbus_set_flash_key(struct i2c_client *client) 3136696777cSDuson Lin { 3146696777cSDuson Lin int error; 3156696777cSDuson Lin u8 cmd[4] = { 0x00, 0x0B, 0x00, 0x5A }; 3166696777cSDuson Lin 3176696777cSDuson Lin error = i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD, 3186696777cSDuson Lin sizeof(cmd), cmd); 3196696777cSDuson Lin if (error) { 3206696777cSDuson Lin dev_err(&client->dev, "cannot set flash key: %d\n", error); 3216696777cSDuson Lin return error; 3226696777cSDuson Lin } 3236696777cSDuson Lin 3246696777cSDuson Lin return 0; 3256696777cSDuson Lin } 3266696777cSDuson Lin 3276696777cSDuson Lin static int elan_smbus_prepare_fw_update(struct i2c_client *client) 3286696777cSDuson Lin { 3296696777cSDuson Lin struct device *dev = &client->dev; 3306696777cSDuson Lin int len; 3316696777cSDuson Lin int error; 3326696777cSDuson Lin enum tp_mode mode; 3336696777cSDuson Lin u8 val[3]; 3346696777cSDuson Lin u8 cmd[4] = {0x0F, 0x78, 0x00, 0x06}; 3356696777cSDuson Lin u16 password; 3366696777cSDuson Lin 3376696777cSDuson Lin /* Get FW in which mode (IAP_MODE/MAIN_MODE) */ 3386696777cSDuson Lin error = elan_smbus_iap_get_mode(client, &mode); 3396696777cSDuson Lin if (error) 3406696777cSDuson Lin return error; 3416696777cSDuson Lin 3426696777cSDuson Lin if (mode == MAIN_MODE) { 3436696777cSDuson Lin 3446696777cSDuson Lin /* set flash key */ 3456696777cSDuson Lin error = elan_smbus_set_flash_key(client); 3466696777cSDuson Lin if (error) 3476696777cSDuson Lin return error; 3486696777cSDuson Lin 3496696777cSDuson Lin /* write iap password */ 3506696777cSDuson Lin if (i2c_smbus_write_byte(client, 3516696777cSDuson Lin ETP_SMBUS_IAP_PASSWORD_WRITE) < 0) { 3526696777cSDuson Lin dev_err(dev, "cannot write iap password\n"); 3536696777cSDuson Lin return -EIO; 3546696777cSDuson Lin } 3556696777cSDuson Lin 3566696777cSDuson Lin error = i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD, 3576696777cSDuson Lin sizeof(cmd), cmd); 3586696777cSDuson Lin if (error) { 3596696777cSDuson Lin dev_err(dev, "failed to write iap password: %d\n", 3606696777cSDuson Lin error); 3616696777cSDuson Lin return error; 3626696777cSDuson Lin } 3636696777cSDuson Lin 3646696777cSDuson Lin /* 3656696777cSDuson Lin * Read back password to make sure we enabled flash 3666696777cSDuson Lin * successfully. 3676696777cSDuson Lin */ 3686696777cSDuson Lin len = i2c_smbus_read_block_data(client, 3696696777cSDuson Lin ETP_SMBUS_IAP_PASSWORD_READ, 3706696777cSDuson Lin val); 3716696777cSDuson Lin if (len < sizeof(u16)) { 3726696777cSDuson Lin error = len < 0 ? len : -EIO; 3736696777cSDuson Lin dev_err(dev, "failed to read iap password: %d\n", 3746696777cSDuson Lin error); 3756696777cSDuson Lin return error; 3766696777cSDuson Lin } 3776696777cSDuson Lin 3786696777cSDuson Lin password = be16_to_cpup((__be16 *)val); 3796696777cSDuson Lin if (password != ETP_SMBUS_IAP_PASSWORD) { 3806696777cSDuson Lin dev_err(dev, "wrong iap password = 0x%X\n", password); 3816696777cSDuson Lin return -EIO; 3826696777cSDuson Lin } 3836696777cSDuson Lin 3846696777cSDuson Lin /* Wait 30ms for MAIN_MODE change to IAP_MODE */ 3856696777cSDuson Lin msleep(30); 3866696777cSDuson Lin } 3876696777cSDuson Lin 3886696777cSDuson Lin error = elan_smbus_set_flash_key(client); 3896696777cSDuson Lin if (error) 3906696777cSDuson Lin return error; 3916696777cSDuson Lin 3926696777cSDuson Lin /* Reset IC */ 3936696777cSDuson Lin error = elan_smbus_iap_reset(client); 3946696777cSDuson Lin if (error) 3956696777cSDuson Lin return error; 3966696777cSDuson Lin 3976696777cSDuson Lin return 0; 3986696777cSDuson Lin } 3996696777cSDuson Lin 4006696777cSDuson Lin 4016696777cSDuson Lin static int elan_smbus_write_fw_block(struct i2c_client *client, 4026696777cSDuson Lin const u8 *page, u16 checksum, int idx) 4036696777cSDuson Lin { 4046696777cSDuson Lin struct device *dev = &client->dev; 4056696777cSDuson Lin int error; 4066696777cSDuson Lin u16 result; 4076696777cSDuson Lin u8 val[3]; 4086696777cSDuson Lin 4096696777cSDuson Lin /* 4106696777cSDuson Lin * Due to the limitation of smbus protocol limiting 4116696777cSDuson Lin * transfer to 32 bytes at a time, we must split block 4126696777cSDuson Lin * in 2 transfers. 4136696777cSDuson Lin */ 4146696777cSDuson Lin error = i2c_smbus_write_block_data(client, 4156696777cSDuson Lin ETP_SMBUS_WRITE_FW_BLOCK, 4166696777cSDuson Lin ETP_FW_PAGE_SIZE / 2, 4176696777cSDuson Lin page); 4186696777cSDuson Lin if (error) { 4196696777cSDuson Lin dev_err(dev, "Failed to write page %d (part %d): %d\n", 4206696777cSDuson Lin idx, 1, error); 4216696777cSDuson Lin return error; 4226696777cSDuson Lin } 4236696777cSDuson Lin 4246696777cSDuson Lin error = i2c_smbus_write_block_data(client, 4256696777cSDuson Lin ETP_SMBUS_WRITE_FW_BLOCK, 4266696777cSDuson Lin ETP_FW_PAGE_SIZE / 2, 4276696777cSDuson Lin page + ETP_FW_PAGE_SIZE / 2); 4286696777cSDuson Lin if (error) { 4296696777cSDuson Lin dev_err(dev, "Failed to write page %d (part %d): %d\n", 4306696777cSDuson Lin idx, 2, error); 4316696777cSDuson Lin return error; 4326696777cSDuson Lin } 4336696777cSDuson Lin 4346696777cSDuson Lin 4356696777cSDuson Lin /* Wait for F/W to update one page ROM data. */ 4366696777cSDuson Lin usleep_range(8000, 10000); 4376696777cSDuson Lin 4386696777cSDuson Lin error = i2c_smbus_read_block_data(client, 4396696777cSDuson Lin ETP_SMBUS_IAP_CTRL_CMD, val); 4406696777cSDuson Lin if (error < 0) { 4416696777cSDuson Lin dev_err(dev, "Failed to read IAP write result: %d\n", 4426696777cSDuson Lin error); 4436696777cSDuson Lin return error; 4446696777cSDuson Lin } 4456696777cSDuson Lin 4466696777cSDuson Lin result = be16_to_cpup((__be16 *)val); 4476696777cSDuson Lin if (result & (ETP_FW_IAP_PAGE_ERR | ETP_FW_IAP_INTF_ERR)) { 4486696777cSDuson Lin dev_err(dev, "IAP reports failed write: %04hx\n", 4496696777cSDuson Lin result); 4506696777cSDuson Lin return -EIO; 4516696777cSDuson Lin } 4526696777cSDuson Lin 4536696777cSDuson Lin return 0; 4546696777cSDuson Lin } 4556696777cSDuson Lin 4566696777cSDuson Lin static int elan_smbus_get_report(struct i2c_client *client, u8 *report) 4576696777cSDuson Lin { 4586696777cSDuson Lin int len; 4596696777cSDuson Lin 4606696777cSDuson Lin len = i2c_smbus_read_block_data(client, 4616696777cSDuson Lin ETP_SMBUS_PACKET_QUERY, 4626696777cSDuson Lin &report[ETP_SMBUS_REPORT_OFFSET]); 4636696777cSDuson Lin if (len < 0) { 4646696777cSDuson Lin dev_err(&client->dev, "failed to read report data: %d\n", len); 4656696777cSDuson Lin return len; 4666696777cSDuson Lin } 4676696777cSDuson Lin 4686696777cSDuson Lin if (len != ETP_SMBUS_REPORT_LEN) { 4696696777cSDuson Lin dev_err(&client->dev, 4706696777cSDuson Lin "wrong report length (%d vs %d expected)\n", 4716696777cSDuson Lin len, ETP_SMBUS_REPORT_LEN); 4726696777cSDuson Lin return -EIO; 4736696777cSDuson Lin } 4746696777cSDuson Lin 4756696777cSDuson Lin return 0; 4766696777cSDuson Lin } 4776696777cSDuson Lin 4786696777cSDuson Lin static int elan_smbus_finish_fw_update(struct i2c_client *client, 4796696777cSDuson Lin struct completion *fw_completion) 4806696777cSDuson Lin { 4816696777cSDuson Lin /* No special handling unlike I2C transport */ 4826696777cSDuson Lin return 0; 4836696777cSDuson Lin } 4846696777cSDuson Lin 4856696777cSDuson Lin const struct elan_transport_ops elan_smbus_ops = { 4866696777cSDuson Lin .initialize = elan_smbus_initialize, 4876696777cSDuson Lin .sleep_control = elan_smbus_sleep_control, 4886696777cSDuson Lin .power_control = elan_smbus_power_control, 4896696777cSDuson Lin .set_mode = elan_smbus_set_mode, 4906696777cSDuson Lin 4916696777cSDuson Lin .calibrate = elan_smbus_calibrate, 4926696777cSDuson Lin .calibrate_result = elan_smbus_calibrate_result, 4936696777cSDuson Lin 4946696777cSDuson Lin .get_baseline_data = elan_smbus_get_baseline_data, 4956696777cSDuson Lin 4966696777cSDuson Lin .get_version = elan_smbus_get_version, 4976696777cSDuson Lin .get_sm_version = elan_smbus_get_sm_version, 4986696777cSDuson Lin .get_product_id = elan_smbus_get_product_id, 4996696777cSDuson Lin .get_checksum = elan_smbus_get_checksum, 5006696777cSDuson Lin 5016696777cSDuson Lin .get_max = elan_smbus_get_max, 5026696777cSDuson Lin .get_resolution = elan_smbus_get_resolution, 5036696777cSDuson Lin .get_num_traces = elan_smbus_get_num_traces, 5046696777cSDuson Lin 5056696777cSDuson Lin .iap_get_mode = elan_smbus_iap_get_mode, 5066696777cSDuson Lin .iap_reset = elan_smbus_iap_reset, 5076696777cSDuson Lin 5086696777cSDuson Lin .prepare_fw_update = elan_smbus_prepare_fw_update, 5096696777cSDuson Lin .write_fw_block = elan_smbus_write_fw_block, 5106696777cSDuson Lin .finish_fw_update = elan_smbus_finish_fw_update, 5116696777cSDuson Lin 5126696777cSDuson Lin .get_report = elan_smbus_get_report, 5136696777cSDuson Lin }; 514