Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

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