blob: 051ab8ee1c333ba49ed61cf64044d9dc348d2273 [file] [log] [blame]
Sagar Dharia7c927c02016-11-23 11:51:43 -07001/*
2 * Copyright (c) 2017, The Linux Foundation. All rights reserved.
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 and
6 * only version 2 as published by the Free Software Foundation.
7 *
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
12 *
13 */
14
15#include <linux/clk.h>
16#include <linux/delay.h>
17#include <linux/err.h>
18#include <linux/i2c.h>
19#include <linux/interrupt.h>
20#include <linux/io.h>
21#include <linux/module.h>
22#include <linux/of.h>
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -060023#include <linux/of_platform.h>
Sagar Dharia7c927c02016-11-23 11:51:43 -070024#include <linux/platform_device.h>
Sagar Dhariab44003b2017-03-10 15:34:26 -070025#include <linux/pm_runtime.h>
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -060026#include <linux/dma-mapping.h>
Sagar Dharia7c927c02016-11-23 11:51:43 -070027#include <linux/qcom-geni-se.h>
Sagar Dharia818623c2017-04-27 13:13:29 -060028#include <linux/ipc_logging.h>
Sagar Dharia7c927c02016-11-23 11:51:43 -070029
30#define SE_I2C_TX_TRANS_LEN (0x26C)
31#define SE_I2C_RX_TRANS_LEN (0x270)
32#define SE_I2C_SCL_COUNTERS (0x278)
Sagar Dharia818623c2017-04-27 13:13:29 -060033#define SE_GENI_IOS (0x908)
Sagar Dharia7c927c02016-11-23 11:51:43 -070034
35#define SE_I2C_ERR (M_CMD_OVERRUN_EN | M_ILLEGAL_CMD_EN | M_CMD_FAILURE_EN |\
36 M_GP_IRQ_1_EN | M_GP_IRQ_3_EN | M_GP_IRQ_4_EN)
37#define SE_I2C_ABORT (1U << 1)
38/* M_CMD OP codes for I2C */
39#define I2C_WRITE (0x1)
40#define I2C_READ (0x2)
41#define I2C_WRITE_READ (0x3)
42#define I2C_ADDR_ONLY (0x4)
43#define I2C_BUS_CLEAR (0x6)
44#define I2C_STOP_ON_BUS (0x7)
45/* M_CMD params for I2C */
46#define PRE_CMD_DELAY (BIT(0))
47#define TIMESTAMP_BEFORE (BIT(1))
48#define STOP_STRETCH (BIT(2))
49#define TIMESTAMP_AFTER (BIT(3))
50#define POST_COMMAND_DELAY (BIT(4))
51#define IGNORE_ADD_NACK (BIT(6))
52#define READ_FINISHED_WITH_ACK (BIT(7))
53#define BYPASS_ADDR_PHASE (BIT(8))
54#define SLV_ADDR_MSK (GENMASK(15, 9))
55#define SLV_ADDR_SHFT (9)
56
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -060057#define I2C_CORE2X_VOTE (10000)
Sagar Dharia818623c2017-04-27 13:13:29 -060058#define GP_IRQ0 0
59#define GP_IRQ1 1
60#define GP_IRQ2 2
61#define GP_IRQ3 3
62#define GP_IRQ4 4
63#define GP_IRQ5 5
64#define GENI_OVERRUN 6
65#define GENI_ILLEGAL_CMD 7
66#define GENI_ABORT_DONE 8
67#define GENI_TIMEOUT 9
68
69#define I2C_NACK GP_IRQ1
70#define I2C_BUS_PROTO GP_IRQ3
71#define I2C_ARB_LOST GP_IRQ4
72#define DM_I2C_RX_ERR ((GP_IRQ1 | GP_IRQ3 | GP_IRQ4) >> 4)
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -060073
Sagar Dharia7c927c02016-11-23 11:51:43 -070074struct geni_i2c_dev {
75 struct device *dev;
76 void __iomem *base;
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -060077 unsigned int tx_wm;
Sagar Dharia7c927c02016-11-23 11:51:43 -070078 int irq;
79 int err;
80 struct i2c_adapter adap;
81 struct completion xfer;
82 struct i2c_msg *cur;
Sagar Dhariab44003b2017-03-10 15:34:26 -070083 struct se_geni_rsc i2c_rsc;
Sagar Dharia7c927c02016-11-23 11:51:43 -070084 int cur_wr;
85 int cur_rd;
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -060086 struct device *wrapper_dev;
Sagar Dharia818623c2017-04-27 13:13:29 -060087 void *ipcl;
88};
89
90struct geni_i2c_err_log {
91 int err;
92 const char *msg;
93};
94
95static struct geni_i2c_err_log gi2c_log[] = {
96 [GP_IRQ0] = {-EINVAL, "Unknown I2C err GP_IRQ0"},
97 [I2C_NACK] = {-ENOTCONN,
98 "NACK: slv unresponsive, check its power/reset-ln"},
99 [GP_IRQ2] = {-EINVAL, "Unknown I2C err GP IRQ2"},
100 [I2C_BUS_PROTO] = {-EPROTO,
101 "Bus proto err, noisy/unepxected start/stop"},
102 [I2C_ARB_LOST] = {-EBUSY,
103 "Bus arbitration lost, clock line undriveable"},
104 [GP_IRQ5] = {-EINVAL, "Unknown I2C err GP IRQ5"},
105 [GENI_OVERRUN] = {-EIO, "Cmd overrun, check GENI cmd-state machine"},
106 [GENI_ILLEGAL_CMD] = {-EILSEQ,
107 "Illegal cmd, check GENI cmd-state machine"},
108 [GENI_ABORT_DONE] = {-ETIMEDOUT, "Abort after timeout successful"},
109 [GENI_TIMEOUT] = {-ETIMEDOUT, "I2C TXN timed out"},
Sagar Dharia7c927c02016-11-23 11:51:43 -0700110};
111
112static inline void qcom_geni_i2c_conf(void __iomem *base, int dfs, int div)
113{
114 geni_write_reg(dfs, base, SE_GENI_CLK_SEL);
115 geni_write_reg((div << 4) | 1, base, GENI_SER_M_CLK_CFG);
116 geni_write_reg(((5 << 20) | (0xC << 10) | 0x18),
117 base, SE_I2C_SCL_COUNTERS);
118 /*
119 * Ensure Clk config completes before return.
120 */
121 mb();
122}
123
Sagar Dharia818623c2017-04-27 13:13:29 -0600124static void geni_i2c_err(struct geni_i2c_dev *gi2c, int err)
125{
126 u32 m_stat = readl_relaxed(gi2c->base + SE_GENI_M_IRQ_STATUS);
127 u32 rx_st = readl_relaxed(gi2c->base + SE_GENI_RX_FIFO_STATUS);
128 u32 tx_st = readl_relaxed(gi2c->base + SE_GENI_TX_FIFO_STATUS);
129 u32 m_cmd = readl_relaxed(gi2c->base + SE_GENI_M_CMD0);
130 u32 geni_s = readl_relaxed(gi2c->base + SE_GENI_STATUS);
131 u32 geni_ios = readl_relaxed(gi2c->base + SE_GENI_IOS);
132
133 if (err == I2C_NACK || err == GENI_ABORT_DONE) {
134 GENI_SE_DBG(gi2c->ipcl, false, gi2c->dev, "%s\n",
135 gi2c_log[err].msg);
136 GENI_SE_DBG(gi2c->ipcl, false, gi2c->dev,
137 "m_stat:0x%x, tx_stat:0x%x, rx_stat:0x%x, ",
138 m_stat, tx_st, rx_st);
139 GENI_SE_DBG(gi2c->ipcl, false, gi2c->dev,
140 "m_cmd:0x%x, geni_status:0x%x, geni_ios:0x%x\n",
141 m_cmd, geni_s, geni_ios);
142 } else {
143 GENI_SE_ERR(gi2c->ipcl, true, gi2c->dev, "%s\n",
144 gi2c_log[err].msg);
145 GENI_SE_ERR(gi2c->ipcl, true, gi2c->dev,
146 "m_stat:0x%x, tx_stat:0x%x, rx_stat:0x%x, ",
147 m_stat, tx_st, rx_st);
148 GENI_SE_ERR(gi2c->ipcl, true, gi2c->dev,
149 "m_cmd:0x%x, geni_status:0x%x, geni_ios:0x%x\n",
150 m_cmd, geni_s, geni_ios);
151 }
152 gi2c->err = gi2c_log[err].err;
153}
154
Sagar Dharia7c927c02016-11-23 11:51:43 -0700155static irqreturn_t geni_i2c_irq(int irq, void *dev)
156{
157 struct geni_i2c_dev *gi2c = dev;
158 int i, j;
159 u32 m_stat = readl_relaxed(gi2c->base + SE_GENI_M_IRQ_STATUS);
Sagar Dharia818623c2017-04-27 13:13:29 -0600160 u32 rx_st = readl_relaxed(gi2c->base + SE_GENI_RX_FIFO_STATUS);
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600161 u32 dm_tx_st = readl_relaxed(gi2c->base + SE_DMA_TX_IRQ_STAT);
162 u32 dm_rx_st = readl_relaxed(gi2c->base + SE_DMA_RX_IRQ_STAT);
163 u32 dma = readl_relaxed(gi2c->base + SE_GENI_DMA_MODE_EN);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700164 struct i2c_msg *cur = gi2c->cur;
165
Sagar Dharia818623c2017-04-27 13:13:29 -0600166 if (!cur || (m_stat & M_CMD_FAILURE_EN) ||
167 (dm_rx_st & (DM_I2C_RX_ERR)) ||
168 (m_stat & M_CMD_ABORT_EN)) {
169
170 if (m_stat & M_GP_IRQ_1_EN)
171 geni_i2c_err(gi2c, I2C_NACK);
172 if (m_stat & M_GP_IRQ_3_EN)
173 geni_i2c_err(gi2c, I2C_BUS_PROTO);
174 if (m_stat & M_GP_IRQ_4_EN)
175 geni_i2c_err(gi2c, I2C_ARB_LOST);
176 if (m_stat & M_CMD_OVERRUN_EN)
177 geni_i2c_err(gi2c, GENI_OVERRUN);
178 if (m_stat & M_ILLEGAL_CMD_EN)
179 geni_i2c_err(gi2c, GENI_ILLEGAL_CMD);
180 if (m_stat & M_CMD_ABORT_EN)
181 geni_i2c_err(gi2c, GENI_ABORT_DONE);
182 if (m_stat & M_GP_IRQ_0_EN)
183 geni_i2c_err(gi2c, GP_IRQ0);
184
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600185 if (!dma)
186 writel_relaxed(0, (gi2c->base +
187 SE_GENI_TX_WATERMARK_REG));
Sagar Dharia7c927c02016-11-23 11:51:43 -0700188 gi2c->err = -EIO;
189 goto irqret;
190 }
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600191
192 if (dma) {
193 dev_dbg(gi2c->dev, "i2c dma tx:0x%x, dma rx:0x%x\n", dm_tx_st,
194 dm_rx_st);
195 goto irqret;
196 }
197
Sagar Dharia7c927c02016-11-23 11:51:43 -0700198 if (((m_stat & M_RX_FIFO_WATERMARK_EN) ||
199 (m_stat & M_RX_FIFO_LAST_EN)) && (cur->flags & I2C_M_RD)) {
Sagar Dharia818623c2017-04-27 13:13:29 -0600200 u32 rxcnt = rx_st & RX_FIFO_WC_MSK;
Sagar Dharia7c927c02016-11-23 11:51:43 -0700201
202 for (j = 0; j < rxcnt; j++) {
203 u32 temp;
204 int p;
205
206 temp = readl_relaxed(gi2c->base + SE_GENI_RX_FIFOn);
207 for (i = gi2c->cur_rd, p = 0; (i < cur->len && p < 4);
208 i++, p++)
209 cur->buf[i] = (u8) ((temp >> (p * 8)) & 0xff);
210 gi2c->cur_rd = i;
211 if (gi2c->cur_rd == cur->len) {
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600212 dev_dbg(gi2c->dev, "FIFO i:%d,read 0x%x\n",
213 i, temp);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700214 break;
215 }
Sagar Dharia7c927c02016-11-23 11:51:43 -0700216 }
217 } else if ((m_stat & M_TX_FIFO_WATERMARK_EN) &&
218 !(cur->flags & I2C_M_RD)) {
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -0600219 for (j = 0; j < gi2c->tx_wm; j++) {
Sagar Dharia7c927c02016-11-23 11:51:43 -0700220 u32 temp = 0;
221 int p;
222
223 for (i = gi2c->cur_wr, p = 0; (i < cur->len && p < 4);
224 i++, p++)
225 temp |= (((u32)(cur->buf[i]) << (p * 8)));
226 writel_relaxed(temp, gi2c->base + SE_GENI_TX_FIFOn);
227 gi2c->cur_wr = i;
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600228 dev_dbg(gi2c->dev, "FIFO i:%d,wrote 0x%x\n", i, temp);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700229 if (gi2c->cur_wr == cur->len) {
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600230 dev_dbg(gi2c->dev, "FIFO i2c bytes done writing\n");
Sagar Dharia7c927c02016-11-23 11:51:43 -0700231 writel_relaxed(0,
232 (gi2c->base + SE_GENI_TX_WATERMARK_REG));
233 break;
234 }
235 }
236 }
237irqret:
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600238 if (m_stat)
239 writel_relaxed(m_stat, gi2c->base + SE_GENI_M_IRQ_CLEAR);
240
241 if (dma) {
242 if (dm_tx_st)
243 writel_relaxed(dm_tx_st, gi2c->base +
244 SE_DMA_TX_IRQ_CLR);
245 if (dm_rx_st)
246 writel_relaxed(dm_rx_st, gi2c->base +
247 SE_DMA_RX_IRQ_CLR);
248 /* Ensure all writes are done before returning from ISR. */
249 wmb();
Sagar Dharia7c927c02016-11-23 11:51:43 -0700250 }
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600251 /* if this is err with done-bit not set, handle that thr' timeout. */
252 if (m_stat & M_CMD_DONE_EN)
253 complete(&gi2c->xfer);
254 else if ((dm_tx_st & TX_DMA_DONE) || (dm_rx_st & RX_DMA_DONE))
255 complete(&gi2c->xfer);
256
Sagar Dharia7c927c02016-11-23 11:51:43 -0700257 return IRQ_HANDLED;
258}
259
260static int geni_i2c_xfer(struct i2c_adapter *adap,
261 struct i2c_msg msgs[],
262 int num)
263{
264 struct geni_i2c_dev *gi2c = i2c_get_adapdata(adap);
265 int i, ret = 0, timeout = 0;
266
267 gi2c->err = 0;
268 gi2c->cur = &msgs[0];
269 reinit_completion(&gi2c->xfer);
Sagar Dhariab44003b2017-03-10 15:34:26 -0700270 ret = pm_runtime_get_sync(gi2c->dev);
271 if (ret < 0) {
Sagar Dharia818623c2017-04-27 13:13:29 -0600272 GENI_SE_ERR(gi2c->ipcl, true, gi2c->dev,
273 "error turning SE resources:%d\n", ret);
Sagar Dhariab44003b2017-03-10 15:34:26 -0700274 pm_runtime_put_noidle(gi2c->dev);
275 /* Set device in suspended since resume failed */
276 pm_runtime_set_suspended(gi2c->dev);
277 return ret;
278 }
Sagar Dharia7c927c02016-11-23 11:51:43 -0700279 qcom_geni_i2c_conf(gi2c->base, 0, 2);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700280 dev_dbg(gi2c->dev, "i2c xfer:num:%d, msgs:len:%d,flg:%d\n",
281 num, msgs[0].len, msgs[0].flags);
282 for (i = 0; i < num; i++) {
283 int stretch = (i < (num - 1));
284 u32 m_param = 0;
285 u32 m_cmd = 0;
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600286 dma_addr_t tx_dma = 0;
287 dma_addr_t rx_dma = 0;
288 enum se_xfer_mode mode = FIFO_MODE;
Sagar Dharia7c927c02016-11-23 11:51:43 -0700289
Girish Mahadevand5890b22017-03-30 13:20:02 -0600290 m_param |= (stretch ? STOP_STRETCH : 0);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700291 m_param |= ((msgs[i].addr & 0x7F) << SLV_ADDR_SHFT);
292
293 gi2c->cur = &msgs[i];
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600294 mode = msgs[i].len > 32 ? SE_DMA : FIFO_MODE;
295 ret = geni_se_select_mode(gi2c->base, mode);
296 if (ret) {
297 dev_err(gi2c->dev, "%s: Error mode init %d:%d:%d\n",
298 __func__, mode, i, msgs[i].len);
299 break;
300 }
Sagar Dharia7c927c02016-11-23 11:51:43 -0700301 if (msgs[i].flags & I2C_M_RD) {
302 dev_dbg(gi2c->dev,
303 "READ,n:%d,i:%d len:%d, stretch:%d\n",
304 num, i, msgs[i].len, stretch);
305 geni_write_reg(msgs[i].len,
306 gi2c->base, SE_I2C_RX_TRANS_LEN);
307 m_cmd = I2C_READ;
308 geni_setup_m_cmd(gi2c->base, m_cmd, m_param);
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600309 if (mode == SE_DMA) {
310 ret = geni_se_rx_dma_prep(gi2c->wrapper_dev,
311 gi2c->base, msgs[i].buf,
312 msgs[i].len, &rx_dma);
313 if (ret)
314 mode = FIFO_MODE;
315 }
316 if (mode == FIFO_MODE)
317 geni_se_select_mode(gi2c->base, mode);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700318 } else {
319 dev_dbg(gi2c->dev,
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600320 "WRITE:n:%d,i:%d len:%d, stretch:%d, m_param:0x%x\n",
321 num, i, msgs[i].len, stretch, m_param);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700322 geni_write_reg(msgs[i].len, gi2c->base,
323 SE_I2C_TX_TRANS_LEN);
324 m_cmd = I2C_WRITE;
325 geni_setup_m_cmd(gi2c->base, m_cmd, m_param);
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600326 if (mode == SE_DMA) {
327 ret = geni_se_tx_dma_prep(gi2c->wrapper_dev,
328 gi2c->base, msgs[i].buf,
329 msgs[i].len, &tx_dma);
330 if (ret)
331 mode = FIFO_MODE;
332 }
333 if (mode == FIFO_MODE) {
334 geni_se_select_mode(gi2c->base, mode);
335 /* Get FIFO IRQ */
336 geni_write_reg(1, gi2c->base,
337 SE_GENI_TX_WATERMARK_REG);
338 }
Sagar Dharia7c927c02016-11-23 11:51:43 -0700339 }
340 /* Ensure FIFO write go through before waiting for Done evet */
341 mb();
342 timeout = wait_for_completion_timeout(&gi2c->xfer, HZ);
343 if (!timeout) {
Sagar Dharia818623c2017-04-27 13:13:29 -0600344 geni_i2c_err(gi2c, GENI_TIMEOUT);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700345 gi2c->cur = NULL;
346 geni_abort_m_cmd(gi2c->base);
347 timeout = wait_for_completion_timeout(&gi2c->xfer, HZ);
348 }
349 gi2c->cur_wr = 0;
350 gi2c->cur_rd = 0;
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600351 if (mode == SE_DMA) {
352 if (gi2c->err) {
353 if (msgs[i].flags != I2C_M_RD)
354 writel_relaxed(1, gi2c->base +
355 SE_DMA_TX_FSM_RST);
356 else
357 writel_relaxed(1, gi2c->base +
358 SE_DMA_RX_FSM_RST);
359 wait_for_completion_timeout(&gi2c->xfer, HZ);
360 }
361 geni_se_rx_dma_unprep(gi2c->wrapper_dev, rx_dma,
362 msgs[i].len);
363 geni_se_tx_dma_unprep(gi2c->wrapper_dev, tx_dma,
364 msgs[i].len);
365 }
366 ret = gi2c->err;
Sagar Dharia7c927c02016-11-23 11:51:43 -0700367 if (gi2c->err) {
368 dev_err(gi2c->dev, "i2c error :%d\n", gi2c->err);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700369 break;
370 }
371 }
372 if (ret == 0)
373 ret = i;
Sagar Dhariab44003b2017-03-10 15:34:26 -0700374 pm_runtime_put_sync(gi2c->dev);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700375 gi2c->cur = NULL;
376 gi2c->err = 0;
377 dev_dbg(gi2c->dev, "i2c txn ret:%d\n", ret);
378 return ret;
379}
380
381static u32 geni_i2c_func(struct i2c_adapter *adap)
382{
383 return I2C_FUNC_I2C | (I2C_FUNC_SMBUS_EMUL & ~I2C_FUNC_SMBUS_QUICK);
384}
385
386static const struct i2c_algorithm geni_i2c_algo = {
387 .master_xfer = geni_i2c_xfer,
388 .functionality = geni_i2c_func,
389};
390
391static int geni_i2c_probe(struct platform_device *pdev)
392{
393 struct geni_i2c_dev *gi2c;
394 struct resource *res;
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -0600395 struct platform_device *wrapper_pdev;
396 struct device_node *wrapper_ph_node;
Sagar Dharia7c927c02016-11-23 11:51:43 -0700397 int ret;
398
399 gi2c = devm_kzalloc(&pdev->dev, sizeof(*gi2c), GFP_KERNEL);
400 if (!gi2c)
401 return -ENOMEM;
402
403 gi2c->dev = &pdev->dev;
404
405 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
406 if (!res)
407 return -EINVAL;
408
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -0600409 wrapper_ph_node = of_parse_phandle(pdev->dev.of_node,
410 "qcom,wrapper-core", 0);
411 if (IS_ERR_OR_NULL(wrapper_ph_node)) {
412 ret = PTR_ERR(wrapper_ph_node);
413 dev_err(&pdev->dev, "No wrapper core defined\n");
414 return ret;
415 }
416 wrapper_pdev = of_find_device_by_node(wrapper_ph_node);
417 of_node_put(wrapper_ph_node);
418 if (IS_ERR_OR_NULL(wrapper_pdev)) {
419 ret = PTR_ERR(wrapper_pdev);
420 dev_err(&pdev->dev, "Cannot retrieve wrapper device\n");
421 return ret;
422 }
423 gi2c->wrapper_dev = &wrapper_pdev->dev;
424 gi2c->i2c_rsc.wrapper_dev = &wrapper_pdev->dev;
425 ret = geni_se_resources_init(&gi2c->i2c_rsc, I2C_CORE2X_VOTE,
426 (DEFAULT_SE_CLK * DEFAULT_BUS_WIDTH));
427 if (ret) {
428 dev_err(gi2c->dev, "geni_se_resources_init\n");
429 return ret;
430 }
431
Sagar Dhariab44003b2017-03-10 15:34:26 -0700432 gi2c->i2c_rsc.se_clk = devm_clk_get(&pdev->dev, "se-clk");
433 if (IS_ERR(gi2c->i2c_rsc.se_clk)) {
434 ret = PTR_ERR(gi2c->i2c_rsc.se_clk);
435 dev_err(&pdev->dev, "Err getting SE Core clk %d\n", ret);
436 return ret;
437 }
438
439 gi2c->i2c_rsc.m_ahb_clk = devm_clk_get(&pdev->dev, "m-ahb");
440 if (IS_ERR(gi2c->i2c_rsc.m_ahb_clk)) {
441 ret = PTR_ERR(gi2c->i2c_rsc.m_ahb_clk);
442 dev_err(&pdev->dev, "Err getting M AHB clk %d\n", ret);
443 return ret;
444 }
445
446 gi2c->i2c_rsc.s_ahb_clk = devm_clk_get(&pdev->dev, "s-ahb");
447 if (IS_ERR(gi2c->i2c_rsc.s_ahb_clk)) {
448 ret = PTR_ERR(gi2c->i2c_rsc.s_ahb_clk);
449 dev_err(&pdev->dev, "Err getting S AHB clk %d\n", ret);
450 return ret;
451 }
452
Sagar Dharia7c927c02016-11-23 11:51:43 -0700453 gi2c->base = devm_ioremap_resource(gi2c->dev, res);
454 if (IS_ERR(gi2c->base))
455 return PTR_ERR(gi2c->base);
456
Sagar Dhariab44003b2017-03-10 15:34:26 -0700457 gi2c->i2c_rsc.geni_pinctrl = devm_pinctrl_get(&pdev->dev);
458 if (IS_ERR_OR_NULL(gi2c->i2c_rsc.geni_pinctrl)) {
459 dev_err(&pdev->dev, "No pinctrl config specified\n");
460 ret = PTR_ERR(gi2c->i2c_rsc.geni_pinctrl);
461 return ret;
462 }
463 gi2c->i2c_rsc.geni_gpio_active =
464 pinctrl_lookup_state(gi2c->i2c_rsc.geni_pinctrl,
465 PINCTRL_DEFAULT);
466 if (IS_ERR_OR_NULL(gi2c->i2c_rsc.geni_gpio_active)) {
467 dev_err(&pdev->dev, "No default config specified\n");
468 ret = PTR_ERR(gi2c->i2c_rsc.geni_gpio_active);
469 return ret;
470 }
471 gi2c->i2c_rsc.geni_gpio_sleep =
472 pinctrl_lookup_state(gi2c->i2c_rsc.geni_pinctrl,
473 PINCTRL_SLEEP);
474 if (IS_ERR_OR_NULL(gi2c->i2c_rsc.geni_gpio_sleep)) {
475 dev_err(&pdev->dev, "No sleep config specified\n");
476 ret = PTR_ERR(gi2c->i2c_rsc.geni_gpio_sleep);
477 return ret;
478 }
479
Sagar Dharia7c927c02016-11-23 11:51:43 -0700480 gi2c->irq = platform_get_irq(pdev, 0);
481 if (gi2c->irq < 0) {
482 dev_err(gi2c->dev, "IRQ error for i2c-geni\n");
483 return gi2c->irq;
484 }
485
486 gi2c->adap.algo = &geni_i2c_algo;
487 init_completion(&gi2c->xfer);
488 platform_set_drvdata(pdev, gi2c);
489 ret = devm_request_irq(gi2c->dev, gi2c->irq, geni_i2c_irq,
490 IRQF_TRIGGER_HIGH, "i2c_geni", gi2c);
491 if (ret) {
492 dev_err(gi2c->dev, "Request_irq failed:%d: err:%d\n",
493 gi2c->irq, ret);
494 return ret;
495 }
496 disable_irq(gi2c->irq);
497 i2c_set_adapdata(&gi2c->adap, gi2c);
498 gi2c->adap.dev.parent = gi2c->dev;
499 gi2c->adap.dev.of_node = pdev->dev.of_node;
500
501 strlcpy(gi2c->adap.name, "Geni-I2C", sizeof(gi2c->adap.name));
502
Sagar Dhariab44003b2017-03-10 15:34:26 -0700503 pm_runtime_set_suspended(gi2c->dev);
504 pm_runtime_enable(gi2c->dev);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700505 i2c_add_adapter(&gi2c->adap);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700506
Karthikeyan Ramasubramaniana5766572017-04-19 11:31:42 -0600507 dev_dbg(gi2c->dev, "I2C probed\n");
Sagar Dharia7c927c02016-11-23 11:51:43 -0700508 return 0;
509}
510
511static int geni_i2c_remove(struct platform_device *pdev)
512{
513 struct geni_i2c_dev *gi2c = platform_get_drvdata(pdev);
514
Sagar Dhariab44003b2017-03-10 15:34:26 -0700515 pm_runtime_disable(gi2c->dev);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700516 i2c_del_adapter(&gi2c->adap);
Sagar Dharia818623c2017-04-27 13:13:29 -0600517 if (gi2c->ipcl)
518 ipc_log_context_destroy(gi2c->ipcl);
Sagar Dharia7c927c02016-11-23 11:51:43 -0700519 return 0;
520}
521
Sagar Dhariab44003b2017-03-10 15:34:26 -0700522static int geni_i2c_resume_noirq(struct device *device)
Sagar Dharia7c927c02016-11-23 11:51:43 -0700523{
524 return 0;
525}
526
Sagar Dhariab44003b2017-03-10 15:34:26 -0700527#ifdef CONFIG_PM
528static int geni_i2c_runtime_suspend(struct device *dev)
529{
530 struct geni_i2c_dev *gi2c = dev_get_drvdata(dev);
531
532 disable_irq(gi2c->irq);
533 se_geni_resources_off(&gi2c->i2c_rsc);
534 return 0;
535}
536
537static int geni_i2c_runtime_resume(struct device *dev)
538{
539 int ret;
540 struct geni_i2c_dev *gi2c = dev_get_drvdata(dev);
541
Sagar Dharia818623c2017-04-27 13:13:29 -0600542 if (!gi2c->ipcl) {
543 char ipc_name[I2C_NAME_SIZE];
544
545 snprintf(ipc_name, I2C_NAME_SIZE, "i2c-%d", gi2c->adap.nr);
546 gi2c->ipcl = ipc_log_context_create(2, ipc_name, 0);
547 }
Sagar Dhariab44003b2017-03-10 15:34:26 -0700548 ret = se_geni_resources_on(&gi2c->i2c_rsc);
549 if (ret)
550 return ret;
551
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -0600552 if (unlikely(!gi2c->tx_wm)) {
553 int gi2c_tx_depth = get_tx_fifo_depth(gi2c->base);
554
555 gi2c->tx_wm = gi2c_tx_depth - 1;
556 geni_se_init(gi2c->base, gi2c->tx_wm, gi2c_tx_depth);
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -0600557 se_config_packing(gi2c->base, 8, 4, true);
Sagar Dharia818623c2017-04-27 13:13:29 -0600558 GENI_SE_DBG(gi2c->ipcl, false, gi2c->dev,
559 "i2c fifo depth:%d\n", gi2c_tx_depth);
Karthikeyan Ramasubramanian0d578b72017-04-26 10:44:02 -0600560 }
Sagar Dhariab44003b2017-03-10 15:34:26 -0700561 enable_irq(gi2c->irq);
562 return 0;
563}
564
565static int geni_i2c_suspend_noirq(struct device *device)
566{
567 if (!pm_runtime_status_suspended(device))
568 return -EBUSY;
569 return 0;
570}
571#else
572static int geni_i2c_runtime_suspend(struct device *dev)
573{
574 return 0;
575}
576
577static int geni_i2c_runtime_resume(struct device *dev)
578{
579 return 0;
580}
581
582static int geni_i2c_suspend_noirq(struct device *device)
Sagar Dharia7c927c02016-11-23 11:51:43 -0700583{
584 return 0;
585}
586#endif
587
588static const struct dev_pm_ops geni_i2c_pm_ops = {
Sagar Dhariab44003b2017-03-10 15:34:26 -0700589 .suspend_noirq = geni_i2c_suspend_noirq,
590 .resume_noirq = geni_i2c_resume_noirq,
591 .runtime_suspend = geni_i2c_runtime_suspend,
592 .runtime_resume = geni_i2c_runtime_resume,
Sagar Dharia7c927c02016-11-23 11:51:43 -0700593};
594
595static const struct of_device_id geni_i2c_dt_match[] = {
596 { .compatible = "qcom,i2c-geni" },
597 {}
598};
599MODULE_DEVICE_TABLE(of, geni_i2c_dt_match);
600
601static struct platform_driver geni_i2c_driver = {
602 .probe = geni_i2c_probe,
603 .remove = geni_i2c_remove,
604 .driver = {
605 .name = "i2c_geni",
606 .pm = &geni_i2c_pm_ops,
607 .of_match_table = geni_i2c_dt_match,
608 },
609};
610
611module_platform_driver(geni_i2c_driver);
612
613MODULE_LICENSE("GPL v2");
614MODULE_ALIAS("platform:i2c_geni");