[linux.git] / drivers / input / rmi4 / rmi_i2c.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (c) 2011-2016 Synaptics Incorporated
 * Copyright (c) 2011 Unixphere
 */

#include <linux/i2c.h>
#include <linux/rmi.h>
#include <linux/of.h>
#include <linux/delay.h>
#include <linux/regulator/consumer.h>
#include "rmi_driver.h"

#define BUFFER_SIZE_INCREMENT 32

/**
 * struct rmi_i2c_xport - stores information for i2c communication
 *
 * @xport: The transport interface structure
 * @client: The I2C client device structure
 *
 * @page_mutex: Locks current page to avoid changing pages in unexpected ways.
 * @page: Keeps track of the current virtual page
 *
 * @tx_buf: Buffer used for transmitting data to the sensor over i2c.
 * @tx_buf_size: Size of the buffer
 *
 * @supplies: Array of voltage regulators
 * @startup_delay: Milliseconds to pause after powering up the regulators
 */
struct rmi_i2c_xport {
	struct rmi_transport_dev xport;
	struct i2c_client *client;

	struct mutex page_mutex;
	int page;

	u8 *tx_buf;
	size_t tx_buf_size;

	struct regulator_bulk_data supplies[2];
	u32 startup_delay;
};

#define RMI_PAGE_SELECT_REGISTER 0xff
#define RMI_I2C_PAGE(addr) (((addr) >> 8) & 0xff)

/*
 * rmi_set_page - Set RMI page
 * @xport: The pointer to the rmi_transport_dev struct
 * @page: The new page address.
 *
 * RMI devices have 16-bit addressing, but some of the transport
 * implementations (like SMBus) only have 8-bit addressing. So RMI implements
 * a page address at 0xff of every page so we can reliable page addresses
 * every 256 registers.
 *
 * The page_mutex lock must be held when this function is entered.
 *
 * Returns zero on success, non-zero on failure.
 */
static int rmi_set_page(struct rmi_i2c_xport *rmi_i2c, u8 page)
{
	struct i2c_client *client = rmi_i2c->client;
	u8 txbuf[2] = {RMI_PAGE_SELECT_REGISTER, page};
	int retval;

	retval = i2c_master_send(client, txbuf, sizeof(txbuf));
	if (retval != sizeof(txbuf)) {
		dev_err(&client->dev,
			"%s: set page failed: %d.", __func__, retval);
		return (retval < 0) ? retval : -EIO;
	}

	rmi_i2c->page = page;
	return 0;
}

static int rmi_i2c_write_block(struct rmi_transport_dev *xport, u16 addr,
			       const void *buf, size_t len)
{
	struct rmi_i2c_xport *rmi_i2c =
		container_of(xport, struct rmi_i2c_xport, xport);
	struct i2c_client *client = rmi_i2c->client;
	size_t tx_size = len + 1;
	int retval;

	mutex_lock(&rmi_i2c->page_mutex);

	if (!rmi_i2c->tx_buf || rmi_i2c->tx_buf_size < tx_size) {
		if (rmi_i2c->tx_buf)
			devm_kfree(&client->dev, rmi_i2c->tx_buf);
		rmi_i2c->tx_buf_size = tx_size + BUFFER_SIZE_INCREMENT;
		rmi_i2c->tx_buf = devm_kzalloc(&client->dev,
					       rmi_i2c->tx_buf_size,
					       GFP_KERNEL);
		if (!rmi_i2c->tx_buf) {
			rmi_i2c->tx_buf_size = 0;
			retval = -ENOMEM;
			goto exit;
		}
	}

	rmi_i2c->tx_buf[0] = addr & 0xff;
	memcpy(rmi_i2c->tx_buf + 1, buf, len);

	if (RMI_I2C_PAGE(addr) != rmi_i2c->page) {
		retval = rmi_set_page(rmi_i2c, RMI_I2C_PAGE(addr));
		if (retval)
			goto exit;
	}

	retval = i2c_master_send(client, rmi_i2c->tx_buf, tx_size);
	if (retval == tx_size)
		retval = 0;
	else if (retval >= 0)
		retval = -EIO;

exit:
	rmi_dbg(RMI_DEBUG_XPORT, &client->dev,
		"write %zd bytes at %#06x: %d (%*ph)\n",
		len, addr, retval, (int)len, buf);

	mutex_unlock(&rmi_i2c->page_mutex);
	return retval;
}

