[deliverable/linux.git] / drivers / input / mouse / elan_i2c_smbus.c

/*
 * Elan I2C/SMBus Touchpad driver - SMBus interface
 *
 * Copyright (c) 2013 ELAN Microelectronics Corp.
 *
 * Author: 林政維 (Duson Lin) <dusonlin@emc.com.tw>
 *
 * Based on cyapa driver:
 * copyright (c) 2011-2012 Cypress Semiconductor, Inc.
 * copyright (c) 2011-2012 Google, Inc.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published
 * by the Free Software Foundation.
 *
 * Trademarks are the property of their respective owners.
 */

#include <linux/delay.h>
#include <linux/i2c.h>
#include <linux/init.h>
#include <linux/kernel.h>

#include "elan_i2c.h"

/* Elan SMbus commands */
#define ETP_SMBUS_IAP_CMD		0x00
#define ETP_SMBUS_ENABLE_TP		0x20
#define ETP_SMBUS_SLEEP_CMD		0x21
#define ETP_SMBUS_IAP_PASSWORD_WRITE	0x29
#define ETP_SMBUS_IAP_PASSWORD_READ	0x80
#define ETP_SMBUS_WRITE_FW_BLOCK	0x2A
#define ETP_SMBUS_IAP_RESET_CMD		0x2B
#define ETP_SMBUS_RANGE_CMD		0xA0
#define ETP_SMBUS_FW_VERSION_CMD	0xA1
#define ETP_SMBUS_XY_TRACENUM_CMD	0xA2
#define ETP_SMBUS_SM_VERSION_CMD	0xA3
#define ETP_SMBUS_UNIQUEID_CMD		0xA3
#define ETP_SMBUS_RESOLUTION_CMD	0xA4
#define ETP_SMBUS_HELLOPACKET_CMD	0xA7
#define ETP_SMBUS_PACKET_QUERY		0xA8
#define ETP_SMBUS_IAP_VERSION_CMD	0xAC
#define ETP_SMBUS_IAP_CTRL_CMD		0xAD
#define ETP_SMBUS_IAP_CHECKSUM_CMD	0xAE
#define ETP_SMBUS_FW_CHECKSUM_CMD	0xAF
#define ETP_SMBUS_MAX_BASELINE_CMD	0xC3
#define ETP_SMBUS_MIN_BASELINE_CMD	0xC4
#define ETP_SMBUS_CALIBRATE_QUERY	0xC5

#define ETP_SMBUS_REPORT_LEN		32
#define ETP_SMBUS_REPORT_OFFSET		2
#define ETP_SMBUS_HELLOPACKET_LEN	5
#define ETP_SMBUS_IAP_PASSWORD		0x1234
#define ETP_SMBUS_IAP_MODE_ON		(1 << 6)

static int elan_smbus_initialize(struct i2c_client *client)
{
	u8 check[ETP_SMBUS_HELLOPACKET_LEN] = { 0x55, 0x55, 0x55, 0x55, 0x55 };
	u8 values[ETP_SMBUS_HELLOPACKET_LEN] = { 0, 0, 0, 0, 0 };
	int len, error;

	/* Get hello packet */
	len = i2c_smbus_read_block_data(client,
					ETP_SMBUS_HELLOPACKET_CMD, values);
	if (len != ETP_SMBUS_HELLOPACKET_LEN) {
		dev_err(&client->dev, "hello packet length fail: %d\n", len);
		error = len < 0 ? len : -EIO;
		return error;
	}

	/* compare hello packet */
	if (memcmp(values, check, ETP_SMBUS_HELLOPACKET_LEN)) {
		dev_err(&client->dev, "hello packet fail [%*ph]\n",
			ETP_SMBUS_HELLOPACKET_LEN, values);
		return -ENXIO;
	}

	/* enable tp */
	error = i2c_smbus_write_byte(client, ETP_SMBUS_ENABLE_TP);
	if (error) {
		dev_err(&client->dev, "failed to enable touchpad: %d\n", error);
		return error;
	}

	return 0;
}

static int elan_smbus_set_mode(struct i2c_client *client, u8 mode)
{
	u8 cmd[4] = { 0x00, 0x07, 0x00, mode };

	return i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD,
					  sizeof(cmd), cmd);
}

static int elan_smbus_sleep_control(struct i2c_client *client, bool sleep)
{
	if (sleep)
		return i2c_smbus_write_byte(client, ETP_SMBUS_SLEEP_CMD);
	else
		return 0; /* XXX should we send ETP_SMBUS_ENABLE_TP here? */
}

