1
2
3
4
5
6
7
8#include <linux/clk.h>
9#include <linux/delay.h>
10#include <linux/i2c.h>
11#include <linux/interrupt.h>
12#include <linux/io.h>
13#include <linux/module.h>
14#include <linux/platform_device.h>
15#include <linux/of.h>
16#include <linux/pm_runtime.h>
17
18
19#define CDNS_I2C_CR_OFFSET 0x00
20#define CDNS_I2C_SR_OFFSET 0x04
21#define CDNS_I2C_ADDR_OFFSET 0x08
22#define CDNS_I2C_DATA_OFFSET 0x0C
23#define CDNS_I2C_ISR_OFFSET 0x10
24#define CDNS_I2C_XFER_SIZE_OFFSET 0x14
25#define CDNS_I2C_TIME_OUT_OFFSET 0x1C
26#define CDNS_I2C_IMR_OFFSET 0x20
27#define CDNS_I2C_IER_OFFSET 0x24
28#define CDNS_I2C_IDR_OFFSET 0x28
29
30
31#define CDNS_I2C_CR_HOLD BIT(4)
32#define CDNS_I2C_CR_ACK_EN BIT(3)
33#define CDNS_I2C_CR_NEA BIT(2)
34#define CDNS_I2C_CR_MS BIT(1)
35
36#define CDNS_I2C_CR_RW BIT(0)
37
38#define CDNS_I2C_CR_CLR_FIFO BIT(6)
39#define CDNS_I2C_CR_DIVA_SHIFT 14
40#define CDNS_I2C_CR_DIVA_MASK (3 << CDNS_I2C_CR_DIVA_SHIFT)
41#define CDNS_I2C_CR_DIVB_SHIFT 8
42#define CDNS_I2C_CR_DIVB_MASK (0x3f << CDNS_I2C_CR_DIVB_SHIFT)
43
44#define CDNS_I2C_CR_MASTER_EN_MASK (CDNS_I2C_CR_NEA | \
45 CDNS_I2C_CR_ACK_EN | \
46 CDNS_I2C_CR_MS)
47
48#define CDNS_I2C_CR_SLAVE_EN_MASK ~CDNS_I2C_CR_MASTER_EN_MASK
49
50
51#define CDNS_I2C_SR_BA BIT(8)
52#define CDNS_I2C_SR_TXDV BIT(6)
53#define CDNS_I2C_SR_RXDV BIT(5)
54#define CDNS_I2C_SR_RXRW BIT(3)
55
56
57
58
59
60
61
62#define CDNS_I2C_ADDR_MASK 0x000003FF
63
64
65
66
67
68
69#define CDNS_I2C_IXR_ARB_LOST BIT(9)
70#define CDNS_I2C_IXR_RX_UNF BIT(7)
71#define CDNS_I2C_IXR_TX_OVF BIT(6)
72#define CDNS_I2C_IXR_RX_OVF BIT(5)
73#define CDNS_I2C_IXR_SLV_RDY BIT(4)
74#define CDNS_I2C_IXR_TO BIT(3)
75#define CDNS_I2C_IXR_NACK BIT(2)
76#define CDNS_I2C_IXR_DATA BIT(1)
77#define CDNS_I2C_IXR_COMP BIT(0)
78
79#define CDNS_I2C_IXR_ALL_INTR_MASK (CDNS_I2C_IXR_ARB_LOST | \
80 CDNS_I2C_IXR_RX_UNF | \
81 CDNS_I2C_IXR_TX_OVF | \
82 CDNS_I2C_IXR_RX_OVF | \
83 CDNS_I2C_IXR_SLV_RDY | \
84 CDNS_I2C_IXR_TO | \
85 CDNS_I2C_IXR_NACK | \
86 CDNS_I2C_IXR_DATA | \
87 CDNS_I2C_IXR_COMP)
88
89#define CDNS_I2C_IXR_ERR_INTR_MASK (CDNS_I2C_IXR_ARB_LOST | \
90 CDNS_I2C_IXR_RX_UNF | \
91 CDNS_I2C_IXR_TX_OVF | \
92 CDNS_I2C_IXR_RX_OVF | \
93 CDNS_I2C_IXR_NACK)
94
95#define CDNS_I2C_ENABLED_INTR_MASK (CDNS_I2C_IXR_ARB_LOST | \
96 CDNS_I2C_IXR_RX_UNF | \
97 CDNS_I2C_IXR_TX_OVF | \
98 CDNS_I2C_IXR_RX_OVF | \
99 CDNS_I2C_IXR_NACK | \
100 CDNS_I2C_IXR_DATA | \
101 CDNS_I2C_IXR_COMP)
102
103#define CDNS_I2C_IXR_SLAVE_INTR_MASK (CDNS_I2C_IXR_RX_UNF | \
104 CDNS_I2C_IXR_TX_OVF | \
105 CDNS_I2C_IXR_RX_OVF | \
106 CDNS_I2C_IXR_TO | \
107 CDNS_I2C_IXR_NACK | \
108 CDNS_I2C_IXR_DATA | \
109 CDNS_I2C_IXR_COMP)
110
111#define CDNS_I2C_TIMEOUT msecs_to_jiffies(1000)
112
113#define CNDS_I2C_PM_TIMEOUT 1000
114
115#define CDNS_I2C_FIFO_DEPTH 16
116
117#define CDNS_I2C_DATA_INTR_DEPTH (CDNS_I2C_FIFO_DEPTH - 2)
118#define CDNS_I2C_MAX_TRANSFER_SIZE 255
119
120#define CDNS_I2C_TRANSFER_SIZE (CDNS_I2C_MAX_TRANSFER_SIZE - 3)
121
122#define DRIVER_NAME "cdns-i2c"
123
124#define CDNS_I2C_DIVA_MAX 4
125#define CDNS_I2C_DIVB_MAX 64
126
127#define CDNS_I2C_TIMEOUT_MAX 0xFF
128
129#define CDNS_I2C_BROKEN_HOLD_BIT BIT(0)
130
131#define cdns_i2c_readreg(offset) readl_relaxed(id->membase + offset)
132#define cdns_i2c_writereg(val, offset) writel_relaxed(val, id->membase + offset)
133
134#if IS_ENABLED(CONFIG_I2C_SLAVE)
135
136
137
138
139
140
141enum cdns_i2c_mode {
142 CDNS_I2C_MODE_SLAVE,
143 CDNS_I2C_MODE_MASTER,
144};
145
146
147
148
149
150
151
152
153enum cdns_i2c_slave_state {
154 CDNS_I2C_SLAVE_STATE_IDLE,
155 CDNS_I2C_SLAVE_STATE_SEND,
156 CDNS_I2C_SLAVE_STATE_RECV,
157};
158#endif
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186struct cdns_i2c {
187 struct device *dev;
188 void __iomem *membase;
189 struct i2c_adapter adap;
190 struct i2c_msg *p_msg;
191 int err_status;
192 struct completion xfer_done;
193 unsigned char *p_send_buf;
194 unsigned char *p_recv_buf;
195 unsigned int send_count;
196 unsigned int recv_count;
197 unsigned int curr_recv_count;
198 int irq;
199 unsigned long input_clk;
200 unsigned int i2c_clk;
201 unsigned int bus_hold_flag;
202 struct clk *clk;
203 struct notifier_block clk_rate_change_nb;
204 u32 quirks;
205#if IS_ENABLED(CONFIG_I2C_SLAVE)
206 u16 ctrl_reg_diva_divb;
207 struct i2c_client *slave;
208 enum cdns_i2c_mode dev_mode;
209 enum cdns_i2c_slave_state slave_state;
210#endif
211};
212
213struct cdns_platform_data {
214 u32 quirks;
215};
216
217#define to_cdns_i2c(_nb) container_of(_nb, struct cdns_i2c, \
218 clk_rate_change_nb)
219
220
221
222
223
224
225
226static void cdns_i2c_clear_bus_hold(struct cdns_i2c *id)
227{
228 u32 reg = cdns_i2c_readreg(CDNS_I2C_CR_OFFSET);
229 if (reg & CDNS_I2C_CR_HOLD)
230 cdns_i2c_writereg(reg & ~CDNS_I2C_CR_HOLD, CDNS_I2C_CR_OFFSET);
231}
232
233static inline bool cdns_is_holdquirk(struct cdns_i2c *id, bool hold_wrkaround)
234{
235 return (hold_wrkaround &&
236 (id->curr_recv_count == CDNS_I2C_FIFO_DEPTH + 1));
237}
238
239#if IS_ENABLED(CONFIG_I2C_SLAVE)
240static void cdns_i2c_set_mode(enum cdns_i2c_mode mode, struct cdns_i2c *id)
241{
242
243 cdns_i2c_writereg(CDNS_I2C_IXR_ALL_INTR_MASK, CDNS_I2C_IDR_OFFSET);
244
245
246 cdns_i2c_writereg(CDNS_I2C_CR_CLR_FIFO, CDNS_I2C_CR_OFFSET);
247
248
249 id->dev_mode = mode;
250 id->slave_state = CDNS_I2C_SLAVE_STATE_IDLE;
251
252 switch (mode) {
253 case CDNS_I2C_MODE_MASTER:
254
255 cdns_i2c_writereg(id->ctrl_reg_diva_divb |
256 CDNS_I2C_CR_MASTER_EN_MASK,
257 CDNS_I2C_CR_OFFSET);
258
259
260
261
262
263
264 usleep_range(115, 125);
265 break;
266 case CDNS_I2C_MODE_SLAVE:
267
268 cdns_i2c_writereg(id->ctrl_reg_diva_divb &
269 CDNS_I2C_CR_SLAVE_EN_MASK,
270 CDNS_I2C_CR_OFFSET);
271
272
273 cdns_i2c_writereg(id->slave->addr & CDNS_I2C_ADDR_MASK,
274 CDNS_I2C_ADDR_OFFSET);
275
276
277 cdns_i2c_writereg(CDNS_I2C_IXR_SLAVE_INTR_MASK,
278 CDNS_I2C_IER_OFFSET);
279 break;
280 }
281}
282
283static void cdns_i2c_slave_rcv_data(struct cdns_i2c *id)
284{
285 u8 bytes;
286 unsigned char data;
287
288
289 if (id->slave_state == CDNS_I2C_SLAVE_STATE_IDLE) {
290 id->slave_state = CDNS_I2C_SLAVE_STATE_RECV;
291 i2c_slave_event(id->slave, I2C_SLAVE_WRITE_REQUESTED, NULL);
292 }
293
294
295 bytes = cdns_i2c_readreg(CDNS_I2C_XFER_SIZE_OFFSET);
296
297
298 while (bytes--) {
299 data = cdns_i2c_readreg(CDNS_I2C_DATA_OFFSET);
300 i2c_slave_event(id->slave, I2C_SLAVE_WRITE_RECEIVED, &data);
301 }
302}
303
304static void cdns_i2c_slave_send_data(struct cdns_i2c *id)
305{
306 u8 data;
307
308
309 if (id->slave_state == CDNS_I2C_SLAVE_STATE_IDLE) {
310 id->slave_state = CDNS_I2C_SLAVE_STATE_SEND;
311 i2c_slave_event(id->slave, I2C_SLAVE_READ_REQUESTED, &data);
312 } else {
313 i2c_slave_event(id->slave, I2C_SLAVE_READ_PROCESSED, &data);
314 }
315
316
317 cdns_i2c_writereg(data, CDNS_I2C_DATA_OFFSET);
318}
319
320
321
322
323
324
325
326
327
328
329static irqreturn_t cdns_i2c_slave_isr(void *ptr)
330{
331 struct cdns_i2c *id = ptr;
332 unsigned int isr_status, i2c_status;
333
334
335 isr_status = cdns_i2c_readreg(CDNS_I2C_ISR_OFFSET);
336 cdns_i2c_writereg(isr_status, CDNS_I2C_ISR_OFFSET);
337
338
339 isr_status &= ~cdns_i2c_readreg(CDNS_I2C_IMR_OFFSET);
340
341
342 i2c_status = cdns_i2c_readreg(CDNS_I2C_SR_OFFSET);
343
344
345 if (i2c_status & CDNS_I2C_SR_RXRW) {
346
347 if (isr_status & CDNS_I2C_IXR_DATA)
348 cdns_i2c_slave_send_data(id);
349
350 if (isr_status & CDNS_I2C_IXR_COMP) {
351 id->slave_state = CDNS_I2C_SLAVE_STATE_IDLE;
352 i2c_slave_event(id->slave, I2C_SLAVE_STOP, NULL);
353 }
354 } else {
355
356 if (isr_status & CDNS_I2C_IXR_DATA)
357 cdns_i2c_slave_rcv_data(id);
358
359 if (isr_status & CDNS_I2C_IXR_COMP) {
360 cdns_i2c_slave_rcv_data(id);
361 id->slave_state = CDNS_I2C_SLAVE_STATE_IDLE;
362 i2c_slave_event(id->slave, I2C_SLAVE_STOP, NULL);
363 }
364 }
365
366
367 if (isr_status & (CDNS_I2C_IXR_NACK | CDNS_I2C_IXR_RX_OVF |
368 CDNS_I2C_IXR_RX_UNF | CDNS_I2C_IXR_TX_OVF)) {
369 id->slave_state = CDNS_I2C_SLAVE_STATE_IDLE;
370 i2c_slave_event(id->slave, I2C_SLAVE_STOP, NULL);
371 cdns_i2c_writereg(CDNS_I2C_CR_CLR_FIFO, CDNS_I2C_CR_OFFSET);
372 }
373
374 return IRQ_HANDLED;
375}
376#endif
377
378
379
380
381
382
383
384
385
386
387static irqreturn_t cdns_i2c_master_isr(void *ptr)
388{
389 unsigned int isr_status, avail_bytes, updatetx;
390 unsigned int bytes_to_send;
391 bool hold_quirk;
392 struct cdns_i2c *id = ptr;
393
394 int done_flag = 0;
395 irqreturn_t status = IRQ_NONE;
396
397 isr_status = cdns_i2c_readreg(CDNS_I2C_ISR_OFFSET);
398 cdns_i2c_writereg(isr_status, CDNS_I2C_ISR_OFFSET);
399 id->err_status = 0;
400
401
402 if (isr_status & (CDNS_I2C_IXR_NACK | CDNS_I2C_IXR_ARB_LOST)) {
403 done_flag = 1;
404 status = IRQ_HANDLED;
405 }
406
407
408
409
410
411 updatetx = 0;
412 if (id->recv_count > id->curr_recv_count)
413 updatetx = 1;
414
415 hold_quirk = (id->quirks & CDNS_I2C_BROKEN_HOLD_BIT) && updatetx;
416
417
418 if (id->p_recv_buf &&
419 ((isr_status & CDNS_I2C_IXR_COMP) ||
420 (isr_status & CDNS_I2C_IXR_DATA))) {
421
422 while (cdns_i2c_readreg(CDNS_I2C_SR_OFFSET) &
423 CDNS_I2C_SR_RXDV) {
424 if (id->recv_count > 0) {
425 *(id->p_recv_buf)++ =
426 cdns_i2c_readreg(CDNS_I2C_DATA_OFFSET);
427 id->recv_count--;
428 id->curr_recv_count--;
429
430
431
432
433
434
435 if (id->recv_count <= CDNS_I2C_FIFO_DEPTH &&
436 !id->bus_hold_flag)
437 cdns_i2c_clear_bus_hold(id);
438
439 } else {
440 dev_err(id->adap.dev.parent,
441 "xfer_size reg rollover. xfer aborted!\n");
442 id->err_status |= CDNS_I2C_IXR_TO;
443 break;
444 }
445
446 if (cdns_is_holdquirk(id, hold_quirk))
447 break;
448 }
449
450
451
452
453
454
455
456
457 if (cdns_is_holdquirk(id, hold_quirk)) {
458
459 while (cdns_i2c_readreg(CDNS_I2C_XFER_SIZE_OFFSET) !=
460 (id->curr_recv_count - CDNS_I2C_FIFO_DEPTH))
461 ;
462
463
464
465
466
467 if (((int)(id->recv_count) - CDNS_I2C_FIFO_DEPTH) >
468 CDNS_I2C_TRANSFER_SIZE) {
469 cdns_i2c_writereg(CDNS_I2C_TRANSFER_SIZE,
470 CDNS_I2C_XFER_SIZE_OFFSET);
471 id->curr_recv_count = CDNS_I2C_TRANSFER_SIZE +
472 CDNS_I2C_FIFO_DEPTH;
473 } else {
474 cdns_i2c_writereg(id->recv_count -
475 CDNS_I2C_FIFO_DEPTH,
476 CDNS_I2C_XFER_SIZE_OFFSET);
477 id->curr_recv_count = id->recv_count;
478 }
479 } else if (id->recv_count && !hold_quirk &&
480 !id->curr_recv_count) {
481
482
483 cdns_i2c_writereg(id->p_msg->addr & CDNS_I2C_ADDR_MASK,
484 CDNS_I2C_ADDR_OFFSET);
485
486 if (id->recv_count > CDNS_I2C_TRANSFER_SIZE) {
487 cdns_i2c_writereg(CDNS_I2C_TRANSFER_SIZE,
488 CDNS_I2C_XFER_SIZE_OFFSET);
489 id->curr_recv_count = CDNS_I2C_TRANSFER_SIZE;
490 } else {
491 cdns_i2c_writereg(id->recv_count,
492 CDNS_I2C_XFER_SIZE_OFFSET);
493 id->curr_recv_count = id->recv_count;
494 }
495 }
496
497
498 if ((isr_status & CDNS_I2C_IXR_COMP) && !id->recv_count) {
499 if (!id->bus_hold_flag)
500 cdns_i2c_clear_bus_hold(id);
501 done_flag = 1;
502 }
503
504 status = IRQ_HANDLED;
505 }
506
507
508 if ((isr_status & CDNS_I2C_IXR_COMP) && !id->p_recv_buf) {
509
510
511
512
513 if (id->send_count) {
514 avail_bytes = CDNS_I2C_FIFO_DEPTH -
515 cdns_i2c_readreg(CDNS_I2C_XFER_SIZE_OFFSET);
516 if (id->send_count > avail_bytes)
517 bytes_to_send = avail_bytes;
518 else
519 bytes_to_send = id->send_count;
520
521 while (bytes_to_send--) {
522 cdns_i2c_writereg(
523 (*(id->p_send_buf)++),
524 CDNS_I2C_DATA_OFFSET);
525 id->send_count--;
526 }
527 } else {
528
529
530
531
532
533 done_flag = 1;
534 }
535 if (!id->send_count && !id->bus_hold_flag)
536 cdns_i2c_clear_bus_hold(id);
537
538 status = IRQ_HANDLED;
539 }
540
541
542 id->err_status |= isr_status & CDNS_I2C_IXR_ERR_INTR_MASK;
543 if (id->err_status)
544 status = IRQ_HANDLED;
545
546 if (done_flag)
547 complete(&id->xfer_done);
548
549 return status;
550}
551
552
553
554
555
556
557
558
559
560
561
562static irqreturn_t cdns_i2c_isr(int irq, void *ptr)
563{
564#if IS_ENABLED(CONFIG_I2C_SLAVE)
565 struct cdns_i2c *id = ptr;
566
567 if (id->dev_mode == CDNS_I2C_MODE_SLAVE)
568 return cdns_i2c_slave_isr(ptr);
569#endif
570 return cdns_i2c_master_isr(ptr);
571}
572
573
574
575
576
577static void cdns_i2c_mrecv(struct cdns_i2c *id)
578{
579 unsigned int ctrl_reg;
580 unsigned int isr_status;
581
582 id->p_recv_buf = id->p_msg->buf;
583 id->recv_count = id->p_msg->len;
584
585
586 ctrl_reg = cdns_i2c_readreg(CDNS_I2C_CR_OFFSET);
587 ctrl_reg |= CDNS_I2C_CR_RW | CDNS_I2C_CR_CLR_FIFO;
588
589 if (id->p_msg->flags & I2C_M_RECV_LEN)
590 id->recv_count = I2C_SMBUS_BLOCK_MAX + 1;
591
592 id->curr_recv_count = id->recv_count;
593
594
595
596
597
598 if (id->recv_count > CDNS_I2C_FIFO_DEPTH)
599 ctrl_reg |= CDNS_I2C_CR_HOLD;
600
601 cdns_i2c_writereg(ctrl_reg, CDNS_I2C_CR_OFFSET);
602
603
604 isr_status = cdns_i2c_readreg(CDNS_I2C_ISR_OFFSET);
605 cdns_i2c_writereg(isr_status, CDNS_I2C_ISR_OFFSET);
606
607
608
609
610
611
612
613 if (id->recv_count > CDNS_I2C_TRANSFER_SIZE) {
614 cdns_i2c_writereg(CDNS_I2C_TRANSFER_SIZE,
615 CDNS_I2C_XFER_SIZE_OFFSET);
616 id->curr_recv_count = CDNS_I2C_TRANSFER_SIZE;
617 } else {
618 cdns_i2c_writereg(id->recv_count, CDNS_I2C_XFER_SIZE_OFFSET);
619 }
620
621
622 cdns_i2c_writereg(id->p_msg->addr & CDNS_I2C_ADDR_MASK,
623 CDNS_I2C_ADDR_OFFSET);
624
625 if (!id->bus_hold_flag &&
626 ((id->p_msg->flags & I2C_M_RECV_LEN) != I2C_M_RECV_LEN) &&
627 (id->recv_count <= CDNS_I2C_FIFO_DEPTH))
628 cdns_i2c_clear_bus_hold(id);
629 cdns_i2c_writereg(CDNS_I2C_ENABLED_INTR_MASK, CDNS_I2C_IER_OFFSET);
630}
631
632
633
634
635
636static void cdns_i2c_msend(struct cdns_i2c *id)
637{
638 unsigned int avail_bytes;
639 unsigned int bytes_to_send;
640 unsigned int ctrl_reg;
641 unsigned int isr_status;
642
643 id->p_recv_buf = NULL;
644 id->p_send_buf = id->p_msg->buf;
645 id->send_count = id->p_msg->len;
646
647
648 ctrl_reg = cdns_i2c_readreg(CDNS_I2C_CR_OFFSET);
649 ctrl_reg &= ~CDNS_I2C_CR_RW;
650 ctrl_reg |= CDNS_I2C_CR_CLR_FIFO;
651
652
653
654
655
656 if (id->send_count > CDNS_I2C_FIFO_DEPTH)
657 ctrl_reg |= CDNS_I2C_CR_HOLD;
658 cdns_i2c_writereg(ctrl_reg, CDNS_I2C_CR_OFFSET);
659
660
661 isr_status = cdns_i2c_readreg(CDNS_I2C_ISR_OFFSET);
662 cdns_i2c_writereg(isr_status, CDNS_I2C_ISR_OFFSET);
663
664
665
666
667
668
669 avail_bytes = CDNS_I2C_FIFO_DEPTH -
670 cdns_i2c_readreg(CDNS_I2C_XFER_SIZE_OFFSET);
671
672 if (id->send_count > avail_bytes)
673 bytes_to_send = avail_bytes;
674 else
675 bytes_to_send = id->send_count;
676
677 while (bytes_to_send--) {
678 cdns_i2c_writereg((*(id->p_send_buf)++), CDNS_I2C_DATA_OFFSET);
679 id->send_count--;
680 }
681
682
683
684
685
686 if (!id->bus_hold_flag && !id->send_count)
687 cdns_i2c_clear_bus_hold(id);
688
689 cdns_i2c_writereg(id->p_msg->addr & CDNS_I2C_ADDR_MASK,
690 CDNS_I2C_ADDR_OFFSET);
691
692 cdns_i2c_writereg(CDNS_I2C_ENABLED_INTR_MASK, CDNS_I2C_IER_OFFSET);
693}
694
695
696
697
698
699
700
701
702static void cdns_i2c_master_reset(struct i2c_adapter *adap)
703{
704 struct cdns_i2c *id = adap->algo_data;
705 u32 regval;
706
707
708 cdns_i2c_writereg(CDNS_I2C_IXR_ALL_INTR_MASK, CDNS_I2C_IDR_OFFSET);
709
710 regval = cdns_i2c_readreg(CDNS_I2C_CR_OFFSET);
711 regval &= ~CDNS_I2C_CR_HOLD;
712 regval |= CDNS_I2C_CR_CLR_FIFO;
713 cdns_i2c_writereg(regval, CDNS_I2C_CR_OFFSET);
714
715 cdns_i2c_writereg(0, CDNS_I2C_XFER_SIZE_OFFSET);
716
717 regval = cdns_i2c_readreg(CDNS_I2C_ISR_OFFSET);
718 cdns_i2c_writereg(regval, CDNS_I2C_ISR_OFFSET);
719
720 regval = cdns_i2c_readreg(CDNS_I2C_SR_OFFSET);
721 cdns_i2c_writereg(regval, CDNS_I2C_SR_OFFSET);
722}
723
724static int cdns_i2c_process_msg(struct cdns_i2c *id, struct i2c_msg *msg,
725 struct i2c_adapter *adap)
726{
727 unsigned long time_left;
728 u32 reg;
729
730 id->p_msg = msg;
731 id->err_status = 0;
732 reinit_completion(&id->xfer_done);
733
734
735 reg = cdns_i2c_readreg(CDNS_I2C_CR_OFFSET);
736 if (msg->flags & I2C_M_TEN) {
737 if (reg & CDNS_I2C_CR_NEA)
738 cdns_i2c_writereg(reg & ~CDNS_I2C_CR_NEA,
739 CDNS_I2C_CR_OFFSET);
740 } else {
741 if (!(reg & CDNS_I2C_CR_NEA))
742 cdns_i2c_writereg(reg | CDNS_I2C_CR_NEA,
743 CDNS_I2C_CR_OFFSET);
744 }
745
746
747 if (msg->flags & I2C_M_RD)
748 cdns_i2c_mrecv(id);
749 else
750 cdns_i2c_msend(id);
751
752
753 time_left = wait_for_completion_timeout(&id->xfer_done, adap->timeout);
754 if (time_left == 0) {
755 cdns_i2c_master_reset(adap);
756 dev_err(id->adap.dev.parent,
757 "timeout waiting on completion\n");
758 return -ETIMEDOUT;
759 }
760
761 cdns_i2c_writereg(CDNS_I2C_IXR_ALL_INTR_MASK,
762 CDNS_I2C_IDR_OFFSET);
763
764
765 if (id->err_status & CDNS_I2C_IXR_ARB_LOST)
766 return -EAGAIN;
767
768 return 0;
769}
770
771
772
773
774
775
776
777
778
779
780
781static int cdns_i2c_master_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs,
782 int num)
783{
784 int ret, count;
785 u32 reg;
786 struct cdns_i2c *id = adap->algo_data;
787 bool hold_quirk;
788#if IS_ENABLED(CONFIG_I2C_SLAVE)
789 bool change_role = false;
790#endif
791
792 ret = pm_runtime_resume_and_get(id->dev);
793 if (ret < 0)
794 return ret;
795
796#if IS_ENABLED(CONFIG_I2C_SLAVE)
797
798 if (id->dev_mode == CDNS_I2C_MODE_SLAVE) {
799 if (id->slave_state != CDNS_I2C_SLAVE_STATE_IDLE)
800 return -EAGAIN;
801
802
803 cdns_i2c_set_mode(CDNS_I2C_MODE_MASTER, id);
804
805
806 change_role = true;
807 }
808#endif
809
810
811 if (cdns_i2c_readreg(CDNS_I2C_SR_OFFSET) & CDNS_I2C_SR_BA) {
812 ret = -EAGAIN;
813 goto out;
814 }
815
816 hold_quirk = !!(id->quirks & CDNS_I2C_BROKEN_HOLD_BIT);
817
818
819
820
821 if (num > 1) {
822
823
824
825
826
827
828
829 for (count = 0; (count < num - 1 && hold_quirk); count++) {
830 if (msgs[count].flags & I2C_M_RD) {
831 dev_warn(adap->dev.parent,
832 "Can't do repeated start after a receive message\n");
833 ret = -EOPNOTSUPP;
834 goto out;
835 }
836 }
837 id->bus_hold_flag = 1;
838 reg = cdns_i2c_readreg(CDNS_I2C_CR_OFFSET);
839 reg |= CDNS_I2C_CR_HOLD;
840 cdns_i2c_writereg(reg, CDNS_I2C_CR_OFFSET);
841 } else {
842 id->bus_hold_flag = 0;
843 }
844
845
846 for (count = 0; count < num; count++, msgs++) {
847 if (count == (num - 1))
848 id->bus_hold_flag = 0;
849
850 ret = cdns_i2c_process_msg(id, msgs, adap);
851 if (ret)
852 goto out;
853
854
855 if (id->err_status) {
856 cdns_i2c_master_reset(adap);
857
858 if (id->err_status & CDNS_I2C_IXR_NACK) {
859 ret = -ENXIO;
860 goto out;
861 }
862 ret = -EIO;
863 goto out;
864 }
865 }
866
867 ret = num;
868
869out:
870
871#if IS_ENABLED(CONFIG_I2C_SLAVE)
872
873 if (change_role)
874 cdns_i2c_set_mode(CDNS_I2C_MODE_SLAVE, id);
875#endif
876
877 pm_runtime_mark_last_busy(id->dev);
878 pm_runtime_put_autosuspend(id->dev);
879 return ret;
880}
881
882
883
884
885
886
887
888static u32 cdns_i2c_func(struct i2c_adapter *adap)
889{
890 u32 func = I2C_FUNC_I2C | I2C_FUNC_10BIT_ADDR |
891 (I2C_FUNC_SMBUS_EMUL & ~I2C_FUNC_SMBUS_QUICK) |
892 I2C_FUNC_SMBUS_BLOCK_DATA;
893
894#if IS_ENABLED(CONFIG_I2C_SLAVE)
895 func |= I2C_FUNC_SLAVE;
896#endif
897
898 return func;
899}
900
901#if IS_ENABLED(CONFIG_I2C_SLAVE)
902static int cdns_reg_slave(struct i2c_client *slave)
903{
904 int ret;
905 struct cdns_i2c *id = container_of(slave->adapter, struct cdns_i2c,
906 adap);
907
908 if (id->slave)
909 return -EBUSY;
910
911 if (slave->flags & I2C_CLIENT_TEN)
912 return -EAFNOSUPPORT;
913
914 ret = pm_runtime_resume_and_get(id->dev);
915 if (ret < 0)
916 return ret;
917
918
919 id->slave = slave;
920
921
922 cdns_i2c_set_mode(CDNS_I2C_MODE_SLAVE, id);
923
924 return 0;
925}
926
927static int cdns_unreg_slave(struct i2c_client *slave)
928{
929 struct cdns_i2c *id = container_of(slave->adapter, struct cdns_i2c,
930 adap);
931
932 pm_runtime_put(id->dev);
933
934
935 id->slave = NULL;
936
937
938 cdns_i2c_set_mode(CDNS_I2C_MODE_MASTER, id);
939
940 return 0;
941}
942#endif
943
944static const struct i2c_algorithm cdns_i2c_algo = {
945 .master_xfer = cdns_i2c_master_xfer,
946 .functionality = cdns_i2c_func,
947#if IS_ENABLED(CONFIG_I2C_SLAVE)
948 .reg_slave = cdns_reg_slave,
949 .unreg_slave = cdns_unreg_slave,
950#endif
951};
952
953
954
955
956
957
958
959
960
961
962
963
964
965static int cdns_i2c_calc_divs(unsigned long *f, unsigned long input_clk,
966 unsigned int *a, unsigned int *b)
967{
968 unsigned long fscl = *f, best_fscl = *f, actual_fscl, temp;
969 unsigned int div_a, div_b, calc_div_a = 0, calc_div_b = 0;
970 unsigned int last_error, current_error;
971
972
973 temp = input_clk / (22 * fscl);
974
975
976
977
978
979 if (!temp || (temp > (CDNS_I2C_DIVA_MAX * CDNS_I2C_DIVB_MAX)))
980 return -EINVAL;
981
982 last_error = -1;
983 for (div_a = 0; div_a < CDNS_I2C_DIVA_MAX; div_a++) {
984 div_b = DIV_ROUND_UP(input_clk, 22 * fscl * (div_a + 1));
985
986 if ((div_b < 1) || (div_b > CDNS_I2C_DIVB_MAX))
987 continue;
988 div_b--;
989
990 actual_fscl = input_clk / (22 * (div_a + 1) * (div_b + 1));
991
992 if (actual_fscl > fscl)
993 continue;
994
995 current_error = ((actual_fscl > fscl) ? (actual_fscl - fscl) :
996 (fscl - actual_fscl));
997
998 if (last_error > current_error) {
999 calc_div_a = div_a;
1000 calc_div_b = div_b;
1001 best_fscl = actual_fscl;
1002 last_error = current_error;
1003 }
1004 }
1005
1006 *a = calc_div_a;
1007 *b = calc_div_b;
1008 *f = best_fscl;
1009
1010 return 0;
1011}
1012
1013
1014
1015
1016
1017
1018
1019
1020
1021
1022
1023
1024
1025
1026
1027
1028
1029static int cdns_i2c_setclk(unsigned long clk_in, struct cdns_i2c *id)
1030{
1031 unsigned int div_a, div_b;
1032 unsigned int ctrl_reg;
1033 int ret = 0;
1034 unsigned long fscl = id->i2c_clk;
1035
1036 ret = cdns_i2c_calc_divs(&fscl, clk_in, &div_a, &div_b);
1037 if (ret)
1038 return ret;
1039
1040 ctrl_reg = cdns_i2c_readreg(CDNS_I2C_CR_OFFSET);
1041 ctrl_reg &= ~(CDNS_I2C_CR_DIVA_MASK | CDNS_I2C_CR_DIVB_MASK);
1042 ctrl_reg |= ((div_a << CDNS_I2C_CR_DIVA_SHIFT) |
1043 (div_b << CDNS_I2C_CR_DIVB_SHIFT));
1044 cdns_i2c_writereg(ctrl_reg, CDNS_I2C_CR_OFFSET);
1045#if IS_ENABLED(CONFIG_I2C_SLAVE)
1046 id->ctrl_reg_diva_divb = ctrl_reg & (CDNS_I2C_CR_DIVA_MASK |
1047 CDNS_I2C_CR_DIVB_MASK);
1048#endif
1049 return 0;
1050}
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068static int cdns_i2c_clk_notifier_cb(struct notifier_block *nb, unsigned long
1069 event, void *data)
1070{
1071 struct clk_notifier_data *ndata = data;
1072 struct cdns_i2c *id = to_cdns_i2c(nb);
1073
1074 if (pm_runtime_suspended(id->dev))
1075 return NOTIFY_OK;
1076
1077 switch (event) {
1078 case PRE_RATE_CHANGE:
1079 {
1080 unsigned long input_clk = ndata->new_rate;
1081 unsigned long fscl = id->i2c_clk;
1082 unsigned int div_a, div_b;
1083 int ret;
1084
1085 ret = cdns_i2c_calc_divs(&fscl, input_clk, &div_a, &div_b);
1086 if (ret) {
1087 dev_warn(id->adap.dev.parent,
1088 "clock rate change rejected\n");
1089 return NOTIFY_STOP;
1090 }
1091
1092
1093 if (ndata->new_rate > ndata->old_rate)
1094 cdns_i2c_setclk(ndata->new_rate, id);
1095
1096 return NOTIFY_OK;
1097 }
1098 case POST_RATE_CHANGE:
1099 id->input_clk = ndata->new_rate;
1100
1101 if (ndata->new_rate < ndata->old_rate)
1102 cdns_i2c_setclk(ndata->new_rate, id);
1103 return NOTIFY_OK;
1104 case ABORT_RATE_CHANGE:
1105
1106 if (ndata->new_rate > ndata->old_rate)
1107 cdns_i2c_setclk(ndata->old_rate, id);
1108 return NOTIFY_OK;
1109 default:
1110 return NOTIFY_DONE;
1111 }
1112}
1113
1114
1115
1116
1117
1118
1119
1120
1121
1122static int __maybe_unused cdns_i2c_runtime_suspend(struct device *dev)
1123{
1124 struct cdns_i2c *xi2c = dev_get_drvdata(dev);
1125
1126 clk_disable(xi2c->clk);
1127
1128 return 0;
1129}
1130
1131
1132
1133
1134
1135
1136
1137
1138
1139static int __maybe_unused cdns_i2c_runtime_resume(struct device *dev)
1140{
1141 struct cdns_i2c *xi2c = dev_get_drvdata(dev);
1142 int ret;
1143
1144 ret = clk_enable(xi2c->clk);
1145 if (ret) {
1146 dev_err(dev, "Cannot enable clock.\n");
1147 return ret;
1148 }
1149
1150 return 0;
1151}
1152
1153static const struct dev_pm_ops cdns_i2c_dev_pm_ops = {
1154 SET_RUNTIME_PM_OPS(cdns_i2c_runtime_suspend,
1155 cdns_i2c_runtime_resume, NULL)
1156};
1157
1158static const struct cdns_platform_data r1p10_i2c_def = {
1159 .quirks = CDNS_I2C_BROKEN_HOLD_BIT,
1160};
1161
1162static const struct of_device_id cdns_i2c_of_match[] = {
1163 { .compatible = "cdns,i2c-r1p10", .data = &r1p10_i2c_def },
1164 { .compatible = "cdns,i2c-r1p14",},
1165 { }
1166};
1167MODULE_DEVICE_TABLE(of, cdns_i2c_of_match);
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178
1179static int cdns_i2c_probe(struct platform_device *pdev)
1180{
1181 struct resource *r_mem;
1182 struct cdns_i2c *id;
1183 int ret;
1184 const struct of_device_id *match;
1185
1186 id = devm_kzalloc(&pdev->dev, sizeof(*id), GFP_KERNEL);
1187 if (!id)
1188 return -ENOMEM;
1189
1190 id->dev = &pdev->dev;
1191 platform_set_drvdata(pdev, id);
1192
1193 match = of_match_node(cdns_i2c_of_match, pdev->dev.of_node);
1194 if (match && match->data) {
1195 const struct cdns_platform_data *data = match->data;
1196 id->quirks = data->quirks;
1197 }
1198
1199 id->membase = devm_platform_get_and_ioremap_resource(pdev, 0, &r_mem);
1200 if (IS_ERR(id->membase))
1201 return PTR_ERR(id->membase);
1202
1203 ret = platform_get_irq(pdev, 0);
1204 if (ret < 0)
1205 return ret;
1206 id->irq = ret;
1207
1208 id->adap.owner = THIS_MODULE;
1209 id->adap.dev.of_node = pdev->dev.of_node;
1210 id->adap.algo = &cdns_i2c_algo;
1211 id->adap.timeout = CDNS_I2C_TIMEOUT;
1212 id->adap.retries = 3;
1213 id->adap.algo_data = id;
1214 id->adap.dev.parent = &pdev->dev;
1215 init_completion(&id->xfer_done);
1216 snprintf(id->adap.name, sizeof(id->adap.name),
1217 "Cadence I2C at %08lx", (unsigned long)r_mem->start);
1218
1219 id->clk = devm_clk_get(&pdev->dev, NULL);
1220 if (IS_ERR(id->clk)) {
1221 if (PTR_ERR(id->clk) != -EPROBE_DEFER)
1222 dev_err(&pdev->dev, "input clock not found.\n");
1223 return PTR_ERR(id->clk);
1224 }
1225 ret = clk_prepare_enable(id->clk);
1226 if (ret)
1227 dev_err(&pdev->dev, "Unable to enable clock.\n");
1228
1229 pm_runtime_set_autosuspend_delay(id->dev, CNDS_I2C_PM_TIMEOUT);
1230 pm_runtime_use_autosuspend(id->dev);
1231 pm_runtime_set_active(id->dev);
1232 pm_runtime_enable(id->dev);
1233
1234 id->clk_rate_change_nb.notifier_call = cdns_i2c_clk_notifier_cb;
1235 if (clk_notifier_register(id->clk, &id->clk_rate_change_nb))
1236 dev_warn(&pdev->dev, "Unable to register clock notifier.\n");
1237 id->input_clk = clk_get_rate(id->clk);
1238
1239 ret = of_property_read_u32(pdev->dev.of_node, "clock-frequency",
1240 &id->i2c_clk);
1241 if (ret || (id->i2c_clk > I2C_MAX_FAST_MODE_FREQ))
1242 id->i2c_clk = I2C_MAX_STANDARD_MODE_FREQ;
1243
1244#if IS_ENABLED(CONFIG_I2C_SLAVE)
1245
1246 id->dev_mode = CDNS_I2C_MODE_MASTER;
1247 id->slave_state = CDNS_I2C_SLAVE_STATE_IDLE;
1248#endif
1249 cdns_i2c_writereg(CDNS_I2C_CR_MASTER_EN_MASK, CDNS_I2C_CR_OFFSET);
1250
1251 ret = cdns_i2c_setclk(id->input_clk, id);
1252 if (ret) {
1253 dev_err(&pdev->dev, "invalid SCL clock: %u Hz\n", id->i2c_clk);
1254 ret = -EINVAL;
1255 goto err_clk_dis;
1256 }
1257
1258 ret = devm_request_irq(&pdev->dev, id->irq, cdns_i2c_isr, 0,
1259 DRIVER_NAME, id);
1260 if (ret) {
1261 dev_err(&pdev->dev, "cannot get irq %d\n", id->irq);
1262 goto err_clk_dis;
1263 }
1264
1265
1266
1267
1268
1269
1270
1271
1272 cdns_i2c_writereg(CDNS_I2C_TIMEOUT_MAX, CDNS_I2C_TIME_OUT_OFFSET);
1273
1274 ret = i2c_add_adapter(&id->adap);
1275 if (ret < 0)
1276 goto err_clk_dis;
1277
1278 dev_info(&pdev->dev, "%u kHz mmio %08lx irq %d\n",
1279 id->i2c_clk / 1000, (unsigned long)r_mem->start, id->irq);
1280
1281 return 0;
1282
1283err_clk_dis:
1284 clk_disable_unprepare(id->clk);
1285 pm_runtime_disable(&pdev->dev);
1286 pm_runtime_set_suspended(&pdev->dev);
1287 return ret;
1288}
1289
1290
1291
1292
1293
1294
1295
1296
1297
1298static int cdns_i2c_remove(struct platform_device *pdev)
1299{
1300 struct cdns_i2c *id = platform_get_drvdata(pdev);
1301
1302 pm_runtime_disable(&pdev->dev);
1303 pm_runtime_set_suspended(&pdev->dev);
1304 pm_runtime_dont_use_autosuspend(&pdev->dev);
1305
1306 i2c_del_adapter(&id->adap);
1307 clk_notifier_unregister(id->clk, &id->clk_rate_change_nb);
1308 clk_disable_unprepare(id->clk);
1309
1310 return 0;
1311}
1312
1313static struct platform_driver cdns_i2c_drv = {
1314 .driver = {
1315 .name = DRIVER_NAME,
1316 .of_match_table = cdns_i2c_of_match,
1317 .pm = &cdns_i2c_dev_pm_ops,
1318 },
1319 .probe = cdns_i2c_probe,
1320 .remove = cdns_i2c_remove,
1321};
1322
1323module_platform_driver(cdns_i2c_drv);
1324
1325MODULE_AUTHOR("Xilinx Inc.");
1326MODULE_DESCRIPTION("Cadence I2C bus driver");
1327MODULE_LICENSE("GPL");
1328