static int rmi_i2c_read_block(struct rmi_transport_dev *xport, u16 addr,
			      void *buf, size_t len)
{
	struct rmi_i2c_xport *rmi_i2c =
		container_of(xport, struct rmi_i2c_xport, xport);
	struct i2c_client *client = rmi_i2c->client;
	u8 addr_offset = addr & 0xff;
	int retval;
	struct i2c_msg msgs[] = {
		{
			.addr	= client->addr,
			.len	= sizeof(addr_offset),
			.buf	= &addr_offset,
		},
		{
			.addr	= client->addr,
			.flags	= I2C_M_RD,
			.len	= len,
			.buf	= buf,
		},
	};

	mutex_lock(&rmi_i2c->page_mutex);

	if (RMI_I2C_PAGE(addr) != rmi_i2c->page) {
		retval = rmi_set_page(rmi_i2c, RMI_I2C_PAGE(addr));
		if (retval)
			goto exit;
	}

	retval = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
	if (retval == ARRAY_SIZE(msgs))
		retval = 0; /* success */
	else if (retval >= 0)
		retval = -EIO;

exit:
	rmi_dbg(RMI_DEBUG_XPORT, &client->dev,
		"read %zd bytes at %#06x: %d (%*ph)\n",
		len, addr, retval, (int)len, buf);

	mutex_unlock(&rmi_i2c->page_mutex);
	return retval;
}

static const struct rmi_transport_ops rmi_i2c_ops = {
	.write_block	= rmi_i2c_write_block,
	.read_block	= rmi_i2c_read_block,
};

#ifdef CONFIG_OF
static const struct of_device_id rmi_i2c_of_match[] = {
	{ .compatible = "syna,rmi4-i2c" },
	{},
};
MODULE_DEVICE_TABLE(of, rmi_i2c_of_match);
#endif

static void rmi_i2c_regulator_bulk_disable(void *data)
{
	struct rmi_i2c_xport *rmi_i2c = data;

	regulator_bulk_disable(ARRAY_SIZE(rmi_i2c->supplies),
			       rmi_i2c->supplies);
}

static void rmi_i2c_unregister_transport(void *data)
{
	struct rmi_i2c_xport *rmi_i2c = data;

	rmi_unregister_transport_device(&rmi_i2c->xport);
}

static int rmi_i2c_probe(struct i2c_client *client)
{
	struct rmi_device_platform_data *pdata;
	struct rmi_device_platform_data *client_pdata =
					dev_get_platdata(&client->dev);
	struct rmi_i2c_xport *rmi_i2c;
	int error;

	rmi_i2c = devm_kzalloc(&client->dev, sizeof(struct rmi_i2c_xport),
				GFP_KERNEL);
	if (!rmi_i2c)
		return -ENOMEM;

	pdata = &rmi_i2c->xport.pdata;

	if (!client->dev.of_node && client_pdata)
		*pdata = *client_pdata;

	pdata->irq = client->irq;

	rmi_dbg(RMI_DEBUG_XPORT, &client->dev, "Probing %s.\n",
			dev_name(&client->dev));

	if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
		dev_err(&client->dev,
			"adapter does not support required functionality\n");
		return -ENODEV;
	}

	rmi_i2c->supplies[0].supply = "vdd";
	rmi_i2c->supplies[1].supply = "vio";
	error = devm_regulator_bulk_get(&client->dev,
					 ARRAY_SIZE(rmi_i2c->supplies),
					 rmi_i2c->supplies);
	if (error < 0)
		return error;

	error = regulator_bulk_enable(ARRAY_SIZE(rmi_i2c->supplies),
				       rmi_i2c->supplies);
	if (error < 0)
		return error;

	error = devm_add_action_or_reset(&client->dev,
					  rmi_i2c_regulator_bulk_disable,
					  rmi_i2c);
	if (error)
		return error;

	of_property_read_u32(client->dev.of_node, "syna,startup-delay-ms",
			     &rmi_i2c->startup_delay);

	msleep(rmi_i2c->startup_delay);

	rmi_i2c->client = client;
	mutex_init(&rmi_i2c->page_mutex);

	rmi_i2c->xport.dev = &client->dev;
	rmi_i2c->xport.proto_name = "i2c";
	rmi_i2c->xport.ops = &rmi_i2c_ops;

	i2c_set_clientdata(client, rmi_i2c);

	/*
	 * Setting the page to zero will (a) make sure the PSR is in a
	 * known state, and (b) make sure we can talk to the device.
	 */
	error = rmi_set_page(rmi_i2c, 0);
	if (error) {
		dev_err(&client->dev, "Failed to set page select to 0\n");
		return error;
	}

	dev_info(&client->dev, "registering I2C-connected sensor\n");

	error = rmi_register_transport_device(&rmi_i2c->xport);
	if (error) {
		dev_err(&client->dev, "failed to register sensor: %d\n", error);
		return error;
	}

	error = devm_add_action_or_reset(&client->dev,
					  rmi_i2c_unregister_transport,
					  rmi_i2c);
	if (error)
		return error;

	return 0;
}