static int elan_smbus_power_control(struct i2c_client *client, bool enable)
{
	return 0; /* A no-op */
}

static int elan_smbus_calibrate(struct i2c_client *client)
{
	u8 cmd[4] = { 0x00, 0x08, 0x00, 0x01 };

	return i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD,
					  sizeof(cmd), cmd);
}

static int elan_smbus_calibrate_result(struct i2c_client *client, u8 *val)
{
	int error;

	error = i2c_smbus_read_block_data(client,
					  ETP_SMBUS_CALIBRATE_QUERY, val);
	if (error < 0)
		return error;

	return 0;
}

static int elan_smbus_get_baseline_data(struct i2c_client *client,
					bool max_baseline, u8 *value)
{
	int error;
	u8 val[3];

	error = i2c_smbus_read_block_data(client,
					  max_baseline ?
						ETP_SMBUS_MAX_BASELINE_CMD :
						ETP_SMBUS_MIN_BASELINE_CMD,
					  val);
	if (error < 0)
		return error;

	*value = be16_to_cpup((__be16 *)val);

	return 0;
}

static int elan_smbus_get_version(struct i2c_client *client,
				  bool iap, u8 *version)
{
	int error;
	u8 val[3];

	error = i2c_smbus_read_block_data(client,
					  iap ? ETP_SMBUS_IAP_VERSION_CMD :
						ETP_SMBUS_FW_VERSION_CMD,
					  val);
	if (error < 0) {
		dev_err(&client->dev, "failed to get %s version: %d\n",
			iap ? "IAP" : "FW", error);
		return error;
	}

	*version = val[2];
	return 0;
}

static int elan_smbus_get_sm_version(struct i2c_client *client,
				     u8 *ic_type, u8 *version)
{
	int error;
	u8 val[3];

	error = i2c_smbus_read_block_data(client,
					  ETP_SMBUS_SM_VERSION_CMD, val);
	if (error < 0) {
		dev_err(&client->dev, "failed to get SM version: %d\n", error);
		return error;
	}

	*version = val[0];
	*ic_type = val[1];
	return 0;
}

static int elan_smbus_get_product_id(struct i2c_client *client, u16 *id)
{
	int error;
	u8 val[3];

	error = i2c_smbus_read_block_data(client,
					  ETP_SMBUS_UNIQUEID_CMD, val);
	if (error < 0) {
		dev_err(&client->dev, "failed to get product ID: %d\n", error);
		return error;
	}

	*id = be16_to_cpup((__be16 *)val);
	return 0;
}

static int elan_smbus_get_checksum(struct i2c_client *client,
				   bool iap, u16 *csum)
{
	int error;
	u8 val[3];

	error = i2c_smbus_read_block_data(client,
					  iap ? ETP_SMBUS_FW_CHECKSUM_CMD :
						ETP_SMBUS_IAP_CHECKSUM_CMD,
					  val);
	if (error < 0) {
		dev_err(&client->dev, "failed to get %s checksum: %d\n",
			iap ? "IAP" : "FW", error);
		return error;
	}

	*csum = be16_to_cpup((__be16 *)val);
	return 0;
}

static int elan_smbus_get_max(struct i2c_client *client,
			      unsigned int *max_x, unsigned int *max_y)
{
	int error;
	u8 val[3];

	error = i2c_smbus_read_block_data(client, ETP_SMBUS_RANGE_CMD, val);
	if (error) {
		dev_err(&client->dev, "failed to get dimensions: %d\n", error);
		return error;
	}

	*max_x = (0x0f & val[0]) << 8 | val[1];
	*max_y = (0xf0 & val[0]) << 4 | val[2];

	return 0;
}

static int elan_smbus_get_resolution(struct i2c_client *client,
				     u8 *hw_res_x, u8 *hw_res_y)
{
	int error;
	u8 val[3];

	error = i2c_smbus_read_block_data(client,
					  ETP_SMBUS_RESOLUTION_CMD, val);
	if (error) {
		dev_err(&client->dev, "failed to get resolution: %d\n", error);
		return error;
	}

	*hw_res_x = val[1] & 0x0F;
	*hw_res_y = (val[1] & 0xF0) >> 4;

	return 0;
}

static int elan_smbus_get_num_traces(struct i2c_client *client,
				     unsigned int *x_traces,
				     unsigned int *y_traces)
{
	int error;
	u8 val[3];

	error = i2c_smbus_read_block_data(client,
					  ETP_SMBUS_XY_TRACENUM_CMD, val);
	if (error) {
		dev_err(&client->dev, "failed to get trace info: %d\n", error);
		return error;
	}

	*x_traces = val[1];
	*y_traces = val[2];

	return 0;
}

