|  | /* | 
|  | * Copyright (c) 2011-2016 Synaptics Incorporated | 
|  | * Copyright (c) 2011 Unixphere | 
|  | * | 
|  | * 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. | 
|  | */ | 
|  |  | 
|  | #include <linux/i2c.h> | 
|  | #include <linux/rmi.h> | 
|  | #include <linux/irq.h> | 
|  | #include <linux/of.h> | 
|  | #include "rmi_driver.h" | 
|  |  | 
|  | #define BUFFER_SIZE_INCREMENT 32 | 
|  |  | 
|  | /** | 
|  | * struct rmi_i2c_xport - stores information for i2c communication | 
|  | * | 
|  | * @xport: The transport interface 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 | 
|  | */ | 
|  | struct rmi_i2c_xport { | 
|  | struct rmi_transport_dev xport; | 
|  | struct i2c_client *client; | 
|  |  | 
|  | struct mutex page_mutex; | 
|  | int page; | 
|  |  | 
|  | int irq; | 
|  |  | 
|  | u8 *tx_buf; | 
|  | size_t tx_buf_size; | 
|  | }; | 
|  |  | 
|  | #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, | 
|  | }; | 
|  |  | 
|  | static irqreturn_t rmi_i2c_irq(int irq, void *dev_id) | 
|  | { | 
|  | struct rmi_i2c_xport *rmi_i2c = dev_id; | 
|  | struct rmi_device *rmi_dev = rmi_i2c->xport.rmi_dev; | 
|  | int ret; | 
|  |  | 
|  | ret = rmi_process_interrupt_requests(rmi_dev); | 
|  | if (ret) | 
|  | rmi_dbg(RMI_DEBUG_XPORT, &rmi_dev->dev, | 
|  | "Failed to process interrupt request: %d\n", ret); | 
|  |  | 
|  | return IRQ_HANDLED; | 
|  | } | 
|  |  | 
|  | static int rmi_i2c_init_irq(struct i2c_client *client) | 
|  | { | 
|  | struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client); | 
|  | int irq_flags = irqd_get_trigger_type(irq_get_irq_data(rmi_i2c->irq)); | 
|  | int ret; | 
|  |  | 
|  | if (!irq_flags) | 
|  | irq_flags = IRQF_TRIGGER_LOW; | 
|  |  | 
|  | ret = devm_request_threaded_irq(&client->dev, rmi_i2c->irq, NULL, | 
|  | rmi_i2c_irq, irq_flags | IRQF_ONESHOT, client->name, | 
|  | rmi_i2c); | 
|  | if (ret < 0) { | 
|  | dev_warn(&client->dev, "Failed to register interrupt %d\n", | 
|  | rmi_i2c->irq); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | #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 int rmi_i2c_probe(struct i2c_client *client, | 
|  | const struct i2c_device_id *id) | 
|  | { | 
|  | 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 retval; | 
|  |  | 
|  | 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; | 
|  |  | 
|  | if (client->irq > 0) | 
|  | rmi_i2c->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->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. | 
|  | */ | 
|  | retval = rmi_set_page(rmi_i2c, 0); | 
|  | if (retval) { | 
|  | dev_err(&client->dev, "Failed to set page select to 0.\n"); | 
|  | return retval; | 
|  | } | 
|  |  | 
|  | retval = rmi_register_transport_device(&rmi_i2c->xport); | 
|  | if (retval) { | 
|  | dev_err(&client->dev, "Failed to register transport driver at 0x%.2X.\n", | 
|  | client->addr); | 
|  | return retval; | 
|  | } | 
|  |  | 
|  | retval = rmi_i2c_init_irq(client); | 
|  | if (retval < 0) | 
|  | return retval; | 
|  |  | 
|  | dev_info(&client->dev, "registered rmi i2c driver at %#04x.\n", | 
|  | client->addr); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int rmi_i2c_remove(struct i2c_client *client) | 
|  | { | 
|  | struct rmi_i2c_xport *rmi_i2c = i2c_get_clientdata(client); | 
|  |  | 
|  | rmi_unregister_transport_device(&rmi_i2c->xport); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | #ifdef CONFIG_PM_SLEEP | 
|  | 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); | 
|  | if (ret) | 
|  | dev_warn(dev, "Failed to resume device: %d\n", ret); | 
|  |  | 
|  | disable_irq(rmi_i2c->irq); | 
|  | if (device_may_wakeup(&client->dev)) { | 
|  | ret = enable_irq_wake(rmi_i2c->irq); | 
|  | if (!ret) | 
|  | dev_warn(dev, "Failed to enable irq for wake: %d\n", | 
|  | ret); | 
|  | } | 
|  | 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; | 
|  |  | 
|  | enable_irq(rmi_i2c->irq); | 
|  | if (device_may_wakeup(&client->dev)) { | 
|  | ret = disable_irq_wake(rmi_i2c->irq); | 
|  | if (!ret) | 
|  | dev_warn(dev, "Failed to disable irq for wake: %d\n", | 
|  | ret); | 
|  | } | 
|  |  | 
|  | ret = rmi_driver_resume(rmi_i2c->xport.rmi_dev); | 
|  | if (ret) | 
|  | dev_warn(dev, "Failed to resume device: %d\n", ret); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  | #endif | 
|  |  | 
|  | #ifdef CONFIG_PM | 
|  | 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); | 
|  | if (ret) | 
|  | dev_warn(dev, "Failed to resume device: %d\n", ret); | 
|  |  | 
|  | disable_irq(rmi_i2c->irq); | 
|  |  | 
|  | 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; | 
|  |  | 
|  | enable_irq(rmi_i2c->irq); | 
|  |  | 
|  | ret = rmi_driver_resume(rmi_i2c->xport.rmi_dev); | 
|  | if (ret) | 
|  | dev_warn(dev, "Failed to resume device: %d\n", ret); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | #endif | 
|  |  | 
|  | static const struct dev_pm_ops rmi_i2c_pm = { | 
|  | SET_SYSTEM_SLEEP_PM_OPS(rmi_i2c_suspend, rmi_i2c_resume) | 
|  | SET_RUNTIME_PM_OPS(rmi_i2c_runtime_suspend, rmi_i2c_runtime_resume, | 
|  | NULL) | 
|  | }; | 
|  |  | 
|  | static const struct i2c_device_id rmi_id[] = { | 
|  | { "rmi4_i2c", 0 }, | 
|  | { } | 
|  | }; | 
|  | MODULE_DEVICE_TABLE(i2c, rmi_id); | 
|  |  | 
|  | static struct i2c_driver rmi_i2c_driver = { | 
|  | .driver = { | 
|  | .name	= "rmi4_i2c", | 
|  | .pm	= &rmi_i2c_pm, | 
|  | .of_match_table = of_match_ptr(rmi_i2c_of_match), | 
|  | }, | 
|  | .id_table	= rmi_id, | 
|  | .probe		= rmi_i2c_probe, | 
|  | .remove		= rmi_i2c_remove, | 
|  | }; | 
|  |  | 
|  | module_i2c_driver(rmi_i2c_driver); | 
|  |  | 
|  | MODULE_AUTHOR("Christopher Heiny <cheiny@synaptics.com>"); | 
|  | MODULE_AUTHOR("Andrew Duggan <aduggan@synaptics.com>"); | 
|  | MODULE_DESCRIPTION("RMI I2C driver"); | 
|  | MODULE_LICENSE("GPL"); | 
|  | MODULE_VERSION(RMI_DRIVER_VERSION); |