static int rmi_i2c_suspend(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client);
	int ret;

	ret = rmi_driver_suspend(rmi_i2c->xport.rmi_dev, true);
	if (ret)
		dev_warn(dev, "Failed to resume device: %d\n", ret);

	regulator_bulk_disable(ARRAY_SIZE(rmi_i2c->supplies),
			       rmi_i2c->supplies);

	return ret;
}

static int rmi_i2c_resume(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client);
	int ret;

	ret = regulator_bulk_enable(ARRAY_SIZE(rmi_i2c->supplies),
				    rmi_i2c->supplies);
	if (ret)
		return ret;

	msleep(rmi_i2c->startup_delay);

	ret = rmi_driver_resume(rmi_i2c->xport.rmi_dev, true);
	if (ret)
		dev_warn(dev, "Failed to resume device: %d\n", ret);

	return ret;
}

static int rmi_i2c_runtime_suspend(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client);
	int ret;

	ret = rmi_driver_suspend(rmi_i2c->xport.rmi_dev, false);
	if (ret)
		dev_warn(dev, "Failed to resume device: %d\n", ret);

	regulator_bulk_disable(ARRAY_SIZE(rmi_i2c->supplies),
			       rmi_i2c->supplies);

	return 0;
}

static int rmi_i2c_runtime_resume(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client);
	int ret;

	ret = regulator_bulk_enable(ARRAY_SIZE(rmi_i2c->supplies),
				    rmi_i2c->supplies);
	if (ret)
		return ret;

	msleep(rmi_i2c->startup_delay);

	ret = rmi_driver_resume(rmi_i2c->xport.rmi_dev, false);
	if (ret)
		dev_warn(dev, "Failed to resume device: %d\n", ret);

	return 0;
}

static const struct dev_pm_ops rmi_i2c_pm = {
	SYSTEM_SLEEP_PM_OPS(rmi_i2c_suspend, rmi_i2c_resume)
	RUNTIME_PM_OPS(rmi_i2c_runtime_suspend, rmi_i2c_runtime_resume, NULL)
};

static const struct i2c_device_id rmi_id[] = {
	{ "rmi4_i2c" },
	{ }
};
MODULE_DEVICE_TABLE(i2c, rmi_id);

static struct i2c_driver rmi_i2c_driver = {
	.driver = {
		.name	= "rmi4_i2c",
		.pm	= pm_ptr(&rmi_i2c_pm),
		.of_match_table = of_match_ptr(rmi_i2c_of_match),
	},
	.id_table	= rmi_id,
	.probe		= rmi_i2c_probe,
};

module_i2c_driver(rmi_i2c_driver);