static int elan_smbus_get_pressure_adjustment(struct i2c_client *client,
					      int *adjustment)
{
	*adjustment = ETP_PRESSURE_OFFSET;
	return 0;
}

static int elan_smbus_iap_get_mode(struct i2c_client *client,
				   enum tp_mode *mode)
{
	int error;
	u16 constant;
	u8 val[3];

	error = i2c_smbus_read_block_data(client, ETP_SMBUS_IAP_CTRL_CMD, val);
	if (error < 0) {
		dev_err(&client->dev, "failed to read iap ctrol register: %d\n",
			error);
		return error;
	}

	constant = be16_to_cpup((__be16 *)val);
	dev_dbg(&client->dev, "iap control reg: 0x%04x.\n", constant);

	*mode = (constant & ETP_SMBUS_IAP_MODE_ON) ? IAP_MODE : MAIN_MODE;

	return 0;
}

static int elan_smbus_iap_reset(struct i2c_client *client)
{
	int error;

	error = i2c_smbus_write_byte(client, ETP_SMBUS_IAP_RESET_CMD);
	if (error) {
		dev_err(&client->dev, "cannot reset IC: %d\n", error);
		return error;
	}

	return 0;
}

static int elan_smbus_set_flash_key(struct i2c_client *client)
{
	int error;
	u8 cmd[4] = { 0x00, 0x0B, 0x00, 0x5A };

	error = i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD,
					   sizeof(cmd), cmd);
	if (error) {
		dev_err(&client->dev, "cannot set flash key: %d\n", error);
		return error;
	}

	return 0;
}

static int elan_smbus_prepare_fw_update(struct i2c_client *client)
{
	struct device *dev = &client->dev;
	int len;
	int error;
	enum tp_mode mode;
	u8 val[3];
	u8 cmd[4] = {0x0F, 0x78, 0x00, 0x06};
	u16 password;

	/* Get FW in which mode	(IAP_MODE/MAIN_MODE)  */
	error = elan_smbus_iap_get_mode(client, &mode);
	if (error)
		return error;

	if (mode == MAIN_MODE) {

		/* set flash key */
		error = elan_smbus_set_flash_key(client);
		if (error)
			return error;

		/* write iap password */
		if (i2c_smbus_write_byte(client,
					 ETP_SMBUS_IAP_PASSWORD_WRITE) < 0) {
			dev_err(dev, "cannot write iap password\n");
			return -EIO;
		}

		error = i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD,
						   sizeof(cmd), cmd);
		if (error) {
			dev_err(dev, "failed to write iap password: %d\n",
				error);
			return error;
		}

		/*
		 * Read back password to make sure we enabled flash
		 * successfully.
		 */
		len = i2c_smbus_read_block_data(client,
						ETP_SMBUS_IAP_PASSWORD_READ,
						val);
		if (len < sizeof(u16)) {
			error = len < 0 ? len : -EIO;
			dev_err(dev, "failed to read iap password: %d\n",
				error);
			return error;
		}

		password = be16_to_cpup((__be16 *)val);
		if (password != ETP_SMBUS_IAP_PASSWORD) {
			dev_err(dev, "wrong iap password = 0x%X\n", password);
			return -EIO;
		}

		/* Wait 30ms for MAIN_MODE change to IAP_MODE */
		msleep(30);
	}

	error = elan_smbus_set_flash_key(client);
	if (error)
		return error;

	/* Reset IC */
	error = elan_smbus_iap_reset(client);
	if (error)
		return error;

	return 0;
}


