blob: 5eab338cfc470fbc57ae1fd4cff2166d122fa536 [file] [log] [blame]
Darwin Rambo18ca5972014-02-11 11:06:36 -08001/*
2 * Copyright 2013 Broadcom Corporation.
3 *
4 * SPDX-License-Identifier: GPL-2.0+
5 */
6
7#include <common.h>
8#include <asm/io.h>
9#include <asm/errno.h>
10#include <asm/arch/sysmap.h>
11#include <asm/kona-common/clk.h>
12#include <i2c.h>
13
14/* Hardware register offsets and field defintions */
15#define CS_OFFSET 0x00000020
16#define CS_ACK_SHIFT 3
17#define CS_ACK_MASK 0x00000008
18#define CS_ACK_CMD_GEN_START 0x00000000
19#define CS_ACK_CMD_GEN_RESTART 0x00000001
20#define CS_CMD_SHIFT 1
21#define CS_CMD_CMD_NO_ACTION 0x00000000
22#define CS_CMD_CMD_START_RESTART 0x00000001
23#define CS_CMD_CMD_STOP 0x00000002
24#define CS_EN_SHIFT 0
25#define CS_EN_CMD_ENABLE_BSC 0x00000001
26
27#define TIM_OFFSET 0x00000024
28#define TIM_PRESCALE_SHIFT 6
29#define TIM_P_SHIFT 3
30#define TIM_NO_DIV_SHIFT 2
31#define TIM_DIV_SHIFT 0
32
33#define DAT_OFFSET 0x00000028
34
35#define TOUT_OFFSET 0x0000002c
36
37#define TXFCR_OFFSET 0x0000003c
38#define TXFCR_FIFO_FLUSH_MASK 0x00000080
39#define TXFCR_FIFO_EN_MASK 0x00000040
40
41#define IER_OFFSET 0x00000044
42#define IER_READ_COMPLETE_INT_MASK 0x00000010
43#define IER_I2C_INT_EN_MASK 0x00000008
44#define IER_FIFO_INT_EN_MASK 0x00000002
45#define IER_NOACK_EN_MASK 0x00000001
46
47#define ISR_OFFSET 0x00000048
48#define ISR_RESERVED_MASK 0xffffff60
49#define ISR_CMDBUSY_MASK 0x00000080
50#define ISR_READ_COMPLETE_MASK 0x00000010
51#define ISR_SES_DONE_MASK 0x00000008
52#define ISR_ERR_MASK 0x00000004
53#define ISR_TXFIFOEMPTY_MASK 0x00000002
54#define ISR_NOACK_MASK 0x00000001
55
56#define CLKEN_OFFSET 0x0000004c
57#define CLKEN_AUTOSENSE_OFF_MASK 0x00000080
58#define CLKEN_M_SHIFT 4
59#define CLKEN_N_SHIFT 1
60#define CLKEN_CLKEN_MASK 0x00000001
61
62#define FIFO_STATUS_OFFSET 0x00000054
63#define FIFO_STATUS_RXFIFO_EMPTY_MASK 0x00000004
64#define FIFO_STATUS_TXFIFO_EMPTY_MASK 0x00000010
65
66#define HSTIM_OFFSET 0x00000058
67#define HSTIM_HS_MODE_MASK 0x00008000
68#define HSTIM_HS_HOLD_SHIFT 10
69#define HSTIM_HS_HIGH_PHASE_SHIFT 5
70#define HSTIM_HS_SETUP_SHIFT 0
71
72#define PADCTL_OFFSET 0x0000005c
73#define PADCTL_PAD_OUT_EN_MASK 0x00000004
74
75#define RXFCR_OFFSET 0x00000068
76#define RXFCR_NACK_EN_SHIFT 7
77#define RXFCR_READ_COUNT_SHIFT 0
78#define RXFIFORDOUT_OFFSET 0x0000006c
79
80/* Locally used constants */
81#define MAX_RX_FIFO_SIZE 64U /* bytes */
82#define MAX_TX_FIFO_SIZE 64U /* bytes */
83
84#define I2C_TIMEOUT 100000 /* usecs */
85
86#define WAIT_INT_CHK 100 /* usecs */
87#if I2C_TIMEOUT % WAIT_INT_CHK
88#error I2C_TIMEOUT must be a multiple of WAIT_INT_CHK
89#endif
90
91/* Operations that can be commanded to the controller */
92enum bcm_kona_cmd_t {
93 BCM_CMD_NOACTION = 0,
94 BCM_CMD_START,
95 BCM_CMD_RESTART,
96 BCM_CMD_STOP,
97};
98
99enum bus_speed_index {
100 BCM_SPD_100K = 0,
101 BCM_SPD_400K,
102 BCM_SPD_1MHZ,
103};
104
105/* Internal divider settings for standard mode, fast mode and fast mode plus */
106struct bus_speed_cfg {
107 uint8_t time_m; /* Number of cycles for setup time */
108 uint8_t time_n; /* Number of cycles for hold time */
109 uint8_t prescale; /* Prescale divider */
110 uint8_t time_p; /* Timing coefficient */
111 uint8_t no_div; /* Disable clock divider */
112 uint8_t time_div; /* Post-prescale divider */
113};
114
115static const struct bus_speed_cfg std_cfg_table[] = {
116 [BCM_SPD_100K] = {0x01, 0x01, 0x03, 0x06, 0x00, 0x02},
117 [BCM_SPD_400K] = {0x05, 0x01, 0x03, 0x05, 0x01, 0x02},
118 [BCM_SPD_1MHZ] = {0x01, 0x01, 0x03, 0x01, 0x01, 0x03},
119};
120
121struct bcm_kona_i2c_dev {
122 void *base;
123 uint speed;
124 const struct bus_speed_cfg *std_cfg;
125};
126
127/* Keep these two defines in sync */
128#define DEF_SPD 100000
129#define DEF_SPD_ENUM BCM_SPD_100K
130
131#define DEF_DEVICE(num) \
132{(void *)CONFIG_SYS_I2C_BASE##num, DEF_SPD, &std_cfg_table[DEF_SPD_ENUM]}
133
134static struct bcm_kona_i2c_dev g_i2c_devs[CONFIG_SYS_MAX_I2C_BUS] = {
135#ifdef CONFIG_SYS_I2C_BASE0
136 DEF_DEVICE(0),
137#endif
138#ifdef CONFIG_SYS_I2C_BASE1
139 DEF_DEVICE(1),
140#endif
141#ifdef CONFIG_SYS_I2C_BASE2
142 DEF_DEVICE(2),
143#endif
144#ifdef CONFIG_SYS_I2C_BASE3
145 DEF_DEVICE(3),
146#endif
147#ifdef CONFIG_SYS_I2C_BASE4
148 DEF_DEVICE(4),
149#endif
150#ifdef CONFIG_SYS_I2C_BASE5
151 DEF_DEVICE(5),
152#endif
153};
154
155#define I2C_M_TEN 0x0010 /* ten bit address */
156#define I2C_M_RD 0x0001 /* read data */
157#define I2C_M_NOSTART 0x4000 /* no restart between msgs */
158
159struct i2c_msg {
160 uint16_t addr;
161 uint16_t flags;
162 uint16_t len;
163 uint8_t *buf;
164};
165
166static void bcm_kona_i2c_send_cmd_to_ctrl(struct bcm_kona_i2c_dev *dev,
167 enum bcm_kona_cmd_t cmd)
168{
169 debug("%s, %d\n", __func__, cmd);
170
171 switch (cmd) {
172 case BCM_CMD_NOACTION:
173 writel((CS_CMD_CMD_NO_ACTION << CS_CMD_SHIFT) |
174 (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT),
175 dev->base + CS_OFFSET);
176 break;
177
178 case BCM_CMD_START:
179 writel((CS_ACK_CMD_GEN_START << CS_ACK_SHIFT) |
180 (CS_CMD_CMD_START_RESTART << CS_CMD_SHIFT) |
181 (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT),
182 dev->base + CS_OFFSET);
183 break;
184
185 case BCM_CMD_RESTART:
186 writel((CS_ACK_CMD_GEN_RESTART << CS_ACK_SHIFT) |
187 (CS_CMD_CMD_START_RESTART << CS_CMD_SHIFT) |
188 (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT),
189 dev->base + CS_OFFSET);
190 break;
191
192 case BCM_CMD_STOP:
193 writel((CS_CMD_CMD_STOP << CS_CMD_SHIFT) |
194 (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT),
195 dev->base + CS_OFFSET);
196 break;
197
198 default:
199 printf("Unknown command %d\n", cmd);
200 }
201}
202
203static void bcm_kona_i2c_enable_clock(struct bcm_kona_i2c_dev *dev)
204{
205 writel(readl(dev->base + CLKEN_OFFSET) | CLKEN_CLKEN_MASK,
206 dev->base + CLKEN_OFFSET);
207}
208
209static void bcm_kona_i2c_disable_clock(struct bcm_kona_i2c_dev *dev)
210{
211 writel(readl(dev->base + CLKEN_OFFSET) & ~CLKEN_CLKEN_MASK,
212 dev->base + CLKEN_OFFSET);
213}
214
215/* Wait until at least one of the mask bit(s) are set */
216static unsigned long wait_for_int_timeout(struct bcm_kona_i2c_dev *dev,
217 unsigned long time_left,
218 uint32_t mask)
219{
220 uint32_t status;
221
222 while (time_left) {
223 status = readl(dev->base + ISR_OFFSET);
224
225 if ((status & ~ISR_RESERVED_MASK) == 0) {
226 debug("Bogus I2C interrupt 0x%x\n", status);
227 continue;
228 }
229
230 /* Must flush the TX FIFO when NAK detected */
231 if (status & ISR_NOACK_MASK)
232 writel(TXFCR_FIFO_FLUSH_MASK | TXFCR_FIFO_EN_MASK,
233 dev->base + TXFCR_OFFSET);
234
235 writel(status & ~ISR_RESERVED_MASK, dev->base + ISR_OFFSET);
236
237 if (status & mask) {
238 /* We are done since one of the mask bits are set */
239 return time_left;
240 }
241 udelay(WAIT_INT_CHK);
242 time_left -= WAIT_INT_CHK;
243 }
244 return 0;
245}
246
247/* Send command to I2C bus */
248static int bcm_kona_send_i2c_cmd(struct bcm_kona_i2c_dev *dev,
249 enum bcm_kona_cmd_t cmd)
250{
251 int rc = 0;
252 unsigned long time_left = I2C_TIMEOUT;
253
254 /* Send the command */
255 bcm_kona_i2c_send_cmd_to_ctrl(dev, cmd);
256
257 /* Wait for transaction to finish or timeout */
258 time_left = wait_for_int_timeout(dev, time_left, IER_I2C_INT_EN_MASK);
259
260 if (!time_left) {
261 printf("controller timed out\n");
262 rc = -ETIMEDOUT;
263 }
264
265 /* Clear command */
266 bcm_kona_i2c_send_cmd_to_ctrl(dev, BCM_CMD_NOACTION);
267
268 return rc;
269}
270
271/* Read a single RX FIFO worth of data from the i2c bus */
272static int bcm_kona_i2c_read_fifo_single(struct bcm_kona_i2c_dev *dev,
273 uint8_t *buf, unsigned int len,
274 unsigned int last_byte_nak)
275{
276 unsigned long time_left = I2C_TIMEOUT;
277
278 /* Start the RX FIFO */
279 writel((last_byte_nak << RXFCR_NACK_EN_SHIFT) |
280 (len << RXFCR_READ_COUNT_SHIFT), dev->base + RXFCR_OFFSET);
281
282 /* Wait for FIFO read to complete */
283 time_left =
284 wait_for_int_timeout(dev, time_left, IER_READ_COMPLETE_INT_MASK);
285
286 if (!time_left) {
287 printf("RX FIFO time out\n");
288 return -EREMOTEIO;
289 }
290
291 /* Read data from FIFO */
292 for (; len > 0; len--, buf++)
293 *buf = readl(dev->base + RXFIFORDOUT_OFFSET);
294
295 return 0;
296}
297
298/* Read any amount of data using the RX FIFO from the i2c bus */
299static int bcm_kona_i2c_read_fifo(struct bcm_kona_i2c_dev *dev,
300 struct i2c_msg *msg)
301{
302 unsigned int bytes_to_read = MAX_RX_FIFO_SIZE;
303 unsigned int last_byte_nak = 0;
304 unsigned int bytes_read = 0;
305 int rc;
306
307 uint8_t *tmp_buf = msg->buf;
308
309 while (bytes_read < msg->len) {
310 if (msg->len - bytes_read <= MAX_RX_FIFO_SIZE) {
311 last_byte_nak = 1; /* NAK last byte of transfer */
312 bytes_to_read = msg->len - bytes_read;
313 }
314
315 rc = bcm_kona_i2c_read_fifo_single(dev, tmp_buf, bytes_to_read,
316 last_byte_nak);
317 if (rc < 0)
318 return -EREMOTEIO;
319
320 bytes_read += bytes_to_read;
321 tmp_buf += bytes_to_read;
322 }
323
324 return 0;
325}
326
327/* Write a single byte of data to the i2c bus */
328static int bcm_kona_i2c_write_byte(struct bcm_kona_i2c_dev *dev, uint8_t data,
329 unsigned int nak_expected)
330{
331 unsigned long time_left = I2C_TIMEOUT;
332 unsigned int nak_received;
333
334 /* Clear pending session done interrupt */
335 writel(ISR_SES_DONE_MASK, dev->base + ISR_OFFSET);
336
337 /* Send one byte of data */
338 writel(data, dev->base + DAT_OFFSET);
339
340 time_left = wait_for_int_timeout(dev, time_left, IER_I2C_INT_EN_MASK);
341
342 if (!time_left) {
343 debug("controller timed out\n");
344 return -ETIMEDOUT;
345 }
346
347 nak_received = readl(dev->base + CS_OFFSET) & CS_ACK_MASK ? 1 : 0;
348
349 if (nak_received ^ nak_expected) {
350 debug("unexpected NAK/ACK\n");
351 return -EREMOTEIO;
352 }
353
354 return 0;
355}
356
357/* Write a single TX FIFO worth of data to the i2c bus */
358static int bcm_kona_i2c_write_fifo_single(struct bcm_kona_i2c_dev *dev,
359 uint8_t *buf, unsigned int len)
360{
361 int k;
362 unsigned long time_left = I2C_TIMEOUT;
363 unsigned int fifo_status;
364
365 /* Write data into FIFO */
366 for (k = 0; k < len; k++)
367 writel(buf[k], (dev->base + DAT_OFFSET));
368
369 /* Wait for FIFO to empty */
370 do {
371 time_left =
372 wait_for_int_timeout(dev, time_left,
373 (IER_FIFO_INT_EN_MASK |
374 IER_NOACK_EN_MASK));
375 fifo_status = readl(dev->base + FIFO_STATUS_OFFSET);
376 } while (time_left && !(fifo_status & FIFO_STATUS_TXFIFO_EMPTY_MASK));
377
378 /* Check if there was a NAK */
379 if (readl(dev->base + CS_OFFSET) & CS_ACK_MASK) {
380 printf("unexpected NAK\n");
381 return -EREMOTEIO;
382 }
383
384 /* Check if a timeout occured */
385 if (!time_left) {
386 printf("completion timed out\n");
387 return -EREMOTEIO;
388 }
389
390 return 0;
391}
392
393/* Write any amount of data using TX FIFO to the i2c bus */
394static int bcm_kona_i2c_write_fifo(struct bcm_kona_i2c_dev *dev,
395 struct i2c_msg *msg)
396{
397 unsigned int bytes_to_write = MAX_TX_FIFO_SIZE;
398 unsigned int bytes_written = 0;
399 int rc;
400
401 uint8_t *tmp_buf = msg->buf;
402
403 while (bytes_written < msg->len) {
404 if (msg->len - bytes_written <= MAX_TX_FIFO_SIZE)
405 bytes_to_write = msg->len - bytes_written;
406
407 rc = bcm_kona_i2c_write_fifo_single(dev, tmp_buf,
408 bytes_to_write);
409 if (rc < 0)
410 return -EREMOTEIO;
411
412 bytes_written += bytes_to_write;
413 tmp_buf += bytes_to_write;
414 }
415
416 return 0;
417}
418
419/* Send i2c address */
420static int bcm_kona_i2c_do_addr(struct bcm_kona_i2c_dev *dev,
421 struct i2c_msg *msg)
422{
423 unsigned char addr;
424
425 if (msg->flags & I2C_M_TEN) {
426 /* First byte is 11110XX0 where XX is upper 2 bits */
427 addr = 0xf0 | ((msg->addr & 0x300) >> 7);
428 if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)
429 return -EREMOTEIO;
430
431 /* Second byte is the remaining 8 bits */
432 addr = msg->addr & 0xff;
433 if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)
434 return -EREMOTEIO;
435
436 if (msg->flags & I2C_M_RD) {
437 /* For read, send restart command */
438 if (bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART) < 0)
439 return -EREMOTEIO;
440
441 /* Then re-send the first byte with the read bit set */
442 addr = 0xf0 | ((msg->addr & 0x300) >> 7) | 0x01;
443 if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)
444 return -EREMOTEIO;
445 }
446 } else {
447 addr = msg->addr << 1;
448
449 if (msg->flags & I2C_M_RD)
450 addr |= 1;
451
452 if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)
453 return -EREMOTEIO;
454 }
455
456 return 0;
457}
458
459static void bcm_kona_i2c_enable_autosense(struct bcm_kona_i2c_dev *dev)
460{
461 writel(readl(dev->base + CLKEN_OFFSET) & ~CLKEN_AUTOSENSE_OFF_MASK,
462 dev->base + CLKEN_OFFSET);
463}
464
465static void bcm_kona_i2c_config_timing(struct bcm_kona_i2c_dev *dev)
466{
467 writel(readl(dev->base + HSTIM_OFFSET) & ~HSTIM_HS_MODE_MASK,
468 dev->base + HSTIM_OFFSET);
469
470 writel((dev->std_cfg->prescale << TIM_PRESCALE_SHIFT) |
471 (dev->std_cfg->time_p << TIM_P_SHIFT) |
472 (dev->std_cfg->no_div << TIM_NO_DIV_SHIFT) |
473 (dev->std_cfg->time_div << TIM_DIV_SHIFT),
474 dev->base + TIM_OFFSET);
475
476 writel((dev->std_cfg->time_m << CLKEN_M_SHIFT) |
477 (dev->std_cfg->time_n << CLKEN_N_SHIFT) |
478 CLKEN_CLKEN_MASK, dev->base + CLKEN_OFFSET);
479}
480
481/* Master transfer function */
482static int bcm_kona_i2c_xfer(struct bcm_kona_i2c_dev *dev,
483 struct i2c_msg msgs[], int num)
484{
485 struct i2c_msg *pmsg;
486 int rc = 0;
487 int i;
488
489 /* Enable pad output */
490 writel(0, dev->base + PADCTL_OFFSET);
491
492 /* Enable internal clocks */
493 bcm_kona_i2c_enable_clock(dev);
494
495 /* Send start command */
496 rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_START);
497 if (rc < 0) {
498 printf("Start command failed rc = %d\n", rc);
499 goto xfer_disable_pad;
500 }
501
502 /* Loop through all messages */
503 for (i = 0; i < num; i++) {
504 pmsg = &msgs[i];
505
506 /* Send restart for subsequent messages */
507 if ((i != 0) && ((pmsg->flags & I2C_M_NOSTART) == 0)) {
508 rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART);
509 if (rc < 0) {
510 printf("restart cmd failed rc = %d\n", rc);
511 goto xfer_send_stop;
512 }
513 }
514
515 /* Send slave address */
516 if (!(pmsg->flags & I2C_M_NOSTART)) {
517 rc = bcm_kona_i2c_do_addr(dev, pmsg);
518 if (rc < 0) {
519 debug("NAK from addr %2.2x msg#%d rc = %d\n",
520 pmsg->addr, i, rc);
521 goto xfer_send_stop;
522 }
523 }
524
525 /* Perform data transfer */
526 if (pmsg->flags & I2C_M_RD) {
527 rc = bcm_kona_i2c_read_fifo(dev, pmsg);
528 if (rc < 0) {
529 printf("read failure\n");
530 goto xfer_send_stop;
531 }
532 } else {
533 rc = bcm_kona_i2c_write_fifo(dev, pmsg);
534 if (rc < 0) {
535 printf("write failure");
536 goto xfer_send_stop;
537 }
538 }
539 }
540
541 rc = num;
542
543xfer_send_stop:
544 /* Send a STOP command */
545 bcm_kona_send_i2c_cmd(dev, BCM_CMD_STOP);
546
547xfer_disable_pad:
548 /* Disable pad output */
549 writel(PADCTL_PAD_OUT_EN_MASK, dev->base + PADCTL_OFFSET);
550
551 /* Stop internal clock */
552 bcm_kona_i2c_disable_clock(dev);
553
554 return rc;
555}
556
557static uint bcm_kona_i2c_assign_bus_speed(struct bcm_kona_i2c_dev *dev,
558 uint speed)
559{
560 switch (speed) {
561 case 100000:
562 dev->std_cfg = &std_cfg_table[BCM_SPD_100K];
563 break;
564 case 400000:
565 dev->std_cfg = &std_cfg_table[BCM_SPD_400K];
566 break;
567 case 1000000:
568 dev->std_cfg = &std_cfg_table[BCM_SPD_1MHZ];
569 break;
570 default:
571 printf("%d hz bus speed not supported\n", speed);
572 return -EINVAL;
573 }
574 dev->speed = speed;
575 return 0;
576}
577
578static void bcm_kona_i2c_init(struct bcm_kona_i2c_dev *dev)
579{
580 /* Parse bus speed */
581 bcm_kona_i2c_assign_bus_speed(dev, dev->speed);
582
583 /* Enable internal clocks */
584 bcm_kona_i2c_enable_clock(dev);
585
586 /* Configure internal dividers */
587 bcm_kona_i2c_config_timing(dev);
588
589 /* Disable timeout */
590 writel(0, dev->base + TOUT_OFFSET);
591
592 /* Enable autosense */
593 bcm_kona_i2c_enable_autosense(dev);
594
595 /* Enable TX FIFO */
596 writel(TXFCR_FIFO_FLUSH_MASK | TXFCR_FIFO_EN_MASK,
597 dev->base + TXFCR_OFFSET);
598
599 /* Mask all interrupts */
600 writel(0, dev->base + IER_OFFSET);
601
602 /* Clear all pending interrupts */
603 writel(ISR_CMDBUSY_MASK |
604 ISR_READ_COMPLETE_MASK |
605 ISR_SES_DONE_MASK |
606 ISR_ERR_MASK |
607 ISR_TXFIFOEMPTY_MASK | ISR_NOACK_MASK, dev->base + ISR_OFFSET);
608
609 /* Enable the controller but leave it idle */
610 bcm_kona_i2c_send_cmd_to_ctrl(dev, BCM_CMD_NOACTION);
611
612 /* Disable pad output */
613 writel(PADCTL_PAD_OUT_EN_MASK, dev->base + PADCTL_OFFSET);
614}
615
616/*
617 * uboot layer
618 */
619struct bcm_kona_i2c_dev *kona_get_dev(struct i2c_adapter *adap)
620{
621 return &g_i2c_devs[adap->hwadapnr];
622}
623
624static void kona_i2c_init(struct i2c_adapter *adap, int speed, int slaveaddr)
625{
626 struct bcm_kona_i2c_dev *dev = kona_get_dev(adap);
627
628 if (clk_bsc_enable(dev->base))
629 return;
630
631 bcm_kona_i2c_init(dev);
632}
633
634static int kona_i2c_read(struct i2c_adapter *adap, uchar chip, uint addr,
635 int alen, uchar *buffer, int len)
636{
637 /* msg[0] writes the addr, msg[1] reads the data */
638 struct i2c_msg msg[2];
639 unsigned char msgbuf0[64];
640 struct bcm_kona_i2c_dev *dev = kona_get_dev(adap);
641
642 msg[0].addr = chip;
643 msg[0].flags = 0;
644 msg[0].len = 1;
645 msg[0].buf = msgbuf0; /* msgbuf0 contains incrementing reg addr */
646
647 msg[1].addr = chip;
648 msg[1].flags = I2C_M_RD;
649 /* msg[1].buf dest ptr increments each read */
650
651 msgbuf0[0] = (unsigned char)addr;
652 msg[1].buf = buffer;
653 msg[1].len = len;
654 if (bcm_kona_i2c_xfer(dev, msg, 2) < 0) {
655 /* Sending 2 i2c messages */
656 kona_i2c_init(adap, adap->speed, adap->slaveaddr);
657 debug("I2C read: I/O error\n");
658 return -EIO;
659 }
660 return 0;
661}
662
663static int kona_i2c_write(struct i2c_adapter *adap, uchar chip, uint addr,
664 int alen, uchar *buffer, int len)
665{
Steve Rae6c2d1422014-05-26 12:33:29 -0700666 struct i2c_msg msg[1];
Darwin Rambo18ca5972014-02-11 11:06:36 -0800667 unsigned char msgbuf0[64];
668 unsigned int i;
669 struct bcm_kona_i2c_dev *dev = kona_get_dev(adap);
670
671 msg[0].addr = chip;
672 msg[0].flags = 0;
673 msg[0].len = 2; /* addr byte plus data */
674 msg[0].buf = msgbuf0;
675
676 for (i = 0; i < len; i++) {
677 msgbuf0[0] = addr++;
678 msgbuf0[1] = buffer[i];
679 if (bcm_kona_i2c_xfer(dev, msg, 1) < 0) {
680 kona_i2c_init(adap, adap->speed, adap->slaveaddr);
681 debug("I2C write: I/O error\n");
682 return -EIO;
683 }
684 }
685 return 0;
686}
687
688static int kona_i2c_probe(struct i2c_adapter *adap, uchar chip)
689{
690 uchar tmp;
691
692 /*
693 * read addr 0x0 of the given chip.
694 */
695 return kona_i2c_read(adap, chip, 0x0, 1, &tmp, 1);
696}
697
698static uint kona_i2c_set_bus_speed(struct i2c_adapter *adap, uint speed)
699{
700 struct bcm_kona_i2c_dev *dev = kona_get_dev(adap);
701 return bcm_kona_i2c_assign_bus_speed(dev, speed);
702}
703
704/*
705 * Register kona i2c adapters. Keep the order below so
706 * that the bus number matches the adapter number.
707 */
708#define DEF_ADAPTER(num) \
709U_BOOT_I2C_ADAP_COMPLETE(kona##num, kona_i2c_init, kona_i2c_probe, \
710 kona_i2c_read, kona_i2c_write, \
711 kona_i2c_set_bus_speed, DEF_SPD, 0x00, num)
712
713#ifdef CONFIG_SYS_I2C_BASE0
714 DEF_ADAPTER(0)
715#endif
716#ifdef CONFIG_SYS_I2C_BASE1
717 DEF_ADAPTER(1)
718#endif
719#ifdef CONFIG_SYS_I2C_BASE2
720 DEF_ADAPTER(2)
721#endif
722#ifdef CONFIG_SYS_I2C_BASE3
723 DEF_ADAPTER(3)
724#endif
725#ifdef CONFIG_SYS_I2C_BASE4
726 DEF_ADAPTER(4)
727#endif
728#ifdef CONFIG_SYS_I2C_BASE5
729 DEF_ADAPTER(5)
730#endif