MODULE_AUTHOR("Christopher Heiny <[email protected]>");
MODULE_AUTHOR("Andrew Duggan <[email protected]>");
MODULE_DESCRIPTION("RMI I2C driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
fdf51604 AD	2	/*
	3	* Copyright (c) 2011-2016 Synaptics Incorporated
	4	* Copyright (c) 2011 Unixphere
fdf51604 AD	5	*/
	6
	7	#include <linux/i2c.h>
	8	#include <linux/rmi.h>
d8a8b3ed	9	#include <linux/of.h>
946c8432 BA	10	#include <linux/delay.h>
946c8432 BA	11	#include <linux/regulator/consumer.h>
fdf51604 AD	12	#include "rmi_driver.h"
	13
	14	#define BUFFER_SIZE_INCREMENT 32
	15
	16	/**
	17	* struct rmi_i2c_xport - stores information for i2c communication
	18	*
	19	* @xport: The transport interface structure
7e909891	20	* @client: The I2C client device structure
fdf51604 AD	21	*
	22	* @page_mutex: Locks current page to avoid changing pages in unexpected ways.
	23	* @page: Keeps track of the current virtual page
	24	*
	25	* @tx_buf: Buffer used for transmitting data to the sensor over i2c.
	26	* @tx_buf_size: Size of the buffer
7e909891 LJ	27	*
	28	* @supplies: Array of voltage regulators
	29	* @startup_delay: Milliseconds to pause after powering up the regulators
fdf51604 AD	30	*/
	31	struct rmi_i2c_xport {
	32	struct rmi_transport_dev xport;
	33	struct i2c_client *client;
	34
	35	struct mutex page_mutex;
	36	int page;
	37
fdf51604 AD	38	u8 *tx_buf;
fdf51604 AD	39	size_t tx_buf_size;
946c8432 BA	40
	41	struct regulator_bulk_data supplies[2];
	42	u32 startup_delay;
fdf51604 AD	43	};
	44
	45	#define RMI_PAGE_SELECT_REGISTER 0xff
	46	#define RMI_I2C_PAGE(addr) (((addr) >> 8) & 0xff)
	47
	48	/*
	49	* rmi_set_page - Set RMI page
	50	* @xport: The pointer to the rmi_transport_dev struct
	51	* @page: The new page address.
	52	*
	53	* RMI devices have 16-bit addressing, but some of the transport
	54	* implementations (like SMBus) only have 8-bit addressing. So RMI implements
	55	* a page address at 0xff of every page so we can reliable page addresses
	56	* every 256 registers.
	57	*
	58	* The page_mutex lock must be held when this function is entered.
	59	*
	60	* Returns zero on success, non-zero on failure.
	61	*/
	62	static int rmi_set_page(struct rmi_i2c_xport *rmi_i2c, u8 page)
	63	{
	64	struct i2c_client *client = rmi_i2c->client;
	65	u8 txbuf[2] = {RMI_PAGE_SELECT_REGISTER, page};
	66	int retval;
	67
	68	retval = i2c_master_send(client, txbuf, sizeof(txbuf));
	69	if (retval != sizeof(txbuf)) {
	70	dev_err(&client->dev,
	71	"%s: set page failed: %d.", __func__, retval);
	72	return (retval < 0) ? retval : -EIO;
	73	}
	74
	75	rmi_i2c->page = page;
	76	return 0;
	77	}
	78
	79	static int rmi_i2c_write_block(struct rmi_transport_dev *xport, u16 addr,
	80	const void *buf, size_t len)
	81	{
	82	struct rmi_i2c_xport *rmi_i2c =
	83	container_of(xport, struct rmi_i2c_xport, xport);
	84	struct i2c_client *client = rmi_i2c->client;
	85	size_t tx_size = len + 1;
	86	int retval;
	87
	88	mutex_lock(&rmi_i2c->page_mutex);
	89
	90	if (!rmi_i2c->tx_buf \|\| rmi_i2c->tx_buf_size < tx_size) {
	91	if (rmi_i2c->tx_buf)
	92	devm_kfree(&client->dev, rmi_i2c->tx_buf);
	93	rmi_i2c->tx_buf_size = tx_size + BUFFER_SIZE_INCREMENT;
	94	rmi_i2c->tx_buf = devm_kzalloc(&client->dev,
	95	rmi_i2c->tx_buf_size,
	96	GFP_KERNEL);
	97	if (!rmi_i2c->tx_buf) {
	98	rmi_i2c->tx_buf_size = 0;
	99	retval = -ENOMEM;
	100	goto exit;
	101	}
	102	}
	103
	104	rmi_i2c->tx_buf[0] = addr & 0xff;
	105	memcpy(rmi_i2c->tx_buf + 1, buf, len);
	106
107	if (RMI_I2C_PAGE(addr) != rmi_i2c->page) {
108	retval = rmi_set_page(rmi_i2c, RMI_I2C_PAGE(addr));
109	if (retval)
110	goto exit;
111	}
112
113	retval = i2c_master_send(client, rmi_i2c->tx_buf, tx_size);
114	if (retval == tx_size)
115	retval = 0;
116	else if (retval >= 0)
117	retval = -EIO;
118
119	exit:
120	rmi_dbg(RMI_DEBUG_XPORT, &client->dev,
121	"write %zd bytes at %#06x: %d (%*ph)\n",
122	len, addr, retval, (int)len, buf);
123
124	mutex_unlock(&rmi_i2c->page_mutex);
125	return retval;
126	}
127
128	static int rmi_i2c_read_block(struct rmi_transport_dev *xport, u16 addr,
129	void *buf, size_t len)
130	{
131	struct rmi_i2c_xport *rmi_i2c =
132	container_of(xport, struct rmi_i2c_xport, xport);
133	struct i2c_client *client = rmi_i2c->client;
134	u8 addr_offset = addr & 0xff;
135	int retval;
136	struct i2c_msg msgs[] = {
137	{
138	.addr = client->addr,
139	.len = sizeof(addr_offset),
140	.buf = &addr_offset,
141	},
142	{
143	.addr = client->addr,
144	.flags = I2C_M_RD,
145	.len = len,
146	.buf = buf,
147	},
148	};
149
150	mutex_lock(&rmi_i2c->page_mutex);
151
152	if (RMI_I2C_PAGE(addr) != rmi_i2c->page) {
153	retval = rmi_set_page(rmi_i2c, RMI_I2C_PAGE(addr));
154	if (retval)
155	goto exit;
156	}
157
158	retval = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
159	if (retval == ARRAY_SIZE(msgs))
160	retval = 0; /* success */
161	else if (retval >= 0)
162	retval = -EIO;
163
164	exit:
165	rmi_dbg(RMI_DEBUG_XPORT, &client->dev,
166	"read %zd bytes at %#06x: %d (%*ph)\n",
167	len, addr, retval, (int)len, buf);
168
169	mutex_unlock(&rmi_i2c->page_mutex);
170	return retval;
171	}
172
173	static const struct rmi_transport_ops rmi_i2c_ops = {
174	.write_block = rmi_i2c_write_block,
175	.read_block = rmi_i2c_read_block,
176	};
177
d8a8b3ed AD	178	#ifdef CONFIG_OF
	179	static const struct of_device_id rmi_i2c_of_match[] = {
	180	{ .compatible = "syna,rmi4-i2c" },
	181	{},
	182	};
	183	MODULE_DEVICE_TABLE(of, rmi_i2c_of_match);
	184	#endif
	185
261d7794 GR	186	static void rmi_i2c_regulator_bulk_disable(void *data)
	187	{
	188	struct rmi_i2c_xport *rmi_i2c = data;
	189
	190	regulator_bulk_disable(ARRAY_SIZE(rmi_i2c->supplies),
	191	rmi_i2c->supplies);
	192	}
	193
	194	static void rmi_i2c_unregister_transport(void *data)
	195	{
	196	struct rmi_i2c_xport *rmi_i2c = data;
	197
	198	rmi_unregister_transport_device(&rmi_i2c->xport);
	199	}
	200
f4ae4f03	201	static int rmi_i2c_probe(struct i2c_client *client)
fdf51604 AD	202	{
	203	struct rmi_device_platform_data *pdata;
	204	struct rmi_device_platform_data *client_pdata =
	205	dev_get_platdata(&client->dev);
	206	struct rmi_i2c_xport *rmi_i2c;
54bf0894	207	int error;
fdf51604 AD	208
	209	rmi_i2c = devm_kzalloc(&client->dev, sizeof(struct rmi_i2c_xport),
	210	GFP_KERNEL);
	211	if (!rmi_i2c)
	212	return -ENOMEM;
	213
	214	pdata = &rmi_i2c->xport.pdata;
	215
d8a8b3ed	216	if (!client->dev.of_node && client_pdata)
fdf51604 AD	217	pdata = client_pdata;
fdf51604 AD	218
3aeed5b5	219	pdata->irq = client->irq;
fdf51604 AD	220
	221	rmi_dbg(RMI_DEBUG_XPORT, &client->dev, "Probing %s.\n",
	222	dev_name(&client->dev));
54bf0894	223
fdf51604 AD	224	if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
fdf51604 AD	225	dev_err(&client->dev,
54bf0894	226	"adapter does not support required functionality\n");
fdf51604 AD	227	return -ENODEV;
	228	}
	229
946c8432 BA	230	rmi_i2c->supplies[0].supply = "vdd";
946c8432 BA	231	rmi_i2c->supplies[1].supply = "vio";
54bf0894	232	error = devm_regulator_bulk_get(&client->dev,
946c8432 BA	233	ARRAY_SIZE(rmi_i2c->supplies),
946c8432 BA	234	rmi_i2c->supplies);
54bf0894 DT	235	if (error < 0)
54bf0894 DT	236	return error;
946c8432	237
54bf0894	238	error = regulator_bulk_enable(ARRAY_SIZE(rmi_i2c->supplies),
946c8432	239	rmi_i2c->supplies);
54bf0894 DT	240	if (error < 0)
54bf0894 DT	241	return error;
946c8432	242
54bf0894	243	error = devm_add_action_or_reset(&client->dev,
261d7794 GR	244	rmi_i2c_regulator_bulk_disable,
261d7794 GR	245	rmi_i2c);
54bf0894 DT	246	if (error)
54bf0894 DT	247	return error;
261d7794	248
946c8432 BA	249	of_property_read_u32(client->dev.of_node, "syna,startup-delay-ms",
	250	&rmi_i2c->startup_delay);
	251
	252	msleep(rmi_i2c->startup_delay);
	253
fdf51604 AD	254	rmi_i2c->client = client;
	255	mutex_init(&rmi_i2c->page_mutex);
	256
	257	rmi_i2c->xport.dev = &client->dev;
	258	rmi_i2c->xport.proto_name = "i2c";
	259	rmi_i2c->xport.ops = &rmi_i2c_ops;
	260
	261	i2c_set_clientdata(client, rmi_i2c);
	262
	263	/*
	264	* Setting the page to zero will (a) make sure the PSR is in a
	265	* known state, and (b) make sure we can talk to the device.
	266	*/
54bf0894 DT	267	error = rmi_set_page(rmi_i2c, 0);
	268	if (error) {
	269	dev_err(&client->dev, "Failed to set page select to 0\n");
	270	return error;
fdf51604 AD	271	}
fdf51604 AD	272
54bf0894 DT	273	dev_info(&client->dev, "registering I2C-connected sensor\n");
	274
	275	error = rmi_register_transport_device(&rmi_i2c->xport);
	276	if (error) {
	277	dev_err(&client->dev, "failed to register sensor: %d\n", error);
	278	return error;
fdf51604	279	}
54bf0894 DT	280
54bf0894 DT	281	error = devm_add_action_or_reset(&client->dev,
261d7794 GR	282	rmi_i2c_unregister_transport,
261d7794 GR	283	rmi_i2c);
54bf0894 DT	284	if (error)
54bf0894 DT	285	return error;
fdf51604	286
fdf51604 AD	287	return 0;
	288	}
	289
