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