32/* 33 * Device driver for Granch SBNI12 leased line adapters 34 * 35 * Revision 2.0.0 1997/08/06 36 * Initial revision by Alexey Zverev 37 * 38 * Revision 2.0.1 1997/08/11 39 * Additional internal statistics support (tx statistics) 40 * 41 * Revision 2.0.2 1997/11/05 42 * if_bpf bug has been fixed 43 * 44 * Revision 2.0.3 1998/12/20 45 * Memory leakage has been eliminated in 46 * the sbni_st and sbni_timeout routines. 47 * 48 * Revision 3.0 2000/08/10 by Yaroslav Polyakov 49 * Support for PCI cards. 4.1 modification. 50 * 51 * Revision 3.1 2000/09/12 52 * Removed extra #defines around bpf functions 53 * 54 * Revision 4.0 2000/11/23 by Denis Timofeev 55 * Completely redesigned the buffer management 56 * 57 * Revision 4.1 2001/01/21 58 * Support for PCI Dual cards and new SBNI12D-10, -11 Dual/ISA cards 59 * 60 * Written with reference to NE2000 driver developed by David Greenman. 61 */ 62 63 64#include <sys/param.h> 65#include <sys/systm.h> 66#include <sys/socket.h> 67#include <sys/sockio.h> 68#include <sys/mbuf.h> 69#include <sys/kernel.h> 70#include <sys/proc.h> 71#include <sys/callout.h> 72#include <sys/syslog.h> 73#include <sys/random.h> 74 75#include <machine/bus.h> 76#include <sys/rman.h> 77#include <machine/resource.h> 78 79#include <net/if.h> 80#include <net/ethernet.h> 81#include <net/if_arp.h> 82#include <net/bpf.h> 83 84#include <dev/sbni/if_sbnireg.h> 85#include <dev/sbni/if_sbnivar.h> 86 87#define ASM_CRC 1 88 89static void sbni_init(void *); 90static void sbni_start(struct ifnet *); 91static int sbni_ioctl(struct ifnet *, u_long, caddr_t); 92static void sbni_watchdog(struct ifnet *); 93static void sbni_stop(struct sbni_softc *); 94static void handle_channel(struct sbni_softc *); 95 96static void card_start(struct sbni_softc *); 97static int recv_frame(struct sbni_softc *); 98static void send_frame(struct sbni_softc *); 99static int upload_data(struct sbni_softc *, u_int, u_int, u_int, u_int32_t); 100static int skip_tail(struct sbni_softc *, u_int, u_int32_t); 101static void interpret_ack(struct sbni_softc *, u_int); 102static void download_data(struct sbni_softc *, u_int32_t *); 103static void prepare_to_send(struct sbni_softc *); 104static void drop_xmit_queue(struct sbni_softc *); 105static int get_rx_buf(struct sbni_softc *); 106static void indicate_pkt(struct sbni_softc *); 107static void change_level(struct sbni_softc *); 108static int check_fhdr(struct sbni_softc *, u_int *, u_int *, 109 u_int *, u_int *, u_int32_t *); 110static int append_frame_to_pkt(struct sbni_softc *, u_int, u_int32_t); 111static void timeout_change_level(struct sbni_softc *); 112static void send_frame_header(struct sbni_softc *, u_int32_t *); 113static void set_initial_values(struct sbni_softc *, struct sbni_flags); 114 115static u_int32_t calc_crc32(u_int32_t, caddr_t, u_int); 116static timeout_t sbni_timeout; 117 118static __inline u_char sbni_inb(struct sbni_softc *, enum sbni_reg); 119static __inline void sbni_outb(struct sbni_softc *, enum sbni_reg, u_char); 120static __inline void sbni_insb(struct sbni_softc *, u_char *, u_int); 121static __inline void sbni_outsb(struct sbni_softc *, u_char *, u_int); 122 123static u_int32_t crc32tab[]; 124 125#ifdef SBNI_DUAL_COMPOUND 126struct sbni_softc *sbni_headlist; 127#endif 128 129u_int32_t next_sbni_unit; 130 131/* -------------------------------------------------------------------------- */ 132 133static __inline u_char 134sbni_inb(struct sbni_softc *sc, enum sbni_reg reg) 135{ 136 return bus_space_read_1( 137 rman_get_bustag(sc->io_res), 138 rman_get_bushandle(sc->io_res), 139 sc->io_off + reg); 140} 141 142static __inline void 143sbni_outb(struct sbni_softc *sc, enum sbni_reg reg, u_char value) 144{ 145 bus_space_write_1( 146 rman_get_bustag(sc->io_res), 147 rman_get_bushandle(sc->io_res), 148 sc->io_off + reg, value); 149} 150 151static __inline void 152sbni_insb(struct sbni_softc *sc, u_char *to, u_int len) 153{ 154 bus_space_read_multi_1( 155 rman_get_bustag(sc->io_res), 156 rman_get_bushandle(sc->io_res), 157 sc->io_off + DAT, to, len); 158} 159 160static __inline void 161sbni_outsb(struct sbni_softc *sc, u_char *from, u_int len) 162{ 163 bus_space_write_multi_1( 164 rman_get_bustag(sc->io_res), 165 rman_get_bushandle(sc->io_res), 166 sc->io_off + DAT, from, len); 167} 168 169 170/* 171 Valid combinations in CSR0 (for probing): 172 173 VALID_DECODER 0000,0011,1011,1010 174 175 ; 0 ; - 176 TR_REQ ; 1 ; + 177 TR_RDY ; 2 ; - 178 TR_RDY TR_REQ ; 3 ; + 179 BU_EMP ; 4 ; + 180 BU_EMP TR_REQ ; 5 ; + 181 BU_EMP TR_RDY ; 6 ; - 182 BU_EMP TR_RDY TR_REQ ; 7 ; + 183 RC_RDY ; 8 ; + 184 RC_RDY TR_REQ ; 9 ; + 185 RC_RDY TR_RDY ; 10 ; - 186 RC_RDY TR_RDY TR_REQ ; 11 ; - 187 RC_RDY BU_EMP ; 12 ; - 188 RC_RDY BU_EMP TR_REQ ; 13 ; - 189 RC_RDY BU_EMP TR_RDY ; 14 ; - 190 RC_RDY BU_EMP TR_RDY TR_REQ ; 15 ; - 191*/ 192 193#define VALID_DECODER (2 + 8 + 0x10 + 0x20 + 0x80 + 0x100 + 0x200) 194 195 196int 197sbni_probe(struct sbni_softc *sc) 198{ 199 u_char csr0; 200 201 csr0 = sbni_inb(sc, CSR0); 202 if (csr0 != 0xff && csr0 != 0x00) { 203 csr0 &= ~EN_INT; 204 if (csr0 & BU_EMP) 205 csr0 |= EN_INT; 206 207 if (VALID_DECODER & (1 << (csr0 >> 4))) 208 return (0); 209 } 210 211 return (ENXIO); 212} 213 214 215/* 216 * Install interface into kernel networking data structures 217 */ 218void 219sbni_attach(struct sbni_softc *sc, int unit, struct sbni_flags flags) 220{ 221 struct ifnet *ifp; 222 u_char csr0; 223 224 ifp = &sc->arpcom.ac_if; 225 sbni_outb(sc, CSR0, 0); 226 set_initial_values(sc, flags); 227 228 callout_handle_init(&sc->wch); 229 if (!ifp->if_name) { 230 /* Initialize ifnet structure */ 231 ifp->if_softc = sc; 232 ifp->if_unit = unit; 233 ifp->if_name = "sbni"; 234 ifp->if_init = sbni_init; 235 ifp->if_start = sbni_start; 236 ifp->if_output = ether_output; 237 ifp->if_ioctl = sbni_ioctl; 238 ifp->if_watchdog = sbni_watchdog; 239 ifp->if_snd.ifq_maxlen = IFQ_MAXLEN; 240 241 /* report real baud rate */ 242 csr0 = sbni_inb(sc, CSR0); 243 ifp->if_baudrate = 244 (csr0 & 0x01 ? 500000 : 2000000) / (1 << flags.rate); 245 246 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 247 ether_ifattach(ifp, sc->arpcom.ac_enaddr); 248 } 249 /* device attach does transition from UNCONFIGURED to IDLE state */ 250 251 if_printf(ifp, "speed %ld, address %6D, rxl ", 252 ifp->if_baudrate, sc->arpcom.ac_enaddr, ":"); 253 if (sc->delta_rxl) 254 printf("auto\n"); 255 else 256 printf("%d (fixed)\n", sc->cur_rxl_index); 257} 258 259/* -------------------------------------------------------------------------- */ 260 261static void 262sbni_init(void *xsc) 263{ 264 struct sbni_softc *sc; 265 struct ifnet *ifp; 266 int s; 267 268 sc = (struct sbni_softc *)xsc; 269 ifp = &sc->arpcom.ac_if; 270 271 /* address not known */ 272 if (TAILQ_EMPTY(&ifp->if_addrhead)) 273 return; 274 275 /* 276 * kludge to avoid multiple initialization when more than once 277 * protocols configured 278 */ 279 if (ifp->if_flags & IFF_RUNNING) 280 return; 281 282 s = splimp(); 283 ifp->if_timer = 0; 284 card_start(sc); 285 sc->wch = timeout(sbni_timeout, sc, hz/SBNI_HZ); 286 287 ifp->if_flags |= IFF_RUNNING; 288 ifp->if_flags &= ~IFF_OACTIVE; 289 290 /* attempt to start output */ 291 sbni_start(ifp); 292 splx(s); 293} 294 295 296static void 297sbni_start(struct ifnet *ifp) 298{ 299 struct sbni_softc *sc = ifp->if_softc; 300 if (sc->tx_frameno == 0) 301 prepare_to_send(sc); 302} 303 304 305static void 306sbni_stop(struct sbni_softc *sc) 307{ 308 sbni_outb(sc, CSR0, 0); 309 drop_xmit_queue(sc); 310 311 if (sc->rx_buf_p) { 312 m_freem(sc->rx_buf_p); 313 sc->rx_buf_p = NULL; 314 } 315 316 untimeout(sbni_timeout, sc, sc->wch); 317 sc->wch.callout = NULL; 318} 319 320/* -------------------------------------------------------------------------- */ 321 322/* interrupt handler */ 323 324/* 325 * SBNI12D-10, -11/ISA boards within "common interrupt" mode could not 326 * be looked as two independent single-channel devices. Every channel seems 327 * as Ethernet interface but interrupt handler must be common. Really, first 328 * channel ("master") driver only registers the handler. In it's struct softc 329 * it has got pointer to "slave" channel's struct softc and handles that's 330 * interrupts too. 331 * softc of successfully attached ISA SBNI boards is linked to list. 332 * While next board driver is initialized, it scans this list. If one 333 * has found softc with same irq and ioaddr different by 4 then it assumes 334 * this board to be "master". 335 */ 336 337void 338sbni_intr(void *arg) 339{ 340 struct sbni_softc *sc; 341 int repeat; 342 343 sc = (struct sbni_softc *)arg; 344 345 do { 346 repeat = 0; 347 if (sbni_inb(sc, CSR0) & (RC_RDY | TR_RDY)) { 348 handle_channel(sc); 349 repeat = 1; 350 } 351 if (sc->slave_sc && /* second channel present */ 352 (sbni_inb(sc->slave_sc, CSR0) & (RC_RDY | TR_RDY))) { 353 handle_channel(sc->slave_sc); 354 repeat = 1; 355 } 356 } while (repeat); 357} 358 359 360static void 361handle_channel(struct sbni_softc *sc) 362{ 363 int req_ans; 364 u_char csr0; 365 366 sbni_outb(sc, CSR0, (sbni_inb(sc, CSR0) & ~EN_INT) | TR_REQ); 367 368 sc->timer_ticks = CHANGE_LEVEL_START_TICKS; 369 for (;;) { 370 csr0 = sbni_inb(sc, CSR0); 371 if ((csr0 & (RC_RDY | TR_RDY)) == 0) 372 break; 373 374 req_ans = !(sc->state & FL_PREV_OK); 375 376 if (csr0 & RC_RDY) 377 req_ans = recv_frame(sc); 378 379 /* 380 * TR_RDY always equals 1 here because we have owned the marker, 381 * and we set TR_REQ when disabled interrupts 382 */ 383 csr0 = sbni_inb(sc, CSR0); 384 if ((csr0 & TR_RDY) == 0 || (csr0 & RC_RDY) != 0) 385 printf("sbni: internal error!\n"); 386 387 /* if state & FL_NEED_RESEND != 0 then tx_frameno != 0 */ 388 if (req_ans || sc->tx_frameno != 0) 389 send_frame(sc); 390 else { 391 /* send the marker without any data */ 392 sbni_outb(sc, CSR0, sbni_inb(sc, CSR0) & ~TR_REQ); 393 } 394 } 395 396 sbni_outb(sc, CSR0, sbni_inb(sc, CSR0) | EN_INT); 397} 398 399 400/* 401 * Routine returns 1 if it need to acknoweledge received frame. 402 * Empty frame received without errors won't be acknoweledged. 403 */ 404 405static int 406recv_frame(struct sbni_softc *sc) 407{ 408 u_int32_t crc; 409 u_int framelen, frameno, ack; 410 u_int is_first, frame_ok; 411 412 crc = CRC32_INITIAL; 413 if (check_fhdr(sc, &framelen, &frameno, &ack, &is_first, &crc)) { 414 frame_ok = framelen > 4 ? 415 upload_data(sc, framelen, frameno, is_first, crc) : 416 skip_tail(sc, framelen, crc); 417 if (frame_ok) 418 interpret_ack(sc, ack); 419 } else 420 frame_ok = 0; 421 422 sbni_outb(sc, CSR0, sbni_inb(sc, CSR0) ^ CT_ZER); 423 if (frame_ok) { 424 sc->state |= FL_PREV_OK; 425 if (framelen > 4) 426 sc->in_stats.all_rx_number++; 427 } else { 428 sc->state &= ~FL_PREV_OK; 429 change_level(sc); 430 sc->in_stats.all_rx_number++; 431 sc->in_stats.bad_rx_number++; 432 } 433 434 return (!frame_ok || framelen > 4); 435} 436 437 438static void 439send_frame(struct sbni_softc *sc) 440{ 441 u_int32_t crc; 442 u_char csr0; 443 444 crc = CRC32_INITIAL; 445 if (sc->state & FL_NEED_RESEND) { 446 447 /* if frame was sended but not ACK'ed - resend it */ 448 if (sc->trans_errors) { 449 sc->trans_errors--; 450 if (sc->framelen != 0) 451 sc->in_stats.resend_tx_number++; 452 } else { 453 /* cannot xmit with many attempts */ 454 drop_xmit_queue(sc); 455 goto do_send; 456 } 457 } else 458 sc->trans_errors = TR_ERROR_COUNT; 459 460 send_frame_header(sc, &crc); 461 sc->state |= FL_NEED_RESEND; 462 /* 463 * FL_NEED_RESEND will be cleared after ACK, but if empty 464 * frame sended then in prepare_to_send next frame 465 */ 466 467 468 if (sc->framelen) { 469 download_data(sc, &crc); 470 sc->in_stats.all_tx_number++; 471 sc->state |= FL_WAIT_ACK; 472 } 473 474 sbni_outsb(sc, (u_char *)&crc, sizeof crc); 475 476do_send: 477 csr0 = sbni_inb(sc, CSR0); 478 sbni_outb(sc, CSR0, csr0 & ~TR_REQ); 479 480 if (sc->tx_frameno) { 481 /* next frame exists - request to send */ 482 sbni_outb(sc, CSR0, csr0 | TR_REQ); 483 } 484} 485 486 487static void 488download_data(struct sbni_softc *sc, u_int32_t *crc_p) 489{ 490 struct mbuf *m; 491 caddr_t data_p; 492 u_int data_len, pos, slice; 493 494 data_p = NULL; /* initialized to avoid warn */ 495 pos = 0; 496 497 for (m = sc->tx_buf_p; m != NULL && pos < sc->pktlen; m = m->m_next) { 498 if (pos + m->m_len > sc->outpos) { 499 data_len = m->m_len - (sc->outpos - pos); 500 data_p = mtod(m, caddr_t) + (sc->outpos - pos); 501 502 goto do_copy; 503 } else 504 pos += m->m_len; 505 } 506 507 data_len = 0; 508 509do_copy: 510 pos = 0; 511 do { 512 if (data_len) { 513 slice = min(data_len, sc->framelen - pos); 514 sbni_outsb(sc, data_p, slice); 515 *crc_p = calc_crc32(*crc_p, data_p, slice); 516 517 pos += slice; 518 if (data_len -= slice) 519 data_p += slice; 520 else { 521 do { 522 m = m->m_next; 523 } while (m != NULL && m->m_len == 0); 524 525 if (m) { 526 data_len = m->m_len; 527 data_p = mtod(m, caddr_t); 528 } 529 } 530 } else { 531 /* frame too short - zero padding */ 532 533 pos = sc->framelen - pos; 534 while (pos--) { 535 sbni_outb(sc, DAT, 0); 536 *crc_p = CRC32(0, *crc_p); 537 } 538 return; 539 } 540 } while (pos < sc->framelen); 541} 542 543 544static int 545upload_data(struct sbni_softc *sc, u_int framelen, u_int frameno, 546 u_int is_first, u_int32_t crc) 547{ 548 int frame_ok; 549 550 if (is_first) { 551 sc->wait_frameno = frameno; 552 sc->inppos = 0; 553 } 554 555 if (sc->wait_frameno == frameno) { 556 557 if (sc->inppos + framelen <= ETHER_MAX_LEN) { 558 frame_ok = append_frame_to_pkt(sc, framelen, crc); 559 560 /* 561 * if CRC is right but framelen incorrect then transmitter 562 * error was occured... drop entire packet 563 */ 564 } else if ((frame_ok = skip_tail(sc, framelen, crc)) != 0) { 565 sc->wait_frameno = 0; 566 sc->inppos = 0; 567 sc->arpcom.ac_if.if_ierrors++; 568 /* now skip all frames until is_first != 0 */ 569 } 570 } else 571 frame_ok = skip_tail(sc, framelen, crc); 572 573 if (is_first && !frame_ok) { 574 /* 575 * Frame has been violated, but we have stored 576 * is_first already... Drop entire packet. 577 */ 578 sc->wait_frameno = 0; 579 sc->arpcom.ac_if.if_ierrors++; 580 } 581 582 return (frame_ok); 583} 584 585 586static __inline void send_complete(struct sbni_softc *); 587 588static __inline void 589send_complete(struct sbni_softc *sc) 590{ 591 m_freem(sc->tx_buf_p); 592 sc->tx_buf_p = NULL; 593 sc->arpcom.ac_if.if_opackets++; 594} 595 596 597static void 598interpret_ack(struct sbni_softc *sc, u_int ack) 599{ 600 if (ack == FRAME_SENT_OK) { 601 sc->state &= ~FL_NEED_RESEND; 602 603 if (sc->state & FL_WAIT_ACK) { 604 sc->outpos += sc->framelen; 605 606 if (--sc->tx_frameno) { 607 sc->framelen = min( 608 sc->maxframe, sc->pktlen - sc->outpos); 609 } else { 610 send_complete(sc); 611 prepare_to_send(sc); 612 } 613 } 614 } 615 616 sc->state &= ~FL_WAIT_ACK; 617} 618 619 620/* 621 * Glue received frame with previous fragments of packet. 622 * Indicate packet when last frame would be accepted. 623 */ 624 625static int 626append_frame_to_pkt(struct sbni_softc *sc, u_int framelen, u_int32_t crc) 627{ 628 caddr_t p; 629 630 if (sc->inppos + framelen > ETHER_MAX_LEN) 631 return (0); 632 633 if (!sc->rx_buf_p && !get_rx_buf(sc)) 634 return (0); 635 636 p = sc->rx_buf_p->m_data + sc->inppos; 637 sbni_insb(sc, p, framelen); 638 if (calc_crc32(crc, p, framelen) != CRC32_REMAINDER) 639 return (0); 640 641 sc->inppos += framelen - 4; 642 if (--sc->wait_frameno == 0) { /* last frame received */ 643 indicate_pkt(sc); 644 sc->arpcom.ac_if.if_ipackets++; 645 } 646 647 return (1); 648} 649 650 651/* 652 * Prepare to start output on adapter. Current priority must be set to splimp 653 * before this routine is called. 654 * Transmitter will be actually activated when marker has been accepted. 655 */ 656 657static void 658prepare_to_send(struct sbni_softc *sc) 659{ 660 struct mbuf *m; 661 u_int len; 662 663 /* sc->tx_buf_p == NULL here! */ 664 if (sc->tx_buf_p) 665 printf("sbni: memory leak!\n"); 666 667 sc->outpos = 0; 668 sc->state &= ~(FL_WAIT_ACK | FL_NEED_RESEND); 669 670 for (;;) { 671 IF_DEQUEUE(&sc->arpcom.ac_if.if_snd, sc->tx_buf_p); 672 if (!sc->tx_buf_p) { 673 /* nothing to transmit... */ 674 sc->pktlen = 0; 675 sc->tx_frameno = 0; 676 sc->framelen = 0; 677 sc->arpcom.ac_if.if_flags &= ~IFF_OACTIVE; 678 return; 679 } 680 681 for (len = 0, m = sc->tx_buf_p; m; m = m->m_next) 682 len += m->m_len; 683 684 if (len != 0) 685 break; 686 m_freem(sc->tx_buf_p); 687 } 688 689 if (len < SBNI_MIN_LEN) 690 len = SBNI_MIN_LEN; 691 692 sc->pktlen = len; 693 sc->tx_frameno = (len + sc->maxframe - 1) / sc->maxframe; 694 sc->framelen = min(len, sc->maxframe); 695 696 sbni_outb(sc, CSR0, sbni_inb(sc, CSR0) | TR_REQ); 697 sc->arpcom.ac_if.if_flags |= IFF_OACTIVE; 698 BPF_MTAP(&sc->arpcom.ac_if, sc->tx_buf_p); 699} 700 701 702static void 703drop_xmit_queue(struct sbni_softc *sc) 704{ 705 struct mbuf *m; 706 707 if (sc->tx_buf_p) { 708 m_freem(sc->tx_buf_p); 709 sc->tx_buf_p = NULL; 710 sc->arpcom.ac_if.if_oerrors++; 711 } 712 713 for (;;) { 714 IF_DEQUEUE(&sc->arpcom.ac_if.if_snd, m); 715 if (m == NULL) 716 break; 717 m_freem(m); 718 sc->arpcom.ac_if.if_oerrors++; 719 } 720 721 sc->tx_frameno = 0; 722 sc->framelen = 0; 723 sc->outpos = 0; 724 sc->state &= ~(FL_WAIT_ACK | FL_NEED_RESEND); 725 sc->arpcom.ac_if.if_flags &= ~IFF_OACTIVE; 726} 727 728 729static void 730send_frame_header(struct sbni_softc *sc, u_int32_t *crc_p) 731{ 732 u_int32_t crc; 733 u_int len_field; 734 u_char value; 735 736 crc = *crc_p; 737 len_field = sc->framelen + 6; /* CRC + frameno + reserved */ 738 739 if (sc->state & FL_NEED_RESEND) 740 len_field |= FRAME_RETRY; /* non-first attempt... */ 741 742 if (sc->outpos == 0) 743 len_field |= FRAME_FIRST; 744 745 len_field |= (sc->state & FL_PREV_OK) ? FRAME_SENT_OK : FRAME_SENT_BAD; 746 sbni_outb(sc, DAT, SBNI_SIG); 747 748 value = (u_char)len_field; 749 sbni_outb(sc, DAT, value); 750 crc = CRC32(value, crc); 751 value = (u_char)(len_field >> 8); 752 sbni_outb(sc, DAT, value); 753 crc = CRC32(value, crc); 754 755 sbni_outb(sc, DAT, sc->tx_frameno); 756 crc = CRC32(sc->tx_frameno, crc); 757 sbni_outb(sc, DAT, 0); 758 crc = CRC32(0, crc); 759 *crc_p = crc; 760} 761 762 763/* 764 * if frame tail not needed (incorrect number or received twice), 765 * it won't store, but CRC will be calculated 766 */ 767 768static int 769skip_tail(struct sbni_softc *sc, u_int tail_len, u_int32_t crc) 770{ 771 while (tail_len--) 772 crc = CRC32(sbni_inb(sc, DAT), crc); 773 774 return (crc == CRC32_REMAINDER); 775} 776 777 778static int 779check_fhdr(struct sbni_softc *sc, u_int *framelen, u_int *frameno, 780 u_int *ack, u_int *is_first, u_int32_t *crc_p) 781{ 782 u_int32_t crc; 783 u_char value; 784 785 crc = *crc_p; 786 if (sbni_inb(sc, DAT) != SBNI_SIG) 787 return (0); 788 789 value = sbni_inb(sc, DAT); 790 *framelen = (u_int)value; 791 crc = CRC32(value, crc); 792 value = sbni_inb(sc, DAT); 793 *framelen |= ((u_int)value) << 8; 794 crc = CRC32(value, crc); 795 796 *ack = *framelen & FRAME_ACK_MASK; 797 *is_first = (*framelen & FRAME_FIRST) != 0; 798 799 if ((*framelen &= FRAME_LEN_MASK) < 6 || *framelen > SBNI_MAX_FRAME - 3) 800 return (0); 801 802 value = sbni_inb(sc, DAT); 803 *frameno = (u_int)value; 804 crc = CRC32(value, crc); 805 806 crc = CRC32(sbni_inb(sc, DAT), crc); /* reserved byte */ 807 *framelen -= 2; 808 809 *crc_p = crc; 810 return (1); 811} 812 813 814static int 815get_rx_buf(struct sbni_softc *sc) 816{ 817 struct mbuf *m; 818 819 MGETHDR(m, M_DONTWAIT, MT_DATA); 820 if (m == NULL) { 821 if_printf(&sc->arpcom.ac_if, "cannot allocate header mbuf\n"); 822 return (0); 823 } 824 825 /* 826 * We always put the received packet in a single buffer - 827 * either with just an mbuf header or in a cluster attached 828 * to the header. The +2 is to compensate for the alignment 829 * fixup below. 830 */ 831 if (ETHER_MAX_LEN + 2 > MHLEN) { 832 /* Attach an mbuf cluster */ 833 MCLGET(m, M_DONTWAIT); 834 if ((m->m_flags & M_EXT) == 0) { 835 m_freem(m); 836 return (0); 837 } 838 } 839 m->m_pkthdr.len = m->m_len = ETHER_MAX_LEN + 2; 840 841 /* 842 * The +2 is to longword align the start of the real packet. 843 * (sizeof ether_header == 14) 844 * This is important for NFS. 845 */ 846 m_adj(m, 2); 847 sc->rx_buf_p = m; 848 return (1); 849} 850 851 852static void 853indicate_pkt(struct sbni_softc *sc) 854{ 855 struct ifnet *ifp = &sc->arpcom.ac_if; 856 struct mbuf *m; 857 858 m = sc->rx_buf_p; 859 m->m_pkthdr.rcvif = ifp; 860 m->m_pkthdr.len = m->m_len = sc->inppos; 861 862 (*ifp->if_input)(ifp, m); 863 sc->rx_buf_p = NULL; 864} 865 866/* -------------------------------------------------------------------------- */ 867 868/* 869 * Routine checks periodically wire activity and regenerates marker if 870 * connect was inactive for a long time. 871 */ 872 873static void 874sbni_timeout(void *xsc) 875{ 876 struct sbni_softc *sc; 877 int s; 878 u_char csr0; 879 880 sc = (struct sbni_softc *)xsc; 881 s = splimp(); 882 883 csr0 = sbni_inb(sc, CSR0); 884 if (csr0 & RC_CHK) { 885 886 if (sc->timer_ticks) { 887 if (csr0 & (RC_RDY | BU_EMP)) 888 /* receiving not active */ 889 sc->timer_ticks--; 890 } else { 891 sc->in_stats.timeout_number++; 892 if (sc->delta_rxl) 893 timeout_change_level(sc); 894 895 sbni_outb(sc, CSR1, *(u_char *)&sc->csr1 | PR_RES); 896 csr0 = sbni_inb(sc, CSR0); 897 } 898 } 899 900 sbni_outb(sc, CSR0, csr0 | RC_CHK); 901 sc->wch = timeout(sbni_timeout, sc, hz/SBNI_HZ); 902 splx(s); 903} 904 905/* -------------------------------------------------------------------------- */ 906 907static void 908card_start(struct sbni_softc *sc) 909{ 910 sc->timer_ticks = CHANGE_LEVEL_START_TICKS; 911 sc->state &= ~(FL_WAIT_ACK | FL_NEED_RESEND); 912 sc->state |= FL_PREV_OK; 913 914 sc->inppos = 0; 915 sc->wait_frameno = 0; 916 917 sbni_outb(sc, CSR1, *(u_char *)&sc->csr1 | PR_RES); 918 sbni_outb(sc, CSR0, EN_INT); 919} 920 921/* -------------------------------------------------------------------------- */ 922 923/* 924 * Device timeout/watchdog routine. Entered if the device neglects to 925 * generate an interrupt after a transmit has been started on it. 926 */ 927 928static void 929sbni_watchdog(struct ifnet *ifp) 930{ 931 log(LOG_ERR, "sbni%d: device timeout\n", ifp->if_unit); 932 ifp->if_oerrors++; 933} 934 935 936static u_char rxl_tab[] = { 937 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x08, 938 0x0a, 0x0c, 0x0f, 0x16, 0x18, 0x1a, 0x1c, 0x1f 939}; 940 941#define SIZE_OF_TIMEOUT_RXL_TAB 4 942static u_char timeout_rxl_tab[] = { 943 0x03, 0x05, 0x08, 0x0b 944}; 945 946static void 947set_initial_values(struct sbni_softc *sc, struct sbni_flags flags) 948{ 949 if (flags.fixed_rxl) { 950 sc->delta_rxl = 0; /* disable receive level autodetection */ 951 sc->cur_rxl_index = flags.rxl; 952 } else { 953 sc->delta_rxl = DEF_RXL_DELTA; 954 sc->cur_rxl_index = DEF_RXL; 955 } 956 957 sc->csr1.rate = flags.fixed_rate ? flags.rate : DEFAULT_RATE; 958 sc->csr1.rxl = rxl_tab[sc->cur_rxl_index]; 959 sc->maxframe = DEFAULT_FRAME_LEN; 960 961 /* 962 * generate Ethernet address (0x00ff01xxxxxx) 963 */ 964 *(u_int16_t *) sc->arpcom.ac_enaddr = htons(0x00ff); 965 if (flags.mac_addr) { 966 *(u_int32_t *) (sc->arpcom.ac_enaddr + 2) = 967 htonl(flags.mac_addr | 0x01000000); 968 } else { 969 *(u_char *) (sc->arpcom.ac_enaddr + 2) = 0x01; 970 read_random(sc->arpcom.ac_enaddr + 3, 3); 971 } 972} 973 974 975#ifdef SBNI_DUAL_COMPOUND 976 977struct sbni_softc * 978connect_to_master(struct sbni_softc *sc) 979{ 980 struct sbni_softc *p, *p_prev; 981 982 for (p = sbni_headlist, p_prev = NULL; p; p_prev = p, p = p->link) { 983 if (rman_get_start(p->io_res) == rman_get_start(sc->io_res) + 4 || 984 rman_get_start(p->io_res) == rman_get_start(sc->io_res) - 4) { 985 p->slave_sc = sc; 986 if (p_prev) 987 p_prev->link = p->link; 988 else 989 sbni_headlist = p->link; 990 return p; 991 } 992 } 993 994 return (NULL); 995} 996 997#endif /* SBNI_DUAL_COMPOUND */ 998 999 1000/* Receive level auto-selection */ 1001 1002static void 1003change_level(struct sbni_softc *sc) 1004{ 1005 if (sc->delta_rxl == 0) /* do not auto-negotiate RxL */ 1006 return; 1007 1008 if (sc->cur_rxl_index == 0) 1009 sc->delta_rxl = 1; 1010 else if (sc->cur_rxl_index == 15) 1011 sc->delta_rxl = -1; 1012 else if (sc->cur_rxl_rcvd < sc->prev_rxl_rcvd) 1013 sc->delta_rxl = -sc->delta_rxl; 1014 1015 sc->csr1.rxl = rxl_tab[sc->cur_rxl_index += sc->delta_rxl]; 1016 sbni_inb(sc, CSR0); /* it needed for PCI cards */ 1017 sbni_outb(sc, CSR1, *(u_char *)&sc->csr1); 1018 1019 sc->prev_rxl_rcvd = sc->cur_rxl_rcvd; 1020 sc->cur_rxl_rcvd = 0; 1021} 1022 1023 1024static void 1025timeout_change_level(struct sbni_softc *sc) 1026{ 1027 sc->cur_rxl_index = timeout_rxl_tab[sc->timeout_rxl]; 1028 if (++sc->timeout_rxl >= 4) 1029 sc->timeout_rxl = 0; 1030 1031 sc->csr1.rxl = rxl_tab[sc->cur_rxl_index]; 1032 sbni_inb(sc, CSR0); 1033 sbni_outb(sc, CSR1, *(u_char *)&sc->csr1); 1034 1035 sc->prev_rxl_rcvd = sc->cur_rxl_rcvd; 1036 sc->cur_rxl_rcvd = 0; 1037} 1038 1039/* -------------------------------------------------------------------------- */ 1040 1041/* 1042 * Process an ioctl request. This code needs some work - it looks 1043 * pretty ugly. 1044 */ 1045 1046static int 1047sbni_ioctl(struct ifnet *ifp, u_long command, caddr_t data) 1048{ 1049 struct sbni_softc *sc; 1050 struct ifreq *ifr; 1051 struct thread *td; 1052 struct sbni_in_stats *in_stats; 1053 struct sbni_flags flags; 1054 int error, s; 1055 1056 sc = ifp->if_softc; 1057 ifr = (struct ifreq *)data; 1058 td = curthread; 1059 error = 0; 1060 1061 s = splimp(); 1062 1063 switch (command) { 1064 case SIOCSIFFLAGS: 1065 /* 1066 * If the interface is marked up and stopped, then start it. 1067 * If it is marked down and running, then stop it. 1068 */ 1069 if (ifp->if_flags & IFF_UP) { 1070 if (!(ifp->if_flags & IFF_RUNNING)) 1071 sbni_init(sc); 1072 } else { 1073 if (ifp->if_flags & IFF_RUNNING) { 1074 sbni_stop(sc); 1075 ifp->if_flags &= ~IFF_RUNNING; 1076 } 1077 } 1078 break; 1079 1080 case SIOCADDMULTI: 1081 case SIOCDELMULTI: 1082 /* 1083 * Multicast list has changed; set the hardware filter 1084 * accordingly. 1085 */ 1086 error = 0; 1087 /* if (ifr == NULL) 1088 error = EAFNOSUPPORT; */ 1089 break; 1090 1091 case SIOCSIFMTU: 1092 if (ifr->ifr_mtu > ETHERMTU) 1093 error = EINVAL; 1094 else 1095 ifp->if_mtu = ifr->ifr_mtu; 1096 break; 1097 1098 /* 1099 * SBNI specific ioctl 1100 */ 1101 case SIOCGHWFLAGS: /* get flags */ 1102 bcopy((caddr_t) sc->arpcom.ac_enaddr+3, (caddr_t) &flags, 3); 1103 flags.rxl = sc->cur_rxl_index; 1104 flags.rate = sc->csr1.rate; 1105 flags.fixed_rxl = (sc->delta_rxl == 0); 1106 flags.fixed_rate = 1; 1107 ifr->ifr_data = *(caddr_t*) &flags; 1108 break; 1109 1110 case SIOCGINSTATS: 1111 in_stats = (struct sbni_in_stats *)ifr->ifr_data; 1112 bcopy((void *)(&(sc->in_stats)), (void *)in_stats, 1113 sizeof(struct sbni_in_stats)); 1114 break; 1115 1116 case SIOCSHWFLAGS: /* set flags */ 1117 /* root only */ 1118 error = suser(td); 1119 if (error) 1120 break; 1121 flags = *(struct sbni_flags*)&ifr->ifr_data; 1122 if (flags.fixed_rxl) { 1123 sc->delta_rxl = 0; 1124 sc->cur_rxl_index = flags.rxl; 1125 } else { 1126 sc->delta_rxl = DEF_RXL_DELTA; 1127 sc->cur_rxl_index = DEF_RXL; 1128 } 1129 sc->csr1.rxl = rxl_tab[sc->cur_rxl_index]; 1130 sc->csr1.rate = flags.fixed_rate ? flags.rate : DEFAULT_RATE; 1131 if (flags.mac_addr) 1132 bcopy((caddr_t) &flags, 1133 (caddr_t) sc->arpcom.ac_enaddr+3, 3); 1134 1135 /* Don't be afraid... */ 1136 sbni_outb(sc, CSR1, *(char*)(&sc->csr1) | PR_RES); 1137 break; 1138 1139 case SIOCRINSTATS: 1140 if (!(error = suser(td))) /* root only */ 1141 bzero(&sc->in_stats, sizeof(struct sbni_in_stats)); 1142 break; 1143 1144 default: 1145 error = ether_ioctl(ifp, command, data); 1146 break; 1147 } 1148 1149 splx(s); 1150 return (error); 1151} 1152 1153/* -------------------------------------------------------------------------- */ 1154 1155#ifdef ASM_CRC 1156 1157static u_int32_t 1158calc_crc32(u_int32_t crc, caddr_t p, u_int len) 1159{ 1160 register u_int32_t _crc __asm ("ax"); 1161 _crc = crc; 1162 1163 __asm __volatile ( 1164 "xorl %%ebx, %%ebx\n" 1165 "movl %1, %%esi\n" 1166 "movl %2, %%ecx\n" 1167 "movl $crc32tab, %%edi\n" 1168 "shrl $2, %%ecx\n" 1169 "jz 1f\n" 1170 1171 ".align 4\n" 1172 "0:\n" 1173 "movb %%al, %%bl\n" 1174 "movl (%%esi), %%edx\n" 1175 "shrl $8, %%eax\n" 1176 "xorb %%dl, %%bl\n" 1177 "shrl $8, %%edx\n" 1178 "xorl (%%edi,%%ebx,4), %%eax\n" 1179 1180 "movb %%al, %%bl\n" 1181 "shrl $8, %%eax\n" 1182 "xorb %%dl, %%bl\n" 1183 "shrl $8, %%edx\n" 1184 "xorl (%%edi,%%ebx,4), %%eax\n" 1185 1186 "movb %%al, %%bl\n" 1187 "shrl $8, %%eax\n" 1188 "xorb %%dl, %%bl\n" 1189 "movb %%dh, %%dl\n" 1190 "xorl (%%edi,%%ebx,4), %%eax\n" 1191 1192 "movb %%al, %%bl\n" 1193 "shrl $8, %%eax\n" 1194 "xorb %%dl, %%bl\n" 1195 "addl $4, %%esi\n" 1196 "xorl (%%edi,%%ebx,4), %%eax\n" 1197 1198 "decl %%ecx\n" 1199 "jnz 0b\n" 1200 1201 "1:\n" 1202 "movl %2, %%ecx\n" 1203 "andl $3, %%ecx\n" 1204 "jz 2f\n" 1205 1206 "movb %%al, %%bl\n" 1207 "shrl $8, %%eax\n" 1208 "xorb (%%esi), %%bl\n" 1209 "xorl (%%edi,%%ebx,4), %%eax\n" 1210 1211 "decl %%ecx\n" 1212 "jz 2f\n" 1213 1214 "movb %%al, %%bl\n" 1215 "shrl $8, %%eax\n" 1216 "xorb 1(%%esi), %%bl\n" 1217 "xorl (%%edi,%%ebx,4), %%eax\n" 1218 1219 "decl %%ecx\n" 1220 "jz 2f\n" 1221 1222 "movb %%al, %%bl\n" 1223 "shrl $8, %%eax\n" 1224 "xorb 2(%%esi), %%bl\n" 1225 "xorl (%%edi,%%ebx,4), %%eax\n" 1226 "2:\n" 1227 : "=a" (_crc) 1228 : "g" (p), "g" (len) 1229 : "bx", "cx", "dx", "si", "di" 1230 ); 1231 1232 return (_crc); 1233} 1234 1235#else /* ASM_CRC */ 1236 1237static u_int32_t 1238calc_crc32(u_int32_t crc, caddr_t p, u_int len) 1239{ 1240 while (len--) 1241 crc = CRC32(*p++, crc); 1242 1243 return (crc); 1244} 1245 1246#endif /* ASM_CRC */ 1247 1248 1249static u_int32_t crc32tab[] __aligned(8) = { 1250 0xD202EF8D, 0xA505DF1B, 0x3C0C8EA1, 0x4B0BBE37, 1251 0xD56F2B94, 0xA2681B02, 0x3B614AB8, 0x4C667A2E, 1252 0xDCD967BF, 0xABDE5729, 0x32D70693, 0x45D03605, 1253 0xDBB4A3A6, 0xACB39330, 0x35BAC28A, 0x42BDF21C, 1254 0xCFB5FFE9, 0xB8B2CF7F, 0x21BB9EC5, 0x56BCAE53, 1255 0xC8D83BF0, 0xBFDF0B66, 0x26D65ADC, 0x51D16A4A, 1256 0xC16E77DB, 0xB669474D, 0x2F6016F7, 0x58672661, 1257 0xC603B3C2, 0xB1048354, 0x280DD2EE, 0x5F0AE278, 1258 0xE96CCF45, 0x9E6BFFD3, 0x0762AE69, 0x70659EFF, 1259 0xEE010B5C, 0x99063BCA, 0x000F6A70, 0x77085AE6, 1260 0xE7B74777, 0x90B077E1, 0x09B9265B, 0x7EBE16CD, 1261 0xE0DA836E, 0x97DDB3F8, 0x0ED4E242, 0x79D3D2D4, 1262 0xF4DBDF21, 0x83DCEFB7, 0x1AD5BE0D, 0x6DD28E9B, 1263 0xF3B61B38, 0x84B12BAE, 0x1DB87A14, 0x6ABF4A82, 1264 0xFA005713, 0x8D076785, 0x140E363F, 0x630906A9, 1265 0xFD6D930A, 0x8A6AA39C, 0x1363F226, 0x6464C2B0, 1266 0xA4DEAE1D, 0xD3D99E8B, 0x4AD0CF31, 0x3DD7FFA7, 1267 0xA3B36A04, 0xD4B45A92, 0x4DBD0B28, 0x3ABA3BBE, 1268 0xAA05262F, 0xDD0216B9, 0x440B4703, 0x330C7795, 1269 0xAD68E236, 0xDA6FD2A0, 0x4366831A, 0x3461B38C, 1270 0xB969BE79, 0xCE6E8EEF, 0x5767DF55, 0x2060EFC3, 1271 0xBE047A60, 0xC9034AF6, 0x500A1B4C, 0x270D2BDA, 1272 0xB7B2364B, 0xC0B506DD, 0x59BC5767, 0x2EBB67F1, 1273 0xB0DFF252, 0xC7D8C2C4, 0x5ED1937E, 0x29D6A3E8, 1274 0x9FB08ED5, 0xE8B7BE43, 0x71BEEFF9, 0x06B9DF6F, 1275 0x98DD4ACC, 0xEFDA7A5A, 0x76D32BE0, 0x01D41B76, 1276 0x916B06E7, 0xE66C3671, 0x7F6567CB, 0x0862575D, 1277 0x9606C2FE, 0xE101F268, 0x7808A3D2, 0x0F0F9344, 1278 0x82079EB1, 0xF500AE27, 0x6C09FF9D, 0x1B0ECF0B, 1279 0x856A5AA8, 0xF26D6A3E, 0x6B643B84, 0x1C630B12, 1280 0x8CDC1683, 0xFBDB2615, 0x62D277AF, 0x15D54739, 1281 0x8BB1D29A, 0xFCB6E20C, 0x65BFB3B6, 0x12B88320, 1282 0x3FBA6CAD, 0x48BD5C3B, 0xD1B40D81, 0xA6B33D17, 1283 0x38D7A8B4, 0x4FD09822, 0xD6D9C998, 0xA1DEF90E, 1284 0x3161E49F, 0x4666D409, 0xDF6F85B3, 0xA868B525, 1285 0x360C2086, 0x410B1010, 0xD80241AA, 0xAF05713C, 1286 0x220D7CC9, 0x550A4C5F, 0xCC031DE5, 0xBB042D73, 1287 0x2560B8D0, 0x52678846, 0xCB6ED9FC, 0xBC69E96A, 1288 0x2CD6F4FB, 0x5BD1C46D, 0xC2D895D7, 0xB5DFA541, 1289 0x2BBB30E2, 0x5CBC0074, 0xC5B551CE, 0xB2B26158, 1290 0x04D44C65, 0x73D37CF3, 0xEADA2D49, 0x9DDD1DDF, 1291 0x03B9887C, 0x74BEB8EA, 0xEDB7E950, 0x9AB0D9C6, 1292 0x0A0FC457, 0x7D08F4C1, 0xE401A57B, 0x930695ED, 1293 0x0D62004E, 0x7A6530D8, 0xE36C6162, 0x946B51F4, 1294 0x19635C01, 0x6E646C97, 0xF76D3D2D, 0x806A0DBB, 1295 0x1E0E9818, 0x6909A88E, 0xF000F934, 0x8707C9A2, 1296 0x17B8D433, 0x60BFE4A5, 0xF9B6B51F, 0x8EB18589, 1297 0x10D5102A, 0x67D220BC, 0xFEDB7106, 0x89DC4190, 1298 0x49662D3D, 0x3E611DAB, 0xA7684C11, 0xD06F7C87, 1299 0x4E0BE924, 0x390CD9B2, 0xA0058808, 0xD702B89E, 1300 0x47BDA50F, 0x30BA9599, 0xA9B3C423, 0xDEB4F4B5, 1301 0x40D06116, 0x37D75180, 0xAEDE003A, 0xD9D930AC, 1302 0x54D13D59, 0x23D60DCF, 0xBADF5C75, 0xCDD86CE3, 1303 0x53BCF940, 0x24BBC9D6, 0xBDB2986C, 0xCAB5A8FA, 1304 0x5A0AB56B, 0x2D0D85FD, 0xB404D447, 0xC303E4D1, 1305 0x5D677172, 0x2A6041E4, 0xB369105E, 0xC46E20C8, 1306 0x72080DF5, 0x050F3D63, 0x9C066CD9, 0xEB015C4F, 1307 0x7565C9EC, 0x0262F97A, 0x9B6BA8C0, 0xEC6C9856, 1308 0x7CD385C7, 0x0BD4B551, 0x92DDE4EB, 0xE5DAD47D, 1309 0x7BBE41DE, 0x0CB97148, 0x95B020F2, 0xE2B71064, 1310 0x6FBF1D91, 0x18B82D07, 0x81B17CBD, 0xF6B64C2B, 1311 0x68D2D988, 0x1FD5E91E, 0x86DCB8A4, 0xF1DB8832, 1312 0x616495A3, 0x1663A535, 0x8F6AF48F, 0xF86DC419, 1313 0x660951BA, 0x110E612C, 0x88073096, 0xFF000000 1314};
|