fdf51604 AD	290	static int rmi_i2c_suspend(struct device *dev)
	291	{
	292	struct i2c_client *client = to_i2c_client(dev);
	293	struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client);
	294	int ret;
	295
3aeed5b5	296	ret = rmi_driver_suspend(rmi_i2c->xport.rmi_dev, true);
fdf51604 AD	297	if (ret)
	298	dev_warn(dev, "Failed to resume device: %d\n", ret);
	299
946c8432 BA	300	regulator_bulk_disable(ARRAY_SIZE(rmi_i2c->supplies),
	301	rmi_i2c->supplies);
	302
fdf51604 AD	303	return ret;
	304	}
	305
	306	static int rmi_i2c_resume(struct device *dev)
	307	{
	308	struct i2c_client *client = to_i2c_client(dev);
	309	struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client);
	310	int ret;
	311
946c8432 BA	312	ret = regulator_bulk_enable(ARRAY_SIZE(rmi_i2c->supplies),
	313	rmi_i2c->supplies);
	314	if (ret)
	315	return ret;
	316
	317	msleep(rmi_i2c->startup_delay);
	318
3aeed5b5	319	ret = rmi_driver_resume(rmi_i2c->xport.rmi_dev, true);
fdf51604 AD	320	if (ret)
	321	dev_warn(dev, "Failed to resume device: %d\n", ret);
	322
	323	return ret;
	324	}