static int elan_smbus_write_fw_block(struct i2c_client *client,
				     const u8 *page, u16 checksum, int idx)
{
	struct device *dev = &client->dev;
	int error;
	u16 result;
	u8 val[3];

	/*
	 * Due to the limitation of smbus protocol limiting
	 * transfer to 32 bytes at a time, we must split block
	 * in 2 transfers.
	 */
	error = i2c_smbus_write_block_data(client,
					   ETP_SMBUS_WRITE_FW_BLOCK,
					   ETP_FW_PAGE_SIZE / 2,
					   page);
	if (error) {
		dev_err(dev, "Failed to write page %d (part %d): %d\n",
			idx, 1, error);
		return error;
	}

	error = i2c_smbus_write_block_data(client,
					   ETP_SMBUS_WRITE_FW_BLOCK,
					   ETP_FW_PAGE_SIZE / 2,
					   page + ETP_FW_PAGE_SIZE / 2);
	if (error) {
		dev_err(dev, "Failed to write page %d (part %d): %d\n",
			idx, 2, error);
		return error;
	}


	/* Wait for F/W to update one page ROM data. */
	usleep_range(8000, 10000);

	error = i2c_smbus_read_block_data(client,
					  ETP_SMBUS_IAP_CTRL_CMD, val);
	if (error < 0) {
		dev_err(dev, "Failed to read IAP write result: %d\n",
			error);
		return error;
	}

	result = be16_to_cpup((__be16 *)val);
	if (result & (ETP_FW_IAP_PAGE_ERR | ETP_FW_IAP_INTF_ERR)) {
		dev_err(dev, "IAP reports failed write: %04hx\n",
			result);
		return -EIO;
	}

	return 0;
}

static int elan_smbus_get_report(struct i2c_client *client, u8 *report)
{
	int len;

	len = i2c_smbus_read_block_data(client,
					ETP_SMBUS_PACKET_QUERY,
					&report[ETP_SMBUS_REPORT_OFFSET]);
	if (len < 0) {
		dev_err(&client->dev, "failed to read report data: %d\n", len);
		return len;
	}

	if (len != ETP_SMBUS_REPORT_LEN) {
		dev_err(&client->dev,
			"wrong report length (%d vs %d expected)\n",
			len, ETP_SMBUS_REPORT_LEN);
		return -EIO;
	}

	return 0;
}

static int elan_smbus_finish_fw_update(struct i2c_client *client,
				       struct completion *fw_completion)
{
	/* No special handling unlike I2C transport */
	return 0;
}

