1 // SPDX-License-Identifier: GPL-2.0-only 2 // Copyright (C) 2013 Broadcom Corporation 3 4 #include <linux/device.h> 5 #include <linux/kernel.h> 6 #include <linux/module.h> 7 #include <linux/sched.h> 8 #include <linux/i2c.h> 9 #include <linux/interrupt.h> 10 #include <linux/platform_device.h> 11 #include <linux/clk.h> 12 #include <linux/io.h> 13 #include <linux/slab.h> 14 15 /* Hardware register offsets and field defintions */ 16 #define CS_OFFSET 0x00000020 17 #define CS_ACK_SHIFT 3 18 #define CS_ACK_MASK 0x00000008 19 #define CS_ACK_CMD_GEN_START 0x00000000 20 #define CS_ACK_CMD_GEN_RESTART 0x00000001 21 #define CS_CMD_SHIFT 1 22 #define CS_CMD_CMD_NO_ACTION 0x00000000 23 #define CS_CMD_CMD_START_RESTART 0x00000001 24 #define CS_CMD_CMD_STOP 0x00000002 25 #define CS_EN_SHIFT 0 26 #define CS_EN_CMD_ENABLE_BSC 0x00000001 27 28 #define TIM_OFFSET 0x00000024 29 #define TIM_PRESCALE_SHIFT 6 30 #define TIM_P_SHIFT 3 31 #define TIM_NO_DIV_SHIFT 2 32 #define TIM_DIV_SHIFT 0 33 34 #define DAT_OFFSET 0x00000028 35 36 #define TOUT_OFFSET 0x0000002c 37 38 #define TXFCR_OFFSET 0x0000003c 39 #define TXFCR_FIFO_FLUSH_MASK 0x00000080 40 #define TXFCR_FIFO_EN_MASK 0x00000040 41 42 #define IER_OFFSET 0x00000044 43 #define IER_READ_COMPLETE_INT_MASK 0x00000010 44 #define IER_I2C_INT_EN_MASK 0x00000008 45 #define IER_FIFO_INT_EN_MASK 0x00000002 46 #define IER_NOACK_EN_MASK 0x00000001 47 48 #define ISR_OFFSET 0x00000048 49 #define ISR_RESERVED_MASK 0xffffff60 50 #define ISR_CMDBUSY_MASK 0x00000080 51 #define ISR_READ_COMPLETE_MASK 0x00000010 52 #define ISR_SES_DONE_MASK 0x00000008 53 #define ISR_ERR_MASK 0x00000004 54 #define ISR_TXFIFOEMPTY_MASK 0x00000002 55 #define ISR_NOACK_MASK 0x00000001 56 57 #define CLKEN_OFFSET 0x0000004C 58 #define CLKEN_AUTOSENSE_OFF_MASK 0x00000080 59 #define CLKEN_M_SHIFT 4 60 #define CLKEN_N_SHIFT 1 61 #define CLKEN_CLKEN_MASK 0x00000001 62 63 #define FIFO_STATUS_OFFSET 0x00000054 64 #define FIFO_STATUS_RXFIFO_EMPTY_MASK 0x00000004 65 #define FIFO_STATUS_TXFIFO_EMPTY_MASK 0x00000010 66 67 #define HSTIM_OFFSET 0x00000058 68 #define HSTIM_HS_MODE_MASK 0x00008000 69 #define HSTIM_HS_HOLD_SHIFT 10 70 #define HSTIM_HS_HIGH_PHASE_SHIFT 5 71 #define HSTIM_HS_SETUP_SHIFT 0 72 73 #define PADCTL_OFFSET 0x0000005c 74 #define PADCTL_PAD_OUT_EN_MASK 0x00000004 75 76 #define RXFCR_OFFSET 0x00000068 77 #define RXFCR_NACK_EN_SHIFT 7 78 #define RXFCR_READ_COUNT_SHIFT 0 79 #define RXFIFORDOUT_OFFSET 0x0000006c 80 81 /* Locally used constants */ 82 #define MAX_RX_FIFO_SIZE 64U /* bytes */ 83 #define MAX_TX_FIFO_SIZE 64U /* bytes */ 84 85 #define STD_EXT_CLK_FREQ 13000000UL 86 #define HS_EXT_CLK_FREQ 104000000UL 87 88 #define MASTERCODE 0x08 /* Mastercodes are 0000_1xxxb */ 89 90 #define I2C_TIMEOUT 100 /* msecs */ 91 92 /* Operations that can be commanded to the controller */ 93 enum bcm_kona_cmd_t { 94 BCM_CMD_NOACTION = 0, 95 BCM_CMD_START, 96 BCM_CMD_RESTART, 97 BCM_CMD_STOP, 98 }; 99 100 enum bus_speed_index { 101 BCM_SPD_100K = 0, 102 BCM_SPD_400K, 103 BCM_SPD_1MHZ, 104 }; 105 106 enum hs_bus_speed_index { 107 BCM_SPD_3P4MHZ = 0, 108 }; 109 110 /* Internal divider settings for standard mode, fast mode and fast mode plus */ 111 struct bus_speed_cfg { 112 uint8_t time_m; /* Number of cycles for setup time */ 113 uint8_t time_n; /* Number of cycles for hold time */ 114 uint8_t prescale; /* Prescale divider */ 115 uint8_t time_p; /* Timing coefficient */ 116 uint8_t no_div; /* Disable clock divider */ 117 uint8_t time_div; /* Post-prescale divider */ 118 }; 119 120 /* Internal divider settings for high-speed mode */ 121 struct hs_bus_speed_cfg { 122 uint8_t hs_hold; /* Number of clock cycles SCL stays low until 123 the end of bit period */ 124 uint8_t hs_high_phase; /* Number of clock cycles SCL stays high 125 before it falls */ 126 uint8_t hs_setup; /* Number of clock cycles SCL stays low 127 before it rises */ 128 uint8_t prescale; /* Prescale divider */ 129 uint8_t time_p; /* Timing coefficient */ 130 uint8_t no_div; /* Disable clock divider */ 131 uint8_t time_div; /* Post-prescale divider */ 132 }; 133 134 static const struct bus_speed_cfg std_cfg_table[] = { 135 [BCM_SPD_100K] = {0x01, 0x01, 0x03, 0x06, 0x00, 0x02}, 136 [BCM_SPD_400K] = {0x05, 0x01, 0x03, 0x05, 0x01, 0x02}, 137 [BCM_SPD_1MHZ] = {0x01, 0x01, 0x03, 0x01, 0x01, 0x03}, 138 }; 139 140 static const struct hs_bus_speed_cfg hs_cfg_table[] = { 141 [BCM_SPD_3P4MHZ] = {0x01, 0x08, 0x14, 0x00, 0x06, 0x01, 0x00}, 142 }; 143 144 struct bcm_kona_i2c_dev { 145 struct device *device; 146 147 void __iomem *base; 148 int irq; 149 struct clk *external_clk; 150 151 struct i2c_adapter adapter; 152 153 struct completion done; 154 155 const struct bus_speed_cfg *std_cfg; 156 const struct hs_bus_speed_cfg *hs_cfg; 157 }; 158 159 static void bcm_kona_i2c_send_cmd_to_ctrl(struct bcm_kona_i2c_dev *dev, 160 enum bcm_kona_cmd_t cmd) 161 { 162 dev_dbg(dev->device, "%s, %d\n", __func__, cmd); 163 164 switch (cmd) { 165 case BCM_CMD_NOACTION: 166 writel((CS_CMD_CMD_NO_ACTION << CS_CMD_SHIFT) | 167 (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT), 168 dev->base + CS_OFFSET); 169 break; 170 171 case BCM_CMD_START: 172 writel((CS_ACK_CMD_GEN_START << CS_ACK_SHIFT) | 173 (CS_CMD_CMD_START_RESTART << CS_CMD_SHIFT) | 174 (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT), 175 dev->base + CS_OFFSET); 176 break; 177 178 case BCM_CMD_RESTART: 179 writel((CS_ACK_CMD_GEN_RESTART << 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_STOP: 186 writel((CS_CMD_CMD_STOP << CS_CMD_SHIFT) | 187 (CS_EN_CMD_ENABLE_BSC << CS_EN_SHIFT), 188 dev->base + CS_OFFSET); 189 break; 190 191 default: 192 dev_err(dev->device, "Unknown command %d\n", cmd); 193 } 194 } 195 196 static void bcm_kona_i2c_enable_clock(struct bcm_kona_i2c_dev *dev) 197 { 198 writel(readl(dev->base + CLKEN_OFFSET) | CLKEN_CLKEN_MASK, 199 dev->base + CLKEN_OFFSET); 200 } 201 202 static void bcm_kona_i2c_disable_clock(struct bcm_kona_i2c_dev *dev) 203 { 204 writel(readl(dev->base + CLKEN_OFFSET) & ~CLKEN_CLKEN_MASK, 205 dev->base + CLKEN_OFFSET); 206 } 207 208 static irqreturn_t bcm_kona_i2c_isr(int irq, void *devid) 209 { 210 struct bcm_kona_i2c_dev *dev = devid; 211 uint32_t status = readl(dev->base + ISR_OFFSET); 212 213 if ((status & ~ISR_RESERVED_MASK) == 0) 214 return IRQ_NONE; 215 216 /* Must flush the TX FIFO when NAK detected */ 217 if (status & ISR_NOACK_MASK) 218 writel(TXFCR_FIFO_FLUSH_MASK | TXFCR_FIFO_EN_MASK, 219 dev->base + TXFCR_OFFSET); 220 221 writel(status & ~ISR_RESERVED_MASK, dev->base + ISR_OFFSET); 222 complete(&dev->done); 223 224 return IRQ_HANDLED; 225 } 226 227 /* Wait for ISR_CMDBUSY_MASK to go low before writing to CS, DAT, or RCD */ 228 static int bcm_kona_i2c_wait_if_busy(struct bcm_kona_i2c_dev *dev) 229 { 230 unsigned long timeout = jiffies + msecs_to_jiffies(I2C_TIMEOUT); 231 232 while (readl(dev->base + ISR_OFFSET) & ISR_CMDBUSY_MASK) 233 if (time_after(jiffies, timeout)) { 234 dev_err(dev->device, "CMDBUSY timeout\n"); 235 return -ETIMEDOUT; 236 } 237 238 return 0; 239 } 240 241 /* Send command to I2C bus */ 242 static int bcm_kona_send_i2c_cmd(struct bcm_kona_i2c_dev *dev, 243 enum bcm_kona_cmd_t cmd) 244 { 245 int rc; 246 unsigned long time_left = msecs_to_jiffies(I2C_TIMEOUT); 247 248 /* Make sure the hardware is ready */ 249 rc = bcm_kona_i2c_wait_if_busy(dev); 250 if (rc < 0) 251 return rc; 252 253 /* Unmask the session done interrupt */ 254 writel(IER_I2C_INT_EN_MASK, dev->base + IER_OFFSET); 255 256 /* Mark as incomplete before sending the command */ 257 reinit_completion(&dev->done); 258 259 /* Send the command */ 260 bcm_kona_i2c_send_cmd_to_ctrl(dev, cmd); 261 262 /* Wait for transaction to finish or timeout */ 263 time_left = wait_for_completion_timeout(&dev->done, time_left); 264 265 /* Mask all interrupts */ 266 writel(0, dev->base + IER_OFFSET); 267 268 if (!time_left) { 269 dev_err(dev->device, "controller timed out\n"); 270 rc = -ETIMEDOUT; 271 } 272 273 /* Clear command */ 274 bcm_kona_i2c_send_cmd_to_ctrl(dev, BCM_CMD_NOACTION); 275 276 return rc; 277 } 278 279 /* Read a single RX FIFO worth of data from the i2c bus */ 280 static int bcm_kona_i2c_read_fifo_single(struct bcm_kona_i2c_dev *dev, 281 uint8_t *buf, unsigned int len, 282 unsigned int last_byte_nak) 283 { 284 unsigned long time_left = msecs_to_jiffies(I2C_TIMEOUT); 285 286 /* Mark as incomplete before starting the RX FIFO */ 287 reinit_completion(&dev->done); 288 289 /* Unmask the read complete interrupt */ 290 writel(IER_READ_COMPLETE_INT_MASK, dev->base + IER_OFFSET); 291 292 /* Start the RX FIFO */ 293 writel((last_byte_nak << RXFCR_NACK_EN_SHIFT) | 294 (len << RXFCR_READ_COUNT_SHIFT), 295 dev->base + RXFCR_OFFSET); 296 297 /* Wait for FIFO read to complete */ 298 time_left = wait_for_completion_timeout(&dev->done, time_left); 299 300 /* Mask all interrupts */ 301 writel(0, dev->base + IER_OFFSET); 302 303 if (!time_left) { 304 dev_err(dev->device, "RX FIFO time out\n"); 305 return -EREMOTEIO; 306 } 307 308 /* Read data from FIFO */ 309 for (; len > 0; len--, buf++) 310 *buf = readl(dev->base + RXFIFORDOUT_OFFSET); 311 312 return 0; 313 } 314 315 /* Read any amount of data using the RX FIFO from the i2c bus */ 316 static int bcm_kona_i2c_read_fifo(struct bcm_kona_i2c_dev *dev, 317 struct i2c_msg *msg) 318 { 319 unsigned int bytes_to_read = MAX_RX_FIFO_SIZE; 320 unsigned int last_byte_nak = 0; 321 unsigned int bytes_read = 0; 322 int rc; 323 324 uint8_t *tmp_buf = msg->buf; 325 326 while (bytes_read < msg->len) { 327 if (msg->len - bytes_read <= MAX_RX_FIFO_SIZE) { 328 last_byte_nak = 1; /* NAK last byte of transfer */ 329 bytes_to_read = msg->len - bytes_read; 330 } 331 332 rc = bcm_kona_i2c_read_fifo_single(dev, tmp_buf, bytes_to_read, 333 last_byte_nak); 334 if (rc < 0) 335 return -EREMOTEIO; 336 337 bytes_read += bytes_to_read; 338 tmp_buf += bytes_to_read; 339 } 340 341 return 0; 342 } 343 344 /* Write a single byte of data to the i2c bus */ 345 static int bcm_kona_i2c_write_byte(struct bcm_kona_i2c_dev *dev, uint8_t data, 346 unsigned int nak_expected) 347 { 348 int rc; 349 unsigned long time_left = msecs_to_jiffies(I2C_TIMEOUT); 350 unsigned int nak_received; 351 352 /* Make sure the hardware is ready */ 353 rc = bcm_kona_i2c_wait_if_busy(dev); 354 if (rc < 0) 355 return rc; 356 357 /* Clear pending session done interrupt */ 358 writel(ISR_SES_DONE_MASK, dev->base + ISR_OFFSET); 359 360 /* Unmask the session done interrupt */ 361 writel(IER_I2C_INT_EN_MASK, dev->base + IER_OFFSET); 362 363 /* Mark as incomplete before sending the data */ 364 reinit_completion(&dev->done); 365 366 /* Send one byte of data */ 367 writel(data, dev->base + DAT_OFFSET); 368 369 /* Wait for byte to be written */ 370 time_left = wait_for_completion_timeout(&dev->done, time_left); 371 372 /* Mask all interrupts */ 373 writel(0, dev->base + IER_OFFSET); 374 375 if (!time_left) { 376 dev_dbg(dev->device, "controller timed out\n"); 377 return -ETIMEDOUT; 378 } 379 380 nak_received = readl(dev->base + CS_OFFSET) & CS_ACK_MASK ? 1 : 0; 381 382 if (nak_received ^ nak_expected) { 383 dev_dbg(dev->device, "unexpected NAK/ACK\n"); 384 return -EREMOTEIO; 385 } 386 387 return 0; 388 } 389 390 /* Write a single TX FIFO worth of data to the i2c bus */ 391 static int bcm_kona_i2c_write_fifo_single(struct bcm_kona_i2c_dev *dev, 392 uint8_t *buf, unsigned int len) 393 { 394 int k; 395 unsigned long time_left = msecs_to_jiffies(I2C_TIMEOUT); 396 unsigned int fifo_status; 397 398 /* Mark as incomplete before sending data to the TX FIFO */ 399 reinit_completion(&dev->done); 400 401 /* Unmask the fifo empty and nak interrupt */ 402 writel(IER_FIFO_INT_EN_MASK | IER_NOACK_EN_MASK, 403 dev->base + IER_OFFSET); 404 405 /* Disable IRQ to load a FIFO worth of data without interruption */ 406 disable_irq(dev->irq); 407 408 /* Write data into FIFO */ 409 for (k = 0; k < len; k++) 410 writel(buf[k], (dev->base + DAT_OFFSET)); 411 412 /* Enable IRQ now that data has been loaded */ 413 enable_irq(dev->irq); 414 415 /* Wait for FIFO to empty */ 416 do { 417 time_left = wait_for_completion_timeout(&dev->done, time_left); 418 fifo_status = readl(dev->base + FIFO_STATUS_OFFSET); 419 } while (time_left && !(fifo_status & FIFO_STATUS_TXFIFO_EMPTY_MASK)); 420 421 /* Mask all interrupts */ 422 writel(0, dev->base + IER_OFFSET); 423 424 /* Check if there was a NAK */ 425 if (readl(dev->base + CS_OFFSET) & CS_ACK_MASK) { 426 dev_err(dev->device, "unexpected NAK\n"); 427 return -EREMOTEIO; 428 } 429 430 /* Check if a timeout occured */ 431 if (!time_left) { 432 dev_err(dev->device, "completion timed out\n"); 433 return -EREMOTEIO; 434 } 435 436 return 0; 437 } 438 439 440 /* Write any amount of data using TX FIFO to the i2c bus */ 441 static int bcm_kona_i2c_write_fifo(struct bcm_kona_i2c_dev *dev, 442 struct i2c_msg *msg) 443 { 444 unsigned int bytes_to_write = MAX_TX_FIFO_SIZE; 445 unsigned int bytes_written = 0; 446 int rc; 447 448 uint8_t *tmp_buf = msg->buf; 449 450 while (bytes_written < msg->len) { 451 if (msg->len - bytes_written <= MAX_TX_FIFO_SIZE) 452 bytes_to_write = msg->len - bytes_written; 453 454 rc = bcm_kona_i2c_write_fifo_single(dev, tmp_buf, 455 bytes_to_write); 456 if (rc < 0) 457 return -EREMOTEIO; 458 459 bytes_written += bytes_to_write; 460 tmp_buf += bytes_to_write; 461 } 462 463 return 0; 464 } 465 466 /* Send i2c address */ 467 static int bcm_kona_i2c_do_addr(struct bcm_kona_i2c_dev *dev, 468 struct i2c_msg *msg) 469 { 470 unsigned char addr; 471 472 if (msg->flags & I2C_M_TEN) { 473 /* First byte is 11110XX0 where XX is upper 2 bits */ 474 addr = 0xF0 | ((msg->addr & 0x300) >> 7); 475 if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0) 476 return -EREMOTEIO; 477 478 /* Second byte is the remaining 8 bits */ 479 addr = msg->addr & 0xFF; 480 if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0) 481 return -EREMOTEIO; 482 483 if (msg->flags & I2C_M_RD) { 484 /* For read, send restart command */ 485 if (bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART) < 0) 486 return -EREMOTEIO; 487 488 /* Then re-send the first byte with the read bit set */ 489 addr = 0xF0 | ((msg->addr & 0x300) >> 7) | 0x01; 490 if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0) 491 return -EREMOTEIO; 492 } 493 } else { 494 addr = i2c_8bit_addr_from_msg(msg); 495 496 if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0) 497 return -EREMOTEIO; 498 } 499 500 return 0; 501 } 502 503 static void bcm_kona_i2c_enable_autosense(struct bcm_kona_i2c_dev *dev) 504 { 505 writel(readl(dev->base + CLKEN_OFFSET) & ~CLKEN_AUTOSENSE_OFF_MASK, 506 dev->base + CLKEN_OFFSET); 507 } 508 509 static void bcm_kona_i2c_config_timing(struct bcm_kona_i2c_dev *dev) 510 { 511 writel(readl(dev->base + HSTIM_OFFSET) & ~HSTIM_HS_MODE_MASK, 512 dev->base + HSTIM_OFFSET); 513 514 writel((dev->std_cfg->prescale << TIM_PRESCALE_SHIFT) | 515 (dev->std_cfg->time_p << TIM_P_SHIFT) | 516 (dev->std_cfg->no_div << TIM_NO_DIV_SHIFT) | 517 (dev->std_cfg->time_div << TIM_DIV_SHIFT), 518 dev->base + TIM_OFFSET); 519 520 writel((dev->std_cfg->time_m << CLKEN_M_SHIFT) | 521 (dev->std_cfg->time_n << CLKEN_N_SHIFT) | 522 CLKEN_CLKEN_MASK, 523 dev->base + CLKEN_OFFSET); 524 } 525 526 static void bcm_kona_i2c_config_timing_hs(struct bcm_kona_i2c_dev *dev) 527 { 528 writel((dev->hs_cfg->prescale << TIM_PRESCALE_SHIFT) | 529 (dev->hs_cfg->time_p << TIM_P_SHIFT) | 530 (dev->hs_cfg->no_div << TIM_NO_DIV_SHIFT) | 531 (dev->hs_cfg->time_div << TIM_DIV_SHIFT), 532 dev->base + TIM_OFFSET); 533 534 writel((dev->hs_cfg->hs_hold << HSTIM_HS_HOLD_SHIFT) | 535 (dev->hs_cfg->hs_high_phase << HSTIM_HS_HIGH_PHASE_SHIFT) | 536 (dev->hs_cfg->hs_setup << HSTIM_HS_SETUP_SHIFT), 537 dev->base + HSTIM_OFFSET); 538 539 writel(readl(dev->base + HSTIM_OFFSET) | HSTIM_HS_MODE_MASK, 540 dev->base + HSTIM_OFFSET); 541 } 542 543 static int bcm_kona_i2c_switch_to_hs(struct bcm_kona_i2c_dev *dev) 544 { 545 int rc; 546 547 /* Send mastercode at standard speed */ 548 rc = bcm_kona_i2c_write_byte(dev, MASTERCODE, 1); 549 if (rc < 0) { 550 pr_err("High speed handshake failed\n"); 551 return rc; 552 } 553 554 /* Configure external clock to higher frequency */ 555 rc = clk_set_rate(dev->external_clk, HS_EXT_CLK_FREQ); 556 if (rc) { 557 dev_err(dev->device, "%s: clk_set_rate returned %d\n", 558 __func__, rc); 559 return rc; 560 } 561 562 /* Reconfigure internal dividers */ 563 bcm_kona_i2c_config_timing_hs(dev); 564 565 /* Send a restart command */ 566 rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART); 567 if (rc < 0) 568 dev_err(dev->device, "High speed restart command failed\n"); 569 570 return rc; 571 } 572 573 static int bcm_kona_i2c_switch_to_std(struct bcm_kona_i2c_dev *dev) 574 { 575 int rc; 576 577 /* Reconfigure internal dividers */ 578 bcm_kona_i2c_config_timing(dev); 579 580 /* Configure external clock to lower frequency */ 581 rc = clk_set_rate(dev->external_clk, STD_EXT_CLK_FREQ); 582 if (rc) { 583 dev_err(dev->device, "%s: clk_set_rate returned %d\n", 584 __func__, rc); 585 } 586 587 return rc; 588 } 589 590 /* Master transfer function */ 591 static int bcm_kona_i2c_xfer(struct i2c_adapter *adapter, 592 struct i2c_msg msgs[], int num) 593 { 594 struct bcm_kona_i2c_dev *dev = i2c_get_adapdata(adapter); 595 struct i2c_msg *pmsg; 596 int rc = 0; 597 int i; 598 599 rc = clk_prepare_enable(dev->external_clk); 600 if (rc) { 601 dev_err(dev->device, "%s: peri clock enable failed. err %d\n", 602 __func__, rc); 603 return rc; 604 } 605 606 /* Enable pad output */ 607 writel(0, dev->base + PADCTL_OFFSET); 608 609 /* Enable internal clocks */ 610 bcm_kona_i2c_enable_clock(dev); 611 612 /* Send start command */ 613 rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_START); 614 if (rc < 0) { 615 dev_err(dev->device, "Start command failed rc = %d\n", rc); 616 goto xfer_disable_pad; 617 } 618 619 /* Switch to high speed if applicable */ 620 if (dev->hs_cfg) { 621 rc = bcm_kona_i2c_switch_to_hs(dev); 622 if (rc < 0) 623 goto xfer_send_stop; 624 } 625 626 /* Loop through all messages */ 627 for (i = 0; i < num; i++) { 628 pmsg = &msgs[i]; 629 630 /* Send restart for subsequent messages */ 631 if ((i != 0) && ((pmsg->flags & I2C_M_NOSTART) == 0)) { 632 rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART); 633 if (rc < 0) { 634 dev_err(dev->device, 635 "restart cmd failed rc = %d\n", rc); 636 goto xfer_send_stop; 637 } 638 } 639 640 /* Send slave address */ 641 if (!(pmsg->flags & I2C_M_NOSTART)) { 642 rc = bcm_kona_i2c_do_addr(dev, pmsg); 643 if (rc < 0) { 644 dev_err(dev->device, 645 "NAK from addr %2.2x msg#%d rc = %d\n", 646 pmsg->addr, i, rc); 647 goto xfer_send_stop; 648 } 649 } 650 651 /* Perform data transfer */ 652 if (pmsg->flags & I2C_M_RD) { 653 rc = bcm_kona_i2c_read_fifo(dev, pmsg); 654 if (rc < 0) { 655 dev_err(dev->device, "read failure\n"); 656 goto xfer_send_stop; 657 } 658 } else { 659 rc = bcm_kona_i2c_write_fifo(dev, pmsg); 660 if (rc < 0) { 661 dev_err(dev->device, "write failure"); 662 goto xfer_send_stop; 663 } 664 } 665 } 666 667 rc = num; 668 669 xfer_send_stop: 670 /* Send a STOP command */ 671 bcm_kona_send_i2c_cmd(dev, BCM_CMD_STOP); 672 673 /* Return from high speed if applicable */ 674 if (dev->hs_cfg) { 675 int hs_rc = bcm_kona_i2c_switch_to_std(dev); 676 677 if (hs_rc) 678 rc = hs_rc; 679 } 680 681 xfer_disable_pad: 682 /* Disable pad output */ 683 writel(PADCTL_PAD_OUT_EN_MASK, dev->base + PADCTL_OFFSET); 684 685 /* Stop internal clock */ 686 bcm_kona_i2c_disable_clock(dev); 687 688 clk_disable_unprepare(dev->external_clk); 689 690 return rc; 691 } 692 693 static uint32_t bcm_kona_i2c_functionality(struct i2c_adapter *adap) 694 { 695 return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL | I2C_FUNC_10BIT_ADDR | 696 I2C_FUNC_NOSTART; 697 } 698 699 static const struct i2c_algorithm bcm_algo = { 700 .master_xfer = bcm_kona_i2c_xfer, 701 .functionality = bcm_kona_i2c_functionality, 702 }; 703 704 static int bcm_kona_i2c_assign_bus_speed(struct bcm_kona_i2c_dev *dev) 705 { 706 unsigned int bus_speed; 707 int ret = of_property_read_u32(dev->device->of_node, "clock-frequency", 708 &bus_speed); 709 if (ret < 0) { 710 dev_err(dev->device, "missing clock-frequency property\n"); 711 return -ENODEV; 712 } 713 714 switch (bus_speed) { 715 case I2C_MAX_STANDARD_MODE_FREQ: 716 dev->std_cfg = &std_cfg_table[BCM_SPD_100K]; 717 break; 718 case I2C_MAX_FAST_MODE_FREQ: 719 dev->std_cfg = &std_cfg_table[BCM_SPD_400K]; 720 break; 721 case I2C_MAX_FAST_MODE_PLUS_FREQ: 722 dev->std_cfg = &std_cfg_table[BCM_SPD_1MHZ]; 723 break; 724 case I2C_MAX_HIGH_SPEED_MODE_FREQ: 725 /* Send mastercode at 100k */ 726 dev->std_cfg = &std_cfg_table[BCM_SPD_100K]; 727 dev->hs_cfg = &hs_cfg_table[BCM_SPD_3P4MHZ]; 728 break; 729 default: 730 pr_err("%d hz bus speed not supported\n", bus_speed); 731 pr_err("Valid speeds are 100khz, 400khz, 1mhz, and 3.4mhz\n"); 732 return -EINVAL; 733 } 734 735 return 0; 736 } 737 738 static int bcm_kona_i2c_probe(struct platform_device *pdev) 739 { 740 int rc = 0; 741 struct bcm_kona_i2c_dev *dev; 742 struct i2c_adapter *adap; 743 744 /* Allocate memory for private data structure */ 745 dev = devm_kzalloc(&pdev->dev, sizeof(*dev), GFP_KERNEL); 746 if (!dev) 747 return -ENOMEM; 748 749 platform_set_drvdata(pdev, dev); 750 dev->device = &pdev->dev; 751 init_completion(&dev->done); 752 753 /* Map hardware registers */ 754 dev->base = devm_platform_ioremap_resource(pdev, 0); 755 if (IS_ERR(dev->base)) 756 return PTR_ERR(dev->base); 757 758 /* Get and enable external clock */ 759 dev->external_clk = devm_clk_get(dev->device, NULL); 760 if (IS_ERR(dev->external_clk)) { 761 dev_err(dev->device, "couldn't get clock\n"); 762 return -ENODEV; 763 } 764 765 rc = clk_set_rate(dev->external_clk, STD_EXT_CLK_FREQ); 766 if (rc) { 767 dev_err(dev->device, "%s: clk_set_rate returned %d\n", 768 __func__, rc); 769 return rc; 770 } 771 772 rc = clk_prepare_enable(dev->external_clk); 773 if (rc) { 774 dev_err(dev->device, "couldn't enable clock\n"); 775 return rc; 776 } 777 778 /* Parse bus speed */ 779 rc = bcm_kona_i2c_assign_bus_speed(dev); 780 if (rc) 781 goto probe_disable_clk; 782 783 /* Enable internal clocks */ 784 bcm_kona_i2c_enable_clock(dev); 785 786 /* Configure internal dividers */ 787 bcm_kona_i2c_config_timing(dev); 788 789 /* Disable timeout */ 790 writel(0, dev->base + TOUT_OFFSET); 791 792 /* Enable autosense */ 793 bcm_kona_i2c_enable_autosense(dev); 794 795 /* Enable TX FIFO */ 796 writel(TXFCR_FIFO_FLUSH_MASK | TXFCR_FIFO_EN_MASK, 797 dev->base + TXFCR_OFFSET); 798 799 /* Mask all interrupts */ 800 writel(0, dev->base + IER_OFFSET); 801 802 /* Clear all pending interrupts */ 803 writel(ISR_CMDBUSY_MASK | 804 ISR_READ_COMPLETE_MASK | 805 ISR_SES_DONE_MASK | 806 ISR_ERR_MASK | 807 ISR_TXFIFOEMPTY_MASK | 808 ISR_NOACK_MASK, 809 dev->base + ISR_OFFSET); 810 811 /* Get the interrupt number */ 812 dev->irq = platform_get_irq(pdev, 0); 813 if (dev->irq < 0) { 814 rc = dev->irq; 815 goto probe_disable_clk; 816 } 817 818 /* register the ISR handler */ 819 rc = devm_request_irq(&pdev->dev, dev->irq, bcm_kona_i2c_isr, 820 IRQF_SHARED, pdev->name, dev); 821 if (rc) { 822 dev_err(dev->device, "failed to request irq %i\n", dev->irq); 823 goto probe_disable_clk; 824 } 825 826 /* Enable the controller but leave it idle */ 827 bcm_kona_i2c_send_cmd_to_ctrl(dev, BCM_CMD_NOACTION); 828 829 /* Disable pad output */ 830 writel(PADCTL_PAD_OUT_EN_MASK, dev->base + PADCTL_OFFSET); 831 832 /* Disable internal clock */ 833 bcm_kona_i2c_disable_clock(dev); 834 835 /* Disable external clock */ 836 clk_disable_unprepare(dev->external_clk); 837 838 /* Add the i2c adapter */ 839 adap = &dev->adapter; 840 i2c_set_adapdata(adap, dev); 841 adap->owner = THIS_MODULE; 842 strscpy(adap->name, "Broadcom I2C adapter", sizeof(adap->name)); 843 adap->algo = &bcm_algo; 844 adap->dev.parent = &pdev->dev; 845 adap->dev.of_node = pdev->dev.of_node; 846 847 rc = i2c_add_adapter(adap); 848 if (rc) 849 return rc; 850 851 dev_info(dev->device, "device registered successfully\n"); 852 853 return 0; 854 855 probe_disable_clk: 856 bcm_kona_i2c_disable_clock(dev); 857 clk_disable_unprepare(dev->external_clk); 858 859 return rc; 860 } 861 862 static int bcm_kona_i2c_remove(struct platform_device *pdev) 863 { 864 struct bcm_kona_i2c_dev *dev = platform_get_drvdata(pdev); 865 866 i2c_del_adapter(&dev->adapter); 867 868 return 0; 869 } 870 871 static const struct of_device_id bcm_kona_i2c_of_match[] = { 872 {.compatible = "brcm,kona-i2c",}, 873 {}, 874 }; 875 MODULE_DEVICE_TABLE(of, bcm_kona_i2c_of_match); 876 877 static struct platform_driver bcm_kona_i2c_driver = { 878 .driver = { 879 .name = "bcm-kona-i2c", 880 .of_match_table = bcm_kona_i2c_of_match, 881 }, 882 .probe = bcm_kona_i2c_probe, 883 .remove = bcm_kona_i2c_remove, 884 }; 885 module_platform_driver(bcm_kona_i2c_driver); 886 887 MODULE_AUTHOR("Tim Kryger <tkryger@broadcom.com>"); 888 MODULE_DESCRIPTION("Broadcom Kona I2C Driver"); 889 MODULE_LICENSE("GPL v2"); 890