fdf51604	325
fdf51604 AD	326	static int rmi_i2c_runtime_suspend(struct device *dev)
	327	{
	328	struct i2c_client *client = to_i2c_client(dev);
	329	struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client);
	330	int ret;
	331
3aeed5b5	332	ret = rmi_driver_suspend(rmi_i2c->xport.rmi_dev, false);
fdf51604 AD	333	if (ret)
	334	dev_warn(dev, "Failed to resume device: %d\n", ret);
	335
946c8432 BA	336	regulator_bulk_disable(ARRAY_SIZE(rmi_i2c->supplies),
	337	rmi_i2c->supplies);
	338
fdf51604 AD	339	return 0;
	340	}
	341
	342	static int rmi_i2c_runtime_resume(struct device *dev)
	343	{
	344	struct i2c_client *client = to_i2c_client(dev);
	345	struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client);
	346	int ret;
	347
946c8432 BA	348	ret = regulator_bulk_enable(ARRAY_SIZE(rmi_i2c->supplies),
	349	rmi_i2c->supplies);
	350	if (ret)
	351	return ret;
	352
	353	msleep(rmi_i2c->startup_delay);
	354
3aeed5b5	355	ret = rmi_driver_resume(rmi_i2c->xport.rmi_dev, false);
fdf51604 AD	356	if (ret)
	357	dev_warn(dev, "Failed to resume device: %d\n", ret);
	358
	359	return 0;
	360	}