const struct elan_transport_ops elan_smbus_ops = {
	.initialize		= elan_smbus_initialize,
	.sleep_control		= elan_smbus_sleep_control,
	.power_control		= elan_smbus_power_control,
	.set_mode		= elan_smbus_set_mode,

	.calibrate		= elan_smbus_calibrate,
	.calibrate_result	= elan_smbus_calibrate_result,

	.get_baseline_data	= elan_smbus_get_baseline_data,

	.get_version		= elan_smbus_get_version,
	.get_sm_version		= elan_smbus_get_sm_version,
	.get_product_id		= elan_smbus_get_product_id,
	.get_checksum		= elan_smbus_get_checksum,
	.get_pressure_adjustment = elan_smbus_get_pressure_adjustment,

	.get_max		= elan_smbus_get_max,
	.get_resolution		= elan_smbus_get_resolution,
	.get_num_traces		= elan_smbus_get_num_traces,

	.iap_get_mode		= elan_smbus_iap_get_mode,
	.iap_reset		= elan_smbus_iap_reset,

	.prepare_fw_update	= elan_smbus_prepare_fw_update,
	.write_fw_block		= elan_smbus_write_fw_block,
	.finish_fw_update	= elan_smbus_finish_fw_update,

	.get_report		= elan_smbus_get_report,
};
Commit	Line	Data
6696777c DL	1	/*
	2	* Elan I2C/SMBus Touchpad driver - SMBus interface
	3	*
	4	* Copyright (c) 2013 ELAN Microelectronics Corp.
	5	*
	6	* Author: 林政維 (Duson Lin) <dusonlin@emc.com.tw>
6696777c DL	7	*
	8	* Based on cyapa driver:
	9	* copyright (c) 2011-2012 Cypress Semiconductor, Inc.
	10	* copyright (c) 2011-2012 Google, Inc.
	11	*
	12	* This program is free software; you can redistribute it and/or modify it
	13	* under the terms of the GNU General Public License version 2 as published
	14	* by the Free Software Foundation.
	15	*
	16	* Trademarks are the property of their respective owners.
	17	*/
	18
	19	#include <linux/delay.h>
	20	#include <linux/i2c.h>
	21	#include <linux/init.h>
	22	#include <linux/kernel.h>
	23
	24	#include "elan_i2c.h"
	25
	26	/* Elan SMbus commands */
	27	#define ETP_SMBUS_IAP_CMD 0x00
	28	#define ETP_SMBUS_ENABLE_TP 0x20
	29	#define ETP_SMBUS_SLEEP_CMD 0x21
	30	#define ETP_SMBUS_IAP_PASSWORD_WRITE 0x29
	31	#define ETP_SMBUS_IAP_PASSWORD_READ 0x80
	32	#define ETP_SMBUS_WRITE_FW_BLOCK 0x2A
	33	#define ETP_SMBUS_IAP_RESET_CMD 0x2B
	34	#define ETP_SMBUS_RANGE_CMD 0xA0
	35	#define ETP_SMBUS_FW_VERSION_CMD 0xA1
	36	#define ETP_SMBUS_XY_TRACENUM_CMD 0xA2
	37	#define ETP_SMBUS_SM_VERSION_CMD 0xA3
	38	#define ETP_SMBUS_UNIQUEID_CMD 0xA3
	39	#define ETP_SMBUS_RESOLUTION_CMD 0xA4
	40	#define ETP_SMBUS_HELLOPACKET_CMD 0xA7
	41	#define ETP_SMBUS_PACKET_QUERY 0xA8
	42	#define ETP_SMBUS_IAP_VERSION_CMD 0xAC
	43	#define ETP_SMBUS_IAP_CTRL_CMD 0xAD
	44	#define ETP_SMBUS_IAP_CHECKSUM_CMD 0xAE
	45	#define ETP_SMBUS_FW_CHECKSUM_CMD 0xAF
	46	#define ETP_SMBUS_MAX_BASELINE_CMD 0xC3
	47	#define ETP_SMBUS_MIN_BASELINE_CMD 0xC4
	48	#define ETP_SMBUS_CALIBRATE_QUERY 0xC5
	49
	50	#define ETP_SMBUS_REPORT_LEN 32
	51	#define ETP_SMBUS_REPORT_OFFSET 2
	52	#define ETP_SMBUS_HELLOPACKET_LEN 5
	53	#define ETP_SMBUS_IAP_PASSWORD 0x1234
	54	#define ETP_SMBUS_IAP_MODE_ON (1 << 6)
	55
	56	static int elan_smbus_initialize(struct i2c_client *client)
	57	{
	58	u8 check[ETP_SMBUS_HELLOPACKET_LEN] = { 0x55, 0x55, 0x55, 0x55, 0x55 };
	59	u8 values[ETP_SMBUS_HELLOPACKET_LEN] = { 0, 0, 0, 0, 0 };
	60	int len, error;
	61
	62	/* Get hello packet */
	63	len = i2c_smbus_read_block_data(client,
	64	ETP_SMBUS_HELLOPACKET_CMD, values);
	65	if (len != ETP_SMBUS_HELLOPACKET_LEN) {
	66	dev_err(&client->dev, "hello packet length fail: %d\n", len);
	67	error = len < 0 ? len : -EIO;
	68	return error;
	69	}
	70
71	/* compare hello packet */
72	if (memcmp(values, check, ETP_SMBUS_HELLOPACKET_LEN)) {
98a4a59e	73	dev_err(&client->dev, "hello packet fail [%*ph]\n",
6696777c DL	74	ETP_SMBUS_HELLOPACKET_LEN, values);
	75	return -ENXIO;
	76	}
	77
	78	/* enable tp */
	79	error = i2c_smbus_write_byte(client, ETP_SMBUS_ENABLE_TP);
	80	if (error) {
	81	dev_err(&client->dev, "failed to enable touchpad: %d\n", error);
	82	return error;
	83	}
	84
	85	return 0;
	86	}
	87
	88	static int elan_smbus_set_mode(struct i2c_client *client, u8 mode)
	89	{
	90	u8 cmd[4] = { 0x00, 0x07, 0x00, mode };
	91
	92	return i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD,
	93	sizeof(cmd), cmd);
	94	}
	95
	96	static int elan_smbus_sleep_control(struct i2c_client *client, bool sleep)
	97	{
	98	if (sleep)
	99	return i2c_smbus_write_byte(client, ETP_SMBUS_SLEEP_CMD);
	100	else
	101	return 0; /* XXX should we send ETP_SMBUS_ENABLE_TP here? */
	102	}
	103
	104	static int elan_smbus_power_control(struct i2c_client *client, bool enable)
	105	{
	106	return 0; /* A no-op */
	107	}
	108
	109	static int elan_smbus_calibrate(struct i2c_client *client)
	110	{
	111	u8 cmd[4] = { 0x00, 0x08, 0x00, 0x01 };
	112
	113	return i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD,
	114	sizeof(cmd), cmd);
	115	}
	116
	117	static int elan_smbus_calibrate_result(struct i2c_client client, u8 val)
	118	{
	119	int error;
	120
	121	error = i2c_smbus_read_block_data(client,
	122	ETP_SMBUS_CALIBRATE_QUERY, val);
	123	if (error < 0)
	124	return error;
	125
	126	return 0;
	127	}
	128
	129	static int elan_smbus_get_baseline_data(struct i2c_client *client,
	130	bool max_baseline, u8 *value)
	131	{
	132	int error;
	133	u8 val[3];
	134
	135	error = i2c_smbus_read_block_data(client,
	136	max_baseline ?
	137	ETP_SMBUS_MAX_BASELINE_CMD :
138	ETP_SMBUS_MIN_BASELINE_CMD,
139	val);
140	if (error < 0)
141	return error;
142
143	value = be16_to_cpup((__be16 )val);
144
145	return 0;
146	}
147
148	static int elan_smbus_get_version(struct i2c_client *client,
149	bool iap, u8 *version)
150	{
151	int error;
152	u8 val[3];
153
154	error = i2c_smbus_read_block_data(client,
155	iap ? ETP_SMBUS_IAP_VERSION_CMD :
156	ETP_SMBUS_FW_VERSION_CMD,
157	val);
158	if (error < 0) {
159	dev_err(&client->dev, "failed to get %s version: %d\n",
160	iap ? "IAP" : "FW", error);
161	return error;
162	}
163
164	*version = val[2];
165	return 0;
166	}
167
12018ac3 DL	168	static int elan_smbus_get_sm_version(struct i2c_client *client,
12018ac3 DL	169	u8 ic_type, u8 version)
6696777c DL	170	{
	171	int error;
	172	u8 val[3];
	173
	174	error = i2c_smbus_read_block_data(client,
	175	ETP_SMBUS_SM_VERSION_CMD, val);
	176	if (error < 0) {
	177	dev_err(&client->dev, "failed to get SM version: %d\n", error);
	178	return error;
	179	}
	180
12018ac3 DL	181	*version = val[0];
12018ac3 DL	182	*ic_type = val[1];
6696777c DL	183	return 0;
	184	}
	185
