smc91c111.c revision 413f05aaf54fa08c0ae7e997327a4f4a473c0a8d
1/* 2 * SMSC 91C111 Ethernet interface emulation 3 * 4 * Copyright (c) 2005 CodeSourcery, LLC. 5 * Written by Paul Brook 6 * 7 * This code is licenced under the GPL 8 */ 9 10#include "vl.h" 11/* For crc32 */ 12#include <zlib.h> 13 14/* Number of 2k memory pages available. */ 15#define NUM_PACKETS 4 16 17typedef struct { 18 uint32_t base; 19 VLANClientState *vc; 20 uint16_t tcr; 21 uint16_t rcr; 22 uint16_t cr; 23 uint16_t ctr; 24 uint16_t gpr; 25 uint16_t ptr; 26 uint16_t ercv; 27 void *pic; 28 int irq; 29 int bank; 30 int packet_num; 31 int tx_alloc; 32 /* Bitmask of allocated packets. */ 33 int allocated; 34 int tx_fifo_len; 35 int tx_fifo[NUM_PACKETS]; 36 int rx_fifo_len; 37 int rx_fifo[NUM_PACKETS]; 38 int tx_fifo_done_len; 39 int tx_fifo_done[NUM_PACKETS]; 40 /* Packet buffer memory. */ 41 uint8_t data[NUM_PACKETS][2048]; 42 uint8_t int_level; 43 uint8_t int_mask; 44 uint8_t macaddr[6]; 45} smc91c111_state; 46 47#define RCR_SOFT_RST 0x8000 48#define RCR_STRIP_CRC 0x0200 49#define RCR_RXEN 0x0100 50 51#define TCR_EPH_LOOP 0x2000 52#define TCR_NOCRC 0x0100 53#define TCR_PAD_EN 0x0080 54#define TCR_FORCOL 0x0004 55#define TCR_LOOP 0x0002 56#define TCR_TXEN 0x0001 57 58#define INT_MD 0x80 59#define INT_ERCV 0x40 60#define INT_EPH 0x20 61#define INT_RX_OVRN 0x10 62#define INT_ALLOC 0x08 63#define INT_TX_EMPTY 0x04 64#define INT_TX 0x02 65#define INT_RCV 0x01 66 67#define CTR_AUTO_RELEASE 0x0800 68#define CTR_RELOAD 0x0002 69#define CTR_STORE 0x0001 70 71#define RS_ALGNERR 0x8000 72#define RS_BRODCAST 0x4000 73#define RS_BADCRC 0x2000 74#define RS_ODDFRAME 0x1000 75#define RS_TOOLONG 0x0800 76#define RS_TOOSHORT 0x0400 77#define RS_MULTICAST 0x0001 78 79/* Update interrupt status. */ 80static void smc91c111_update(smc91c111_state *s) 81{ 82 int level; 83 84 if (s->tx_fifo_len == 0) 85 s->int_level |= INT_TX_EMPTY; 86 if (s->tx_fifo_done_len != 0) 87 s->int_level |= INT_TX; 88 level = (s->int_level & s->int_mask) != 0; 89 pic_set_irq_new(s->pic, s->irq, level); 90} 91 92/* Try to allocate a packet. Returns 0x80 on failure. */ 93static int smc91c111_allocate_packet(smc91c111_state *s) 94{ 95 int i; 96 if (s->allocated == (1 << NUM_PACKETS) - 1) { 97 return 0x80; 98 } 99 100 for (i = 0; i < NUM_PACKETS; i++) { 101 if ((s->allocated & (1 << i)) == 0) 102 break; 103 } 104 s->allocated |= 1 << i; 105 return i; 106} 107 108 109/* Process a pending TX allocate. */ 110static void smc91c111_tx_alloc(smc91c111_state *s) 111{ 112 s->tx_alloc = smc91c111_allocate_packet(s); 113 if (s->tx_alloc == 0x80) 114 return; 115 s->int_level |= INT_ALLOC; 116 smc91c111_update(s); 117} 118 119/* Remove and item from the RX FIFO. */ 120static void smc91c111_pop_rx_fifo(smc91c111_state *s) 121{ 122 int i; 123 124 s->rx_fifo_len--; 125 if (s->rx_fifo_len) { 126 for (i = 0; i < s->rx_fifo_len; i++) 127 s->rx_fifo[i] = s->rx_fifo[i + 1]; 128 s->int_level |= INT_RCV; 129 } else { 130 s->int_level &= ~INT_RCV; 131 } 132 smc91c111_update(s); 133} 134 135/* Remove an item from the TX completion FIFO. */ 136static void smc91c111_pop_tx_fifo_done(smc91c111_state *s) 137{ 138 int i; 139 140 if (s->tx_fifo_done_len == 0) 141 return; 142 s->tx_fifo_done_len--; 143 for (i = 0; i < s->tx_fifo_done_len; i++) 144 s->tx_fifo_done[i] = s->tx_fifo_done[i + 1]; 145} 146 147/* Release the memory allocated to a packet. */ 148static void smc91c111_release_packet(smc91c111_state *s, int packet) 149{ 150 s->allocated &= ~(1 << packet); 151 if (s->tx_alloc == 0x80) 152 smc91c111_tx_alloc(s); 153} 154 155/* Flush the TX FIFO. */ 156static void smc91c111_do_tx(smc91c111_state *s) 157{ 158 int i; 159 int len; 160 int control; 161 int add_crc; 162 uint32_t crc; 163 int packetnum; 164 uint8_t *p; 165 166 if ((s->tcr & TCR_TXEN) == 0) 167 return; 168 if (s->tx_fifo_len == 0) 169 return; 170 for (i = 0; i < s->tx_fifo_len; i++) { 171 packetnum = s->tx_fifo[i]; 172 p = &s->data[packetnum][0]; 173 /* Set status word. */ 174 *(p++) = 0x01; 175 *(p++) = 0x40; 176 len = *(p++); 177 len |= ((int)*(p++)) << 8; 178 len -= 6; 179 control = p[len + 1]; 180 if (control & 0x20) 181 len++; 182 /* ??? This overwrites the data following the buffer. 183 Don't know what real hardware does. */ 184 if (len < 64 && (s->tcr & TCR_PAD_EN)) { 185 memset(p + len, 0, 64 - len); 186 len = 64; 187 } 188#if 0 189 /* The card is supposed to append the CRC to the frame. However 190 none of the other network traffic has the CRC appended. 191 Suspect this is low level ethernet detail we don't need to worry 192 about. */ 193 add_crc = (control & 0x10) || (s->tcr & TCR_NOCRC) == 0; 194 if (add_crc) { 195 crc = crc32(~0, p, len); 196 memcpy(p + len, &crc, 4); 197 len += 4; 198 } 199#else 200 add_crc = 0; 201#endif 202 if (s->ctr & CTR_AUTO_RELEASE) 203 /* Race? */ 204 smc91c111_release_packet(s, packetnum); 205 else if (s->tx_fifo_done_len < NUM_PACKETS) 206 s->tx_fifo_done[s->tx_fifo_done_len++] = packetnum; 207 qemu_send_packet(s->vc, p, len); 208 } 209 s->tx_fifo_len = 0; 210 smc91c111_update(s); 211} 212 213/* Add a packet to the TX FIFO. */ 214static void smc91c111_queue_tx(smc91c111_state *s, int packet) 215{ 216 if (s->tx_fifo_len == NUM_PACKETS) 217 return; 218 s->tx_fifo[s->tx_fifo_len++] = packet; 219 smc91c111_do_tx(s); 220} 221 222static void smc91c111_reset(smc91c111_state *s) 223{ 224 s->bank = 0; 225 s->tx_fifo_len = 0; 226 s->tx_fifo_done_len = 0; 227 s->rx_fifo_len = 0; 228 s->allocated = 0; 229 s->packet_num = 0; 230 s->tx_alloc = 0; 231 s->tcr = 0; 232 s->rcr = 0; 233 s->cr = 0xa0b1; 234 s->ctr = 0x1210; 235 s->ptr = 0; 236 s->ercv = 0x1f; 237 s->int_level = INT_TX_EMPTY; 238 s->int_mask = 0; 239 smc91c111_update(s); 240} 241 242#define SET_LOW(name, val) s->name = (s->name & 0xff00) | val 243#define SET_HIGH(name, val) s->name = (s->name & 0xff) | (val << 8) 244 245static void smc91c111_writeb(void *opaque, target_phys_addr_t offset, 246 uint32_t value) 247{ 248 smc91c111_state *s = (smc91c111_state *)opaque; 249 250 offset -= s->base; 251 if (offset == 14) { 252 s->bank = value; 253 return; 254 } 255 if (offset == 15) 256 return; 257 switch (s->bank) { 258 case 0: 259 switch (offset) { 260 case 0: /* TCR */ 261 SET_LOW(tcr, value); 262 return; 263 case 1: 264 SET_HIGH(tcr, value); 265 return; 266 case 4: /* RCR */ 267 SET_LOW(rcr, value); 268 return; 269 case 5: 270 SET_HIGH(rcr, value); 271 if (s->rcr & RCR_SOFT_RST) 272 smc91c111_reset(s); 273 return; 274 case 10: case 11: /* RPCR */ 275 /* Ignored */ 276 return; 277 } 278 break; 279 280 case 1: 281 switch (offset) { 282 case 0: /* CONFIG */ 283 SET_LOW(cr, value); 284 return; 285 case 1: 286 SET_HIGH(cr,value); 287 return; 288 case 2: case 3: /* BASE */ 289 case 4: case 5: case 6: case 7: case 8: case 9: /* IA */ 290 /* Not implemented. */ 291 return; 292 case 10: /* Genral Purpose */ 293 SET_LOW(gpr, value); 294 return; 295 case 11: 296 SET_HIGH(gpr, value); 297 return; 298 case 12: /* Control */ 299 if (value & 1) 300 fprintf(stderr, "smc91c111:EEPROM store not implemented\n"); 301 if (value & 2) 302 fprintf(stderr, "smc91c111:EEPROM reload not implemented\n"); 303 value &= ~3; 304 SET_LOW(ctr, value); 305 return; 306 case 13: 307 SET_HIGH(ctr, value); 308 return; 309 } 310 break; 311 312 case 2: 313 switch (offset) { 314 case 0: /* MMU Command */ 315 switch (value >> 5) { 316 case 0: /* no-op */ 317 break; 318 case 1: /* Allocate for TX. */ 319 s->tx_alloc = 0x80; 320 s->int_level &= ~INT_ALLOC; 321 smc91c111_update(s); 322 smc91c111_tx_alloc(s); 323 break; 324 case 2: /* Reset MMU. */ 325 s->allocated = 0; 326 s->tx_fifo_len = 0; 327 s->tx_fifo_done_len = 0; 328 s->rx_fifo_len = 0; 329 s->tx_alloc = 0; 330 break; 331 case 3: /* Remove from RX FIFO. */ 332 smc91c111_pop_rx_fifo(s); 333 break; 334 case 4: /* Remove from RX FIFO and release. */ 335 if (s->rx_fifo_len > 0) { 336 smc91c111_release_packet(s, s->rx_fifo[0]); 337 } 338 smc91c111_pop_rx_fifo(s); 339 break; 340 case 5: /* Release. */ 341 smc91c111_release_packet(s, s->packet_num); 342 break; 343 case 6: /* Add to TX FIFO. */ 344 smc91c111_queue_tx(s, s->packet_num); 345 break; 346 case 7: /* Reset TX FIFO. */ 347 s->tx_fifo_len = 0; 348 s->tx_fifo_done_len = 0; 349 break; 350 } 351 return; 352 case 1: 353 /* Ignore. */ 354 return; 355 case 2: /* Packet Number Register */ 356 s->packet_num = value; 357 return; 358 case 3: case 4: case 5: 359 /* Should be readonly, but linux writes to them anyway. Ignore. */ 360 return; 361 case 6: /* Pointer */ 362 SET_LOW(ptr, value); 363 return; 364 case 7: 365 SET_HIGH(ptr, value); 366 return; 367 case 8: case 9: case 10: case 11: /* Data */ 368 { 369 int p; 370 int n; 371 372 if (s->ptr & 0x8000) 373 n = s->rx_fifo[0]; 374 else 375 n = s->packet_num; 376 p = s->ptr & 0x07ff; 377 if (s->ptr & 0x4000) { 378 s->ptr = (s->ptr & 0xf800) | ((s->ptr + 1) & 0x7ff); 379 } else { 380 p += (offset & 3); 381 } 382 s->data[n][p] = value; 383 } 384 return; 385 case 12: /* Interrupt ACK. */ 386 s->int_level &= ~(value & 0xd6); 387 if (value & INT_TX) 388 smc91c111_pop_tx_fifo_done(s); 389 smc91c111_update(s); 390 return; 391 case 13: /* Interrupt mask. */ 392 s->int_mask = value; 393 smc91c111_update(s); 394 return; 395 } 396 break;; 397 398 case 3: 399 switch (offset) { 400 case 0: case 1: case 2: case 3: case 4: case 5: case 6: case 7: 401 /* Multicast table. */ 402 /* Not implemented. */ 403 return; 404 case 8: case 9: /* Management Interface. */ 405 /* Not implemented. */ 406 return; 407 case 12: /* Early receive. */ 408 s->ercv = value & 0x1f; 409 case 13: 410 /* Ignore. */ 411 return; 412 } 413 break; 414 } 415 cpu_abort (cpu_single_env, "smc91c111_write: Bad reg %d:%x\n", 416 s->bank, offset); 417} 418 419static uint32_t smc91c111_readb(void *opaque, target_phys_addr_t offset) 420{ 421 smc91c111_state *s = (smc91c111_state *)opaque; 422 423 offset -= s->base; 424 if (offset == 14) { 425 return s->bank; 426 } 427 if (offset == 15) 428 return 0x33; 429 switch (s->bank) { 430 case 0: 431 switch (offset) { 432 case 0: /* TCR */ 433 return s->tcr & 0xff; 434 case 1: 435 return s->tcr >> 8; 436 case 2: /* EPH Status */ 437 return 0; 438 case 3: 439 return 0x40; 440 case 4: /* RCR */ 441 return s->rcr & 0xff; 442 case 5: 443 return s->rcr >> 8; 444 case 6: /* Counter */ 445 case 7: 446 /* Not implemented. */ 447 return 0; 448 case 8: /* Free memory available. */ 449 { 450 int i; 451 int n; 452 n = 0; 453 for (i = 0; i < NUM_PACKETS; i++) { 454 if (s->allocated & (1 << i)) 455 n++; 456 } 457 return n; 458 } 459 case 9: /* Memory size. */ 460 return NUM_PACKETS; 461 case 10: case 11: /* RPCR */ 462 /* Not implemented. */ 463 return 0; 464 } 465 break; 466 467 case 1: 468 switch (offset) { 469 case 0: /* CONFIG */ 470 return s->cr & 0xff; 471 case 1: 472 return s->cr >> 8; 473 case 2: case 3: /* BASE */ 474 /* Not implemented. */ 475 return 0; 476 case 4: case 5: case 6: case 7: case 8: case 9: /* IA */ 477 return s->macaddr[offset - 4]; 478 case 10: /* General Purpose */ 479 return s->gpr & 0xff; 480 case 11: 481 return s->gpr >> 8; 482 case 12: /* Control */ 483 return s->ctr & 0xff; 484 case 13: 485 return s->ctr >> 8; 486 } 487 break; 488 489 case 2: 490 switch (offset) { 491 case 0: case 1: /* MMUCR Busy bit. */ 492 return 0; 493 case 2: /* Packet Number. */ 494 return s->packet_num; 495 case 3: /* Allocation Result. */ 496 return s->tx_alloc; 497 case 4: /* TX FIFO */ 498 if (s->tx_fifo_done_len == 0) 499 return 0x80; 500 else 501 return s->tx_fifo_done[0]; 502 case 5: /* RX FIFO */ 503 if (s->rx_fifo_len == 0) 504 return 0x80; 505 else 506 return s->rx_fifo[0]; 507 case 6: /* Pointer */ 508 return s->ptr & 0xff; 509 case 7: 510 return (s->ptr >> 8) & 0xf7; 511 case 8: case 9: case 10: case 11: /* Data */ 512 { 513 int p; 514 int n; 515 516 if (s->ptr & 0x8000) 517 n = s->rx_fifo[0]; 518 else 519 n = s->packet_num; 520 p = s->ptr & 0x07ff; 521 if (s->ptr & 0x4000) { 522 s->ptr = (s->ptr & 0xf800) | ((s->ptr + 1) & 0x07ff); 523 } else { 524 p += (offset & 3); 525 } 526 return s->data[n][p]; 527 } 528 case 12: /* Interrupt status. */ 529 return s->int_level; 530 case 13: /* Interrupt mask. */ 531 return s->int_mask; 532 } 533 break; 534 535 case 3: 536 switch (offset) { 537 case 0: case 1: case 2: case 3: case 4: case 5: case 6: case 7: 538 /* Multicast table. */ 539 /* Not implemented. */ 540 return 0; 541 case 8: /* Management Interface. */ 542 /* Not implemented. */ 543 return 0x30; 544 case 9: 545 return 0x33; 546 case 10: /* Revision. */ 547 return 0x91; 548 case 11: 549 return 0x33; 550 case 12: 551 return s->ercv; 552 case 13: 553 return 0; 554 } 555 break; 556 } 557 cpu_abort (cpu_single_env, "smc91c111_read: Bad reg %d:%x\n", 558 s->bank, offset); 559 return 0; 560} 561 562static void smc91c111_writew(void *opaque, target_phys_addr_t offset, 563 uint32_t value) 564{ 565 smc91c111_writeb(opaque, offset, value & 0xff); 566 smc91c111_writeb(opaque, offset + 1, value >> 8); 567} 568 569static void smc91c111_writel(void *opaque, target_phys_addr_t offset, 570 uint32_t value) 571{ 572 smc91c111_state *s = (smc91c111_state *)opaque; 573 /* 32-bit writes to offset 0xc only actually write to the bank select 574 register (offset 0xe) */ 575 if (offset != s->base + 0xc) 576 smc91c111_writew(opaque, offset, value & 0xffff); 577 smc91c111_writew(opaque, offset + 2, value >> 16); 578} 579 580static uint32_t smc91c111_readw(void *opaque, target_phys_addr_t offset) 581{ 582 uint32_t val; 583 val = smc91c111_readb(opaque, offset); 584 val |= smc91c111_readb(opaque, offset + 1) << 8; 585 return val; 586} 587 588static uint32_t smc91c111_readl(void *opaque, target_phys_addr_t offset) 589{ 590 uint32_t val; 591 val = smc91c111_readw(opaque, offset); 592 val |= smc91c111_readw(opaque, offset + 2) << 16; 593 return val; 594} 595 596static int smc91c111_can_receive(void *opaque) 597{ 598 smc91c111_state *s = (smc91c111_state *)opaque; 599 600 if ((s->rcr & RCR_RXEN) == 0 || (s->rcr & RCR_SOFT_RST)) 601 return 1; 602 if (s->allocated == (1 << NUM_PACKETS) - 1) 603 return 0; 604 return 1; 605} 606 607static void smc91c111_receive(void *opaque, const uint8_t *buf, int size) 608{ 609 smc91c111_state *s = (smc91c111_state *)opaque; 610 int status; 611 int packetsize; 612 uint32_t crc; 613 int packetnum; 614 uint8_t *p; 615 616 if ((s->rcr & RCR_RXEN) == 0 || (s->rcr & RCR_SOFT_RST)) 617 return; 618 /* Short packets are padded with zeros. Recieveing a packet 619 < 64 bytes long is considered an error condition. */ 620 if (size < 64) 621 packetsize = 64; 622 else 623 packetsize = (size & ~1); 624 packetsize += 6; 625 crc = (s->rcr & RCR_STRIP_CRC) == 0; 626 if (crc) 627 packetsize += 4; 628 /* TODO: Flag overrun and receive errors. */ 629 if (packetsize > 2048) 630 return; 631 packetnum = smc91c111_allocate_packet(s); 632 if (packetnum == 0x80) 633 return; 634 s->rx_fifo[s->rx_fifo_len++] = packetnum; 635 636 p = &s->data[packetnum][0]; 637 /* ??? Multicast packets? */ 638 status = 0; 639 if (size > 1518) 640 status |= RS_TOOLONG; 641 if (size & 1) 642 status |= RS_ODDFRAME; 643 *(p++) = status & 0xff; 644 *(p++) = status >> 8; 645 *(p++) = packetsize & 0xff; 646 *(p++) = packetsize >> 8; 647 memcpy(p, buf, size & ~1); 648 p += (size & ~1); 649 /* Pad short packets. */ 650 if (size < 64) { 651 int pad; 652 653 if (size & 1) 654 *(p++) = buf[size - 1]; 655 pad = 64 - size; 656 memset(p, 0, pad); 657 p += pad; 658 size = 64; 659 } 660 /* It's not clear if the CRC should go before or after the last byte in 661 odd sized packets. Linux disables the CRC, so that's no help. 662 The pictures in the documentation show the CRC aligned on a 16-bit 663 boundary before the last odd byte, so that's what we do. */ 664 if (crc) { 665 crc = crc32(~0, buf, size); 666 *(p++) = crc & 0xff; crc >>= 8; 667 *(p++) = crc & 0xff; crc >>= 8; 668 *(p++) = crc & 0xff; crc >>= 8; 669 *(p++) = crc & 0xff; crc >>= 8; 670 } 671 if (size & 1) { 672 *(p++) = buf[size - 1]; 673 *(p++) = 0x60; 674 } else { 675 *(p++) = 0; 676 *(p++) = 0x40; 677 } 678 /* TODO: Raise early RX interrupt? */ 679 s->int_level |= INT_RCV; 680 smc91c111_update(s); 681} 682 683static CPUReadMemoryFunc *smc91c111_readfn[] = { 684 smc91c111_readb, 685 smc91c111_readw, 686 smc91c111_readl 687}; 688 689static CPUWriteMemoryFunc *smc91c111_writefn[] = { 690 smc91c111_writeb, 691 smc91c111_writew, 692 smc91c111_writel 693}; 694 695void smc91c111_init(NICInfo *nd, uint32_t base, void *pic, int irq) 696{ 697 smc91c111_state *s; 698 int iomemtype; 699 700 s = (smc91c111_state *)qemu_mallocz(sizeof(smc91c111_state)); 701 iomemtype = cpu_register_io_memory(0, smc91c111_readfn, 702 smc91c111_writefn, s); 703 cpu_register_physical_memory(base, 16, iomemtype); 704 s->base = base; 705 s->pic = pic; 706 s->irq = irq; 707 memcpy(s->macaddr, nd->macaddr, 6); 708 709 smc91c111_reset(s); 710 711 s->vc = qemu_new_vlan_client(nd->vlan, smc91c111_receive, 712 smc91c111_can_receive, s); 713 /* ??? Save/restore. */ 714} 715