fdf51604 AD	361
fdf51604 AD	362	static const struct dev_pm_ops rmi_i2c_pm = {
452fcd2d JC	363	SYSTEM_SLEEP_PM_OPS(rmi_i2c_suspend, rmi_i2c_resume)
452fcd2d JC	364	RUNTIME_PM_OPS(rmi_i2c_runtime_suspend, rmi_i2c_runtime_resume, NULL)
fdf51604 AD	365	};
	366
	367	static const struct i2c_device_id rmi_id[] = {
5852f2af	368	{ "rmi4_i2c" },
fdf51604 AD	369	{ }
	370	};
	371	MODULE_DEVICE_TABLE(i2c, rmi_id);
	372
	373	static struct i2c_driver rmi_i2c_driver = {
	374	.driver = {
	375	.name = "rmi4_i2c",
452fcd2d	376	.pm = pm_ptr(&rmi_i2c_pm),
d8a8b3ed	377	.of_match_table = of_match_ptr(rmi_i2c_of_match),
fdf51604 AD	378	},
fdf51604 AD	379	.id_table = rmi_id,
d8bde56d	380	.probe = rmi_i2c_probe,
fdf51604 AD	381	};
	382
	383	module_i2c_driver(rmi_i2c_driver);
	384
	385	MODULE_AUTHOR("Christopher Heiny <[email protected]>");
	386	MODULE_AUTHOR("Andrew Duggan <[email protected]>");
	387	MODULE_DESCRIPTION("RMI I2C driver");
	388	MODULE_LICENSE("GPL");