ed75a14e	186	static int elan_smbus_get_product_id(struct i2c_client client, u16 id)
6696777c DL	187	{
	188	int error;
	189	u8 val[3];
	190
	191	error = i2c_smbus_read_block_data(client,
	192	ETP_SMBUS_UNIQUEID_CMD, val);
	193	if (error < 0) {
	194	dev_err(&client->dev, "failed to get product ID: %d\n", error);
	195	return error;
	196	}
	197
ed75a14e	198	id = be16_to_cpup((__be16 )val);
6696777c DL	199	return 0;
	200	}
	201
	202	static int elan_smbus_get_checksum(struct i2c_client *client,
	203	bool iap, u16 *csum)
	204	{
	205	int error;
	206	u8 val[3];
	207
	208	error = i2c_smbus_read_block_data(client,
	209	iap ? ETP_SMBUS_FW_CHECKSUM_CMD :
	210	ETP_SMBUS_IAP_CHECKSUM_CMD,
	211	val);
	212	if (error < 0) {
	213	dev_err(&client->dev, "failed to get %s checksum: %d\n",
	214	iap ? "IAP" : "FW", error);
	215	return error;
	216	}
	217
	218	csum = be16_to_cpup((__be16 )val);
	219	return 0;
	220	}
	221
	222	static int elan_smbus_get_max(struct i2c_client *client,
	223	unsigned int max_x, unsigned int max_y)
	224	{
	225	int error;
	226	u8 val[3];
	227
	228	error = i2c_smbus_read_block_data(client, ETP_SMBUS_RANGE_CMD, val);
	229	if (error) {
	230	dev_err(&client->dev, "failed to get dimensions: %d\n", error);
	231	return error;
	232	}
	233
	234	*max_x = (0x0f & val[0]) << 8 \| val[1];
	235	*max_y = (0xf0 & val[0]) << 4 \| val[2];
	236
	237	return 0;
	238	}
	239
	240	static int elan_smbus_get_resolution(struct i2c_client *client,
	241	u8 hw_res_x, u8 hw_res_y)
	242	{
	243	int error;
	244	u8 val[3];
	245
	246	error = i2c_smbus_read_block_data(client,
	247	ETP_SMBUS_RESOLUTION_CMD, val);
	248	if (error) {
	249	dev_err(&client->dev, "failed to get resolution: %d\n", error);
	250	return error;
	251	}
	252
	253	*hw_res_x = val[1] & 0x0F;
	254	*hw_res_y = (val[1] & 0xF0) >> 4;
	255
	256	return 0;
	257	}
	258
	259	static int elan_smbus_get_num_traces(struct i2c_client *client,
	260	unsigned int *x_traces,
	261	unsigned int *y_traces)
	262	{
263	int error;
264	u8 val[3];
265
266	error = i2c_smbus_read_block_data(client,
267	ETP_SMBUS_XY_TRACENUM_CMD, val);
268	if (error) {
269	dev_err(&client->dev, "failed to get trace info: %d\n", error);
270	return error;
271	}
272
9f423801 DL	273	*x_traces = val[1];
9f423801 DL	274	*y_traces = val[2];
6696777c DL	275
	276	return 0;
	277	}
	278
