1 /* 2 * Copyright (C) 2017, 2018 Paul Boddie <paul@boddie.org.uk> 3 * 4 * This program is free software; you can redistribute it and/or 5 * modify it under the terms of the GNU General Public License as 6 * published by the Free Software Foundation; either version 2 of 7 * the License, or (at your option) any later version. 8 * 9 * This program is distributed in the hope that it will be useful, 10 * but WITHOUT ANY WARRANTY; without even the implied warranty of 11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 12 * GNU General Public License for more details. 13 * 14 * You should have received a copy of the GNU General Public License 15 * along with this program; if not, write to the Free Software 16 * Foundation, Inc., 51 Franklin Street, Fifth Floor, 17 * Boston, MA 02110-1301, USA 18 */ 19 20 #include <l4/devices/i2c-jz4780.h> 21 #include <l4/devices/hw_mmio_register_block.h> 22 23 #include <l4/sys/icu.h> 24 #include <l4/util/util.h> 25 #include <sys/time.h> 26 27 #include <cstdio> 28 29 /* 30 I2C pins: 31 32 I2C0: PD30/SMB0_SDA, PD31/SMB0_SCK 33 I2C1: PD30/SMB1_SDA, PD31/SMB1_SCK (pulled up on CI20) 34 I2C2: PF16/SMB2_SDA, PF17/SMB2_SCK 35 PWM: PD10/SMB3_SDA, PD11/SMB3_SCK 36 PWM: PE3/SMB4_SDA, PE4/SMB4_SCK 37 I2C4: PE12/SMB4_SDA, PE13/SMB4_SCK 38 HDMI: PF25/SMB4_SDA/DDCSDA, PF24/SMB4_SCK/DDCSCK 39 40 See: http://mipscreator.imgtec.com/CI20/hardware/board/ci20_jz4780_v2.0.pdf 41 */ 42 43 enum Regs 44 { 45 Smb_control = 0x000, // SMBCON 46 Smb_target_address = 0x004, // SMBTAR 47 Smb_slave_address = 0x008, // SMBSAR 48 Smb_data_command = 0x010, // SMBDC 49 Std_high_count = 0x014, // SMBSHCNT 50 Std_low_count = 0x018, // SMBSLCNT 51 Fast_high_count = 0x01c, // SMBFHCNT 52 Fast_low_count = 0x020, // SMBFLCNT 53 Int_status = 0x02c, // SMBINTST (read-only) 54 Int_mask = 0x030, // SMBINTM 55 56 Rx_fifo_thold = 0x038, // SMBRXTL 57 Tx_fifo_thold = 0x03c, // SMBTXTL 58 Int_combined_clear = 0x040, // SMBCINT (read-only) 59 Int_rx_uf_clear = 0x044, // SMBCRXUF (read-only) 60 Int_rx_of_clear = 0x048, // SMBCRXOF (read-only) 61 Int_tx_of_clear = 0x04c, // SMBCTXOF (read-only) 62 Int_rd_req_clear = 0x050, // SMBCRXREQ (read-only) 63 Int_tx_abort_clear = 0x054, // SMBCTXABT (read-only) 64 Int_rx_done_clear = 0x058, // SMBCRXDN (read-only) 65 Int_activity_clear = 0x05c, // SMBCACT (read-only) 66 Int_stop_clear = 0x060, // SMBCSTP (read-only) 67 Int_start_clear = 0x064, // SMBCSTT (read-only) 68 Int_call_clear = 0x068, // SMBCGC (read-only) 69 Smb_enable = 0x06c, // SMBENB 70 Smb_status = 0x070, // SMBST (read-only) 71 72 Tx_fifo_count = 0x074, // SMBTXFLR (read-only) 73 Rx_fifo_count = 0x078, // SMBRXFLR (read-only) 74 75 Trans_abort_status0 = 0x080, // SMBABTSRC (read-only) 76 Trans_abort_status1 = 0x084, // ... (read-only) 77 78 Smb_dma_ctrl = 0x088, // SMBDMACR 79 Smb_trans_data_lvl = 0x08c, // SMBDMATDLR 80 Smb_recv_data_lvl = 0x090, // SMBDMARDLR 81 Smb_sda_setup_time = 0x094, // SMBSDASU 82 Smb_ack_call = 0x098, // SMBACKGC 83 84 Smb_enable_status = 0x09c, // SMBENBST (read-only) 85 Smb_sda_hold_time = 0x0d0, // SMBSDAHD 86 87 Smb_block_offset = 0x1000 88 }; 89 90 enum Smb_control_bits : unsigned 91 { 92 Smb_no_stop_empty = 0x80, // STPHLD (no STP condition when queue empty) 93 Smb_disable_slave = 0x40, // SLVDIS (slave disabled) 94 Smb_enable_restart = 0x20, // REST 95 Smb_enable_master = 0x01, // MD (master enabled) 96 Smb_speed_bit = 1, // SPD 97 }; 98 99 enum Smb_enable_bits : unsigned 100 { 101 Smb_enable_enabled = 0x01, // SMBEN 102 }; 103 104 enum Smb_status_bits : unsigned 105 { 106 Smb_status_master_act = 0x20, // MSTACT (master active) 107 Smb_status_rx_nempty = 0x08, // RFNE (read queue not empty) 108 Smb_status_tx_empty = 0x04, // TFE (write queue empty) 109 Smb_status_tx_nfull = 0x02, // TFNF (write queue not full) 110 Smb_status_active = 0x01, // ACT (device active as master or slave) 111 }; 112 113 enum Smb_target_bits : unsigned 114 { 115 Smb_target_7bits = 0x7f, 116 }; 117 118 enum Smb_hold_control_bits : unsigned 119 { 120 Smb_hold_enable = 0x100, // HDENB 121 Smb_hold_disable = 0x000, // HDENB 122 Smb_hold_mask = 0x1ff, 123 }; 124 125 enum Smb_setup_control_bits : unsigned 126 { 127 Smb_setup_mask = 0x0ff, 128 }; 129 130 enum Smb_command_bits : unsigned 131 { 132 Smb_command_read = 0x100, // CMD 133 Smb_command_write = 0x000, // CMD 134 }; 135 136 enum Smb_fifo_bits : unsigned 137 { 138 Smb_fifo_limit = 16, 139 }; 140 141 enum Int_bits : unsigned 142 { 143 Int_call = 0x800, // IGC (general call received) 144 Int_start = 0x400, // ISTT (start/restart condition occurred) 145 Int_stop = 0x200, // ISTP (stop condition occurred) 146 Int_activity = 0x100, // IACT (bus activity interrupt) 147 Int_rx_done = 0x080, // RXDN (read from master device done) 148 Int_tx_abort = 0x040, // TXABT (transmit abort) 149 Int_rd_req = 0x020, // RDREQ (read request from master device) 150 Int_tx_empty = 0x010, // TXEMP (threshold reached or passed) 151 Int_tx_of = 0x008, // TXOF (overflow when writing to queue) 152 Int_rx_full = 0x004, // RXFL (threshold reached or exceeded) 153 Int_rx_of = 0x002, // RXOF (overflow from device) 154 Int_rx_uf = 0x001, // RXUF (underflow when reading from queue) 155 }; 156 157 158 159 // Initialise a channel. 160 161 I2c_jz4780_channel::I2c_jz4780_channel(l4_addr_t start, 162 Cpm_jz4780_chip *cpm, 163 uint32_t frequency) 164 : _cpm(cpm), _frequency(frequency) 165 { 166 _regs = new Hw::Mmio_register_block<32>(start); 167 } 168 169 // Enable the channel. 170 171 void 172 I2c_jz4780_channel::enable() 173 { 174 _regs[Smb_enable] = Smb_enable_enabled; 175 while (!(_regs[Smb_enable_status] & Smb_enable_enabled)); 176 } 177 178 // Disable the channel. 179 180 void 181 I2c_jz4780_channel::disable() 182 { 183 _regs[Smb_enable] = 0; 184 while (_regs[Smb_enable_status] & Smb_enable_enabled); 185 } 186 187 // Set the frequency-related peripheral parameters. 188 189 void 190 I2c_jz4780_channel::set_frequency() 191 { 192 // The APB clock (PCLK) is used to drive I2C transfers. Its value must be 193 // obtained from the CPM unit. It is known as SMB_CLK here and is scaled to 194 // kHz in order to keep the numbers easily representable, as is the bus 195 // frequency. 196 197 uint32_t smb_clk = _cpm->get_pclock_frequency() / 1000; 198 uint32_t i2c_clk = _frequency / 1000; 199 unsigned int speed = (i2c_clk <= 100) ? 1 : 2; 200 201 _regs[Smb_control] = _regs[Smb_control] | (speed << Smb_speed_bit) | 202 Smb_disable_slave | 203 Smb_enable_restart | 204 Smb_enable_master; 205 206 // According to the programming manual, if the PCLK period is T{SMB_CLK} 207 // then the I2C clock period is... 208 209 // T{SCL} = T{SCL_high} + T{SCL_low} 210 211 // Where... 212 213 // T{SCL_low} = T{SMB_CLK} * (#cycles for low signal) 214 // T{SCL_high} = T{SMB_CLK} * (#cycles for high signal) 215 216 // Since, with minimum periods being defined... 217 218 // T{SCL} >= T{min_SCL} 219 // T{SCL_low} >= T{min_SCL_low} 220 // T{SCL_high} >= T{min_SCL_high} 221 // T{min_SCL} = T{min_SCL_low} + T{min_SCL_high} 222 223 // Then the following applies... 224 225 // T{SMB_CLK} * (#cycles for low signal)) >= T{min_SCL_low} 226 // T{SMB_CLK} * (#cycles for high signal) >= T{min_SCL_high} 227 228 // To work with different clock speeds while maintaining the low-to-high 229 // ratios: 230 231 // T{min_SCL_low} = T{min_SCL} * T{min_SCL_low} / T{min_SCL} 232 // = T{min_SCL} * (T{min_SCL_low} / (T{min_SCL_low} + T{min_SCL_high})) 233 234 // T{min_SCL_high} = T{min_SCL} * T{min_SCL_high} / T{min_SCL} 235 // = T{min_SCL} * (T{min_SCL_high} / (T{min_SCL_low} + T{min_SCL_high})) 236 237 // Constraints are given with respect to the high and low count registers. 238 239 // #cycles for high signal = SMBxHCNT + 8 240 // #cycles for low signal = SMBxLCNT + 1 241 242 // From earlier, this yields... 243 244 // T{SMB_CLK} * (SMBxLCNT + 1) >= T{min_SCL_low} 245 // T{SMB_CLK} * (SMBxHCNT + 8) >= T{min_SCL_high} 246 247 // Rearranging... 248 249 // SMBxLCNT >= (T{min_SCL_low} / T{SMB_CLK}) - 1 250 // >= T{min_SCL_low} * SMB_CLK - 1 251 252 // SMBxHCNT >= (T{min_SCL_high} / T{SMB_CLK}) - 8 253 // >= T{min_SCL_high} * SMB_CLK - 8 254 255 // Introducing the definitions for the high and low periods... 256 257 // SMBxLCNT >= T{min_SCL} * (T{min_SCL_low} / (T{min_SCL_low} + T{min_SCL_high})) * SMB_CLK - 1 258 // >= (T{min_SCL_low} / T{min_SCL}) * SMB_CLK / I2C_CLK - 1 259 260 // SMBxHCNT >= T{min_SCL} * (T{min_SCL_high} / (T{min_SCL_low} + T{min_SCL_high})) * SMB_CLK - 8 261 // >= (T{min_SCL_high} / T{min_SCL}) * SMB_CLK / I2C_CLK - 8 262 263 uint32_t high_reg, low_reg; 264 uint32_t high_count, low_count; 265 int32_t hold_count; 266 uint32_t setup_count; 267 268 // Level hold times: 269 270 // Standard Fast 271 // SCL low 4.7us 1.3us 272 // SCL high 4.0us 0.6us + 273 // SCL period 8.7us 1.9us = 274 275 if (i2c_clk <= 100) // 100 kHz 276 { 277 low_count = (smb_clk * 47) / (i2c_clk * 87) - 1; 278 high_count = (smb_clk * 40) / (i2c_clk * 87) - 8; 279 low_reg = Std_low_count; 280 high_reg = Std_high_count; 281 } 282 else 283 { 284 low_count = (smb_clk * 13) / (i2c_clk * 19) - 1; 285 high_count = (smb_clk * 6) / (i2c_clk * 19) - 8; 286 low_reg = Fast_low_count; 287 high_reg = Fast_high_count; 288 } 289 290 // Minimum counts are 8 and 6 for low and high respectively. 291 292 _regs[low_reg] = low_count < 8 ? 8 : low_count; 293 _regs[high_reg] = high_count < 6 ? 6 : high_count; 294 295 // Data hold and setup times: 296 297 // Standard Fast 298 // t{HD;DAT} 300ns 300ns 299 // t{SU;DAT} 250ns 100ns 300 301 // T{delay} = (SMBSDAHD + 1) * T{SMB_CLK} 302 // SMBSDAHD = T{delay} / T{SMB_CLK} - 1 303 // SMBSDAHD = SMB_CLK * T{delay} - 1 304 305 hold_count = (smb_clk * 300) / 1000000 - 1; 306 307 _regs[Smb_sda_hold_time] = (_regs[Smb_sda_hold_time] & ~Smb_hold_mask) | 308 (hold_count >= 0 ? Smb_hold_enable : Smb_hold_disable) | 309 (hold_count < 0 ? 0 : hold_count < 255 ? hold_count : 255); 310 311 // T{delay} = (SMBSDASU - 1) * T{SMB_CLK} 312 // SMBSDASU = T{delay} / T{SMB_CLK} + 1 313 // SMBSDASU = SMB_CLK * T{delay} + 1 314 315 if (i2c_clk <= 100) 316 setup_count = (smb_clk * 250) / 1000000 + 1; 317 else 318 setup_count = (smb_clk * 100) / 1000000 + 1; 319 320 _regs[Smb_sda_setup_time] = (_regs[Smb_sda_setup_time] & ~Smb_setup_mask) | 321 (setup_count < 255 ? setup_count : 255); 322 } 323 324 // Set the target address and enable transfer. 325 // NOTE: Only supporting 7-bit addresses currently. 326 327 void 328 I2c_jz4780_channel::set_target(uint8_t address) 329 { 330 disable(); 331 set_frequency(); 332 _regs[Smb_target_address] = address & Smb_target_7bits; 333 enable(); 334 init_parameters(); 335 } 336 337 338 339 // Reset interrupt flags upon certain conditions. 340 341 void 342 I2c_jz4780_channel::reset_flags() 343 { 344 volatile uint32_t r; 345 346 _regs[Int_mask] = 0; 347 348 // Read from the register to clear interrupts. 349 350 r = _regs[Int_combined_clear]; 351 (void) r; 352 r = _regs[Trans_abort_status0]; 353 (void) r; 354 } 355 356 // Initialise interrupt flags and queue thresholds for reading and writing. 357 358 void 359 I2c_jz4780_channel::init_parameters() 360 { 361 // Handle read queue conditions for data, write queue conditions for commands. 362 363 reset_flags(); 364 365 _regs[Int_mask] = Int_rx_full | // read condition (reading needed) 366 Int_rx_of | // abort condition 367 Int_tx_empty | // write condition (writing needed) 368 Int_tx_abort; // abort condition 369 370 _regs[Tx_fifo_thold] = 0; // write when 0 in queue 371 372 // Make sure that the stop condition does not occur automatically. 373 374 _regs[Smb_control] = _regs[Smb_control] | Smb_no_stop_empty; 375 } 376 377 378 379 // Return whether the device is active. 380 381 int 382 I2c_jz4780_channel::active() 383 { 384 return _regs[Smb_status] & Smb_status_master_act; 385 } 386 387 // Return whether data is available to receive. 388 389 int 390 I2c_jz4780_channel::have_input() 391 { 392 return _regs[Smb_status] & Smb_status_rx_nempty; 393 } 394 395 // Return whether data is queued for sending. 396 397 int 398 I2c_jz4780_channel::have_output() 399 { 400 return !(_regs[Smb_status] & Smb_status_tx_empty); 401 } 402 403 // Return whether data can be queued for sending. 404 405 int 406 I2c_jz4780_channel::can_send() 407 { 408 return _regs[Smb_status] & Smb_status_tx_nfull; 409 } 410 411 // Return whether a receive operation has failed. 412 413 int 414 I2c_jz4780_channel::read_failed() 415 { 416 return _regs[Int_status] & Int_rx_of; 417 } 418 419 // Return whether a send operation has failed. 420 421 int 422 I2c_jz4780_channel::write_failed() 423 { 424 return _regs[Int_status] & Int_tx_abort; 425 } 426 427 428 429 // Send read commands for empty queue entries. 430 431 void 432 I2c_jz4780_channel::queue_reads() 433 { 434 unsigned int remaining = _total - _reqpos; 435 unsigned int queued = _reqpos - _pos; 436 437 // Permit one more issued read request due to the behaviour of the peripheral 438 // to withhold a request unless the stop condition has been issued. 439 440 unsigned int can_queue = Smb_fifo_limit - queued + 1; 441 442 // Keep the number of reads in progress below the length of the read queue. 443 444 if (!can_queue) 445 return; 446 447 if (remaining < can_queue) 448 can_queue = remaining; 449 450 // Queue read requests for any remaining queue entries. 451 452 for (unsigned int i = 0; i < can_queue; i++) 453 _regs[Smb_data_command] = Smb_command_read; 454 455 // Track queued messages and requested positions. 456 457 _reqpos += can_queue; 458 459 // Issue the stop condition after the final read request. 460 // In practice, an extra read request works better since it does not risk a 461 // transmission abort condition and would permit following transactions. 462 463 if (_total == _reqpos) 464 _regs[Smb_data_command] = Smb_command_read; 465 //stop(); 466 } 467 468 // Send write commands for empty queue entries. 469 470 void 471 I2c_jz4780_channel::queue_writes(uint8_t buf[], unsigned int *pos, unsigned int total) 472 { 473 // Queue write requests for any remaining queue entries. 474 475 while ((*pos < total) && can_send() && !write_failed()) 476 { 477 _regs[Smb_data_command] = Smb_command_write | buf[*pos]; 478 (*pos)++; 479 } 480 } 481 482 // Store read command results from the queue. 483 484 void 485 I2c_jz4780_channel::store_reads() 486 { 487 int have_read = 0; 488 489 // Read any input and store it in the buffer. 490 491 while (have_input() && (_pos < _total)) 492 { 493 _buf[_pos] = _regs[Smb_data_command] & 0xff; 494 _pos++; 495 496 have_read = 1; 497 } 498 499 // Update the threshold to be notified of any reduced remaining amount. 500 501 if (have_read) 502 set_read_threshold(); 503 } 504 505 void 506 I2c_jz4780_channel::set_read_threshold() 507 { 508 unsigned int remaining = _total - _pos; 509 510 if (!remaining) 511 return; 512 513 // Read all remaining. 514 515 if (remaining <= Smb_fifo_limit) 516 _regs[Rx_fifo_thold] = remaining - 1; 517 518 // Read to limit. 519 520 else 521 _regs[Rx_fifo_thold] = Smb_fifo_limit - 1; 522 } 523 524 // Read from the target device. 525 526 void 527 I2c_jz4780_channel::start_read(uint8_t buf[], unsigned int total) 528 { 529 _buf = buf; 530 _total = total; 531 _pos = 0; 532 _reqpos = 0; 533 _fail = 0; 534 535 set_read_threshold(); 536 } 537 538 void 539 I2c_jz4780_channel::read() 540 { 541 if (read_failed() || write_failed()) 542 { 543 #if 0 544 printf("intst*=%x\n", (uint32_t) _regs[Int_status]); 545 printf("rxfifo=%d\n", (uint32_t) _regs[Rx_fifo_count] & 0x3f); 546 printf("smbabtsrc=%x\n", (uint32_t) _regs[Trans_abort_status0]); 547 #endif 548 _fail = 1; 549 return; 550 } 551 552 if (_pos < _total) 553 { 554 if (_regs[Int_status] & Int_rx_full) 555 store_reads(); 556 if (_regs[Int_status] & Int_tx_empty) 557 queue_reads(); 558 } 559 } 560 561 int 562 I2c_jz4780_channel::read_done() 563 { 564 return _pos == _total; 565 } 566 567 unsigned 568 I2c_jz4780_channel::have_read() 569 { 570 return _pos; 571 } 572 573 int 574 I2c_jz4780_channel::read_incomplete() 575 { 576 return _fail; 577 } 578 579 // Write to the target device. 580 581 void 582 I2c_jz4780_channel::write(uint8_t buf[], unsigned int total) 583 { 584 unsigned int pos = 0; 585 586 while ((pos < total) && !write_failed()) 587 { 588 queue_writes(buf, &pos, total); 589 } 590 } 591 592 // Explicitly stop communication. 593 594 void 595 I2c_jz4780_channel::stop() 596 { 597 _regs[Smb_control] = _regs[Smb_control] & ~Smb_no_stop_empty; 598 } 599 600 601 602 // Initialise the I2C controller. 603 604 I2c_jz4780_chip::I2c_jz4780_chip(l4_addr_t start, l4_addr_t end, 605 Cpm_jz4780_chip *cpm, 606 uint32_t frequency) 607 : _start(start), _end(end), _cpm(cpm), _frequency(frequency) 608 { 609 } 610 611 // Obtain a channel object. 612 613 I2c_jz4780_channel * 614 I2c_jz4780_chip::get_channel(uint8_t channel) 615 { 616 l4_addr_t block = _start + channel * Smb_block_offset; 617 618 if (block < _end) 619 { 620 _cpm->start_i2c(channel); 621 return new I2c_jz4780_channel(block, _cpm, _frequency); 622 } 623 else 624 throw -L4_EINVAL; 625 } 626 627 628 629 // C language interface functions. 630 631 void *jz4780_i2c_init(l4_addr_t start, l4_addr_t end, void *cpm, uint32_t frequency) 632 { 633 return (void *) new I2c_jz4780_chip(start, end, static_cast<Cpm_jz4780_chip *>(cpm), frequency); 634 } 635 636 void jz4780_i2c_disable(void *i2c_channel) 637 { 638 static_cast<I2c_jz4780_channel *>(i2c_channel)->disable(); 639 } 640 641 void *jz4780_i2c_get_channel(void *i2c, uint8_t channel) 642 { 643 return static_cast<I2c_jz4780_chip *>(i2c)->get_channel(channel); 644 } 645 646 void jz4780_i2c_set_target(void *i2c_channel, uint8_t addr) 647 { 648 static_cast<I2c_jz4780_channel *>(i2c_channel)->set_target(addr); 649 } 650 651 void jz4780_i2c_start_read(void *i2c_channel, uint8_t buf[], unsigned int total) 652 { 653 static_cast<I2c_jz4780_channel *>(i2c_channel)->start_read(buf, total); 654 } 655 656 void jz4780_i2c_read(void *i2c_channel) 657 { 658 static_cast<I2c_jz4780_channel *>(i2c_channel)->read(); 659 } 660 661 int jz4780_i2c_read_done(void *i2c_channel) 662 { 663 return static_cast<I2c_jz4780_channel *>(i2c_channel)->read_done(); 664 } 665 666 unsigned int jz4780_i2c_have_read(void *i2c_channel) 667 { 668 return static_cast<I2c_jz4780_channel *>(i2c_channel)->have_read(); 669 } 670 671 int jz4780_i2c_read_incomplete(void *i2c_channel) 672 { 673 return static_cast<I2c_jz4780_channel *>(i2c_channel)->read_incomplete(); 674 } 675 676 void jz4780_i2c_write(void *i2c_channel, uint8_t buf[], unsigned int total) 677 { 678 static_cast<I2c_jz4780_channel *>(i2c_channel)->write(buf, total); 679 } 680 681 void jz4780_i2c_stop(void *i2c_channel) 682 { 683 static_cast<I2c_jz4780_channel *>(i2c_channel)->stop(); 684 }