b9bced0e	279	static int elan_smbus_get_pressure_adjustment(struct i2c_client *client,
	280	int *adjustment)
	281	{
	282	*adjustment = ETP_PRESSURE_OFFSET;
	283	return 0;
	284	}
	285
6696777c DL	286	static int elan_smbus_iap_get_mode(struct i2c_client *client,
	287	enum tp_mode *mode)
	288	{
	289	int error;
	290	u16 constant;
	291	u8 val[3];
	292
	293	error = i2c_smbus_read_block_data(client, ETP_SMBUS_IAP_CTRL_CMD, val);
	294	if (error < 0) {
	295	dev_err(&client->dev, "failed to read iap ctrol register: %d\n",
	296	error);
	297	return error;
	298	}
	299
	300	constant = be16_to_cpup((__be16 *)val);
	301	dev_dbg(&client->dev, "iap control reg: 0x%04x.\n", constant);
	302
	303	*mode = (constant & ETP_SMBUS_IAP_MODE_ON) ? IAP_MODE : MAIN_MODE;
	304
	305	return 0;
	306	}
	307
	308	static int elan_smbus_iap_reset(struct i2c_client *client)
	309	{
	310	int error;
	311
	312	error = i2c_smbus_write_byte(client, ETP_SMBUS_IAP_RESET_CMD);
	313	if (error) {
	314	dev_err(&client->dev, "cannot reset IC: %d\n", error);
	315	return error;
	316	}
	317
	318	return 0;
	319	}
	320
	321	static int elan_smbus_set_flash_key(struct i2c_client *client)
	322	{
	323	int error;
	324	u8 cmd[4] = { 0x00, 0x0B, 0x00, 0x5A };
	325
	326	error = i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD,
	327	sizeof(cmd), cmd);
	328	if (error) {
	329	dev_err(&client->dev, "cannot set flash key: %d\n", error);
	330	return error;
	331	}
	332
	333	return 0;
	334	}
	335
	336	static int elan_smbus_prepare_fw_update(struct i2c_client *client)
	337	{
	338	struct device *dev = &client->dev;
	339	int len;
	340	int error;
	341	enum tp_mode mode;
	342	u8 val[3];
	343	u8 cmd[4] = {0x0F, 0x78, 0x00, 0x06};
	344	u16 password;
	345
	346	/* Get FW in which mode (IAP_MODE/MAIN_MODE) */
	347	error = elan_smbus_iap_get_mode(client, &mode);
	348	if (error)
	349	return error;
350
351	if (mode == MAIN_MODE) {
352
353	/* set flash key */
354	error = elan_smbus_set_flash_key(client);
355	if (error)
356	return error;
357
358	/* write iap password */
359	if (i2c_smbus_write_byte(client,
360	ETP_SMBUS_IAP_PASSWORD_WRITE) < 0) {
361	dev_err(dev, "cannot write iap password\n");
362	return -EIO;
363	}
364
365	error = i2c_smbus_write_block_data(client, ETP_SMBUS_IAP_CMD,
366	sizeof(cmd), cmd);
367	if (error) {
368	dev_err(dev, "failed to write iap password: %d\n",
369	error);
370	return error;
371	}
372
373	/*
374	* Read back password to make sure we enabled flash
375	* successfully.
376	*/
377	len = i2c_smbus_read_block_data(client,
378	ETP_SMBUS_IAP_PASSWORD_READ,
379	val);
380	if (len < sizeof(u16)) {
381	error = len < 0 ? len : -EIO;
382	dev_err(dev, "failed to read iap password: %d\n",
383	error);
384	return error;
385	}
386
387	password = be16_to_cpup((__be16 *)val);
388	if (password != ETP_SMBUS_IAP_PASSWORD) {
389	dev_err(dev, "wrong iap password = 0x%X\n", password);
390	return -EIO;
391	}
392
393	/* Wait 30ms for MAIN_MODE change to IAP_MODE */
394	msleep(30);
395	}
396
397	error = elan_smbus_set_flash_key(client);
398	if (error)
399	return error;
400
401	/* Reset IC */
402	error = elan_smbus_iap_reset(client);
403	if (error)
404	return error;
405
406	return 0;
407	}
408
409
410	static int elan_smbus_write_fw_block(struct i2c_client *client,
411	const u8 *page, u16 checksum, int idx)
412	{
413	struct device *dev = &client->dev;
414	int error;
415	u16 result;
416	u8 val[3];
417
418	/*
419	* Due to the limitation of smbus protocol limiting
420	* transfer to 32 bytes at a time, we must split block
421	* in 2 transfers.
422	*/
423	error = i2c_smbus_write_block_data(client,
424	ETP_SMBUS_WRITE_FW_BLOCK,
425	ETP_FW_PAGE_SIZE / 2,
426	page);
427	if (error) {
428	dev_err(dev, "Failed to write page %d (part %d): %d\n",
429	idx, 1, error);
430	return error;
431	}
432
433	error = i2c_smbus_write_block_data(client,
434	ETP_SMBUS_WRITE_FW_BLOCK,
435	ETP_FW_PAGE_SIZE / 2,
436	page + ETP_FW_PAGE_SIZE / 2);
437	if (error) {
438	dev_err(dev, "Failed to write page %d (part %d): %d\n",
439	idx, 2, error);
440	return error;
441	}
442
443
444	/* Wait for F/W to update one page ROM data. */
445	usleep_range(8000, 10000);
446
447	error = i2c_smbus_read_block_data(client,
448	ETP_SMBUS_IAP_CTRL_CMD, val);
449	if (error < 0) {
450	dev_err(dev, "Failed to read IAP write result: %d\n",
451	error);
452	return error;
453	}
454
455	result = be16_to_cpup((__be16 *)val);
456	if (result & (ETP_FW_IAP_PAGE_ERR \| ETP_FW_IAP_INTF_ERR)) {
457	dev_err(dev, "IAP reports failed write: %04hx\n",
458	result);
459	return -EIO;
460	}
461
462	return 0;
463	}
464
465	static int elan_smbus_get_report(struct i2c_client client, u8 report)
466	{
467	int len;
468
469	len = i2c_smbus_read_block_data(client,
470	ETP_SMBUS_PACKET_QUERY,
471	&report[ETP_SMBUS_REPORT_OFFSET]);
472	if (len < 0) {
473	dev_err(&client->dev, "failed to read report data: %d\n", len);
474	return len;
475	}
476
477	if (len != ETP_SMBUS_REPORT_LEN) {
478	dev_err(&client->dev,
479	"wrong report length (%d vs %d expected)\n",
480	len, ETP_SMBUS_REPORT_LEN);
481	return -EIO;
482	}
483
484	return 0;
485	}
486
487	static int elan_smbus_finish_fw_update(struct i2c_client *client,
488	struct completion *fw_completion)
489	{
490	/* No special handling unlike I2C transport */
491	return 0;
492	}
493
494	const struct elan_transport_ops elan_smbus_ops = {
495	.initialize = elan_smbus_initialize,
496	.sleep_control = elan_smbus_sleep_control,
497	.power_control = elan_smbus_power_control,
498	.set_mode = elan_smbus_set_mode,
499
500	.calibrate = elan_smbus_calibrate,
501	.calibrate_result = elan_smbus_calibrate_result,
502
503	.get_baseline_data = elan_smbus_get_baseline_data,
504
505	.get_version = elan_smbus_get_version,
506	.get_sm_version = elan_smbus_get_sm_version,
507	.get_product_id = elan_smbus_get_product_id,
508	.get_checksum = elan_smbus_get_checksum,
b9bced0e	509	.get_pressure_adjustment = elan_smbus_get_pressure_adjustment,
6696777c DL	510
	511	.get_max = elan_smbus_get_max,
	512	.get_resolution = elan_smbus_get_resolution,
	513	.get_num_traces = elan_smbus_get_num_traces,
	514
	515	.iap_get_mode = elan_smbus_iap_get_mode,
	516	.iap_reset = elan_smbus_iap_reset,
	517
	518	.prepare_fw_update = elan_smbus_prepare_fw_update,
	519	.write_fw_block = elan_smbus_write_fw_block,
	520	.finish_fw_update = elan_smbus_finish_fw_update,
	521
	522	.get_report = elan_smbus_get_report,
	523	};