| .psize 0 | 
| /* | 
|   wanXL serial card driver for Linux | 
|   card firmware part | 
|   | 
|   Copyright (C) 2003 Krzysztof Halasa <khc@pm.waw.pl> | 
|   | 
|   This program is free software; you can redistribute it and/or modify it | 
|   under the terms of version 2 of the GNU General Public License | 
|   as published by the Free Software Foundation. | 
|   | 
|   | 
|   | 
|   | 
|     DPRAM BDs: | 
|     0x000 - 0x050 TX#0    0x050 - 0x140 RX#0 | 
|     0x140 - 0x190 TX#1    0x190 - 0x280 RX#1 | 
|     0x280 - 0x2D0 TX#2    0x2D0 - 0x3C0 RX#2 | 
|     0x3C0 - 0x410 TX#3    0x410 - 0x500 RX#3 | 
|   | 
|   | 
|     000 5FF 1536 Bytes Dual-Port RAM User Data / BDs | 
|     600 6FF 256 Bytes Dual-Port RAM User Data / BDs | 
|     700 7FF 256 Bytes Dual-Port RAM User Data / BDs | 
|     C00 CBF 192 Bytes Dual-Port RAM Parameter RAM Page 1 | 
|     D00 DBF 192 Bytes Dual-Port RAM Parameter RAM Page 2 | 
|     E00 EBF 192 Bytes Dual-Port RAM Parameter RAM Page 3 | 
|     F00 FBF 192 Bytes Dual-Port RAM Parameter RAM Page 4 | 
|   | 
|     local interrupts            level | 
|     NMI                    7 | 
|     PIT timer, CPM (RX/TX complete)        4 | 
|     PCI9060    DMA and PCI doorbells        3 | 
|     Cable - not used            1 | 
| */ | 
|   | 
| #include <linux/hdlc.h> | 
| #include <linux/hdlc/ioctl.h> | 
| #include "wanxl.h" | 
|   | 
| /* memory addresses and offsets */ | 
|   | 
| MAX_RAM_SIZE    = 16 * 1024 * 1024    // max RAM supported by hardware | 
|   | 
| PCI9060_VECTOR    = 0x0000006C | 
| CPM_IRQ_BASE    = 0x40 | 
| ERROR_VECTOR    = CPM_IRQ_BASE * 4 | 
| SCC1_VECTOR    = (CPM_IRQ_BASE + 0x1E) * 4 | 
| SCC2_VECTOR    = (CPM_IRQ_BASE + 0x1D) * 4 | 
| SCC3_VECTOR    = (CPM_IRQ_BASE + 0x1C) * 4 | 
| SCC4_VECTOR    = (CPM_IRQ_BASE + 0x1B) * 4 | 
| CPM_IRQ_LEVEL    = 4 | 
| TIMER_IRQ    = 128 | 
| TIMER_IRQ_LEVEL = 4 | 
| PITR_CONST    = 0x100 + 16        // 1 Hz timer | 
|   | 
| MBAR        = 0x0003FF00 | 
|   | 
| VALUE_WINDOW    = 0x40000000 | 
| ORDER_WINDOW    = 0xC0000000 | 
|   | 
| PLX        = 0xFFF90000 | 
|   | 
| CSRA        = 0xFFFB0000 | 
| CSRB        = 0xFFFB0002 | 
| CSRC        = 0xFFFB0004 | 
| CSRD        = 0xFFFB0006 | 
| STATUS_CABLE_LL        = 0x2000 | 
| STATUS_CABLE_DTR    = 0x1000 | 
|   | 
| DPRBASE        = 0xFFFC0000 | 
|   | 
| SCC1_BASE    = DPRBASE + 0xC00 | 
| MISC_BASE    = DPRBASE + 0xCB0 | 
| SCC2_BASE    = DPRBASE + 0xD00 | 
| SCC3_BASE    = DPRBASE + 0xE00 | 
| SCC4_BASE    = DPRBASE + 0xF00 | 
|   | 
| // offset from SCCx_BASE | 
| // SCC_xBASE contain offsets from DPRBASE and must be divisible by 8 | 
| SCC_RBASE    = 0        // 16-bit RxBD base address | 
| SCC_TBASE    = 2        // 16-bit TxBD base address | 
| SCC_RFCR    = 4        // 8-bit Rx function code | 
| SCC_TFCR    = 5        // 8-bit Tx function code | 
| SCC_MRBLR    = 6        // 16-bit maximum Rx buffer length | 
| SCC_C_MASK    = 0x34        // 32-bit CRC constant | 
| SCC_C_PRES    = 0x38        // 32-bit CRC preset | 
| SCC_MFLR    = 0x46        // 16-bit max Rx frame length (without flags) | 
|   | 
| REGBASE        = DPRBASE + 0x1000 | 
| PICR        = REGBASE + 0x026    // 16-bit periodic irq control | 
| PITR        = REGBASE + 0x02A    // 16-bit periodic irq timing | 
| OR1        = REGBASE + 0x064    // 32-bit RAM bank #1 options | 
| CICR        = REGBASE + 0x540    // 32(24)-bit CP interrupt config | 
| CIMR        = REGBASE + 0x548    // 32-bit CP interrupt mask | 
| CISR        = REGBASE + 0x54C    // 32-bit CP interrupts in-service | 
| PADIR        = REGBASE + 0x550    // 16-bit PortA data direction bitmap | 
| PAPAR        = REGBASE + 0x552    // 16-bit PortA pin assignment bitmap | 
| PAODR        = REGBASE + 0x554    // 16-bit PortA open drain bitmap | 
| PADAT        = REGBASE + 0x556    // 16-bit PortA data register | 
|   | 
| PCDIR        = REGBASE + 0x560    // 16-bit PortC data direction bitmap | 
| PCPAR        = REGBASE + 0x562    // 16-bit PortC pin assignment bitmap | 
| PCSO        = REGBASE + 0x564    // 16-bit PortC special options | 
| PCDAT        = REGBASE + 0x566    // 16-bit PortC data register | 
| PCINT        = REGBASE + 0x568    // 16-bit PortC interrupt control | 
| CR        = REGBASE + 0x5C0    // 16-bit Command register | 
|   | 
| SCC1_REGS    = REGBASE + 0x600 | 
| SCC2_REGS    = REGBASE + 0x620 | 
| SCC3_REGS    = REGBASE + 0x640 | 
| SCC4_REGS    = REGBASE + 0x660 | 
| SICR        = REGBASE + 0x6EC    // 32-bit SI clock route | 
|   | 
| // offset from SCCx_REGS | 
| SCC_GSMR_L    = 0x00    // 32 bits | 
| SCC_GSMR_H    = 0x04    // 32 bits | 
| SCC_PSMR    = 0x08    // 16 bits | 
| SCC_TODR    = 0x0C    // 16 bits | 
| SCC_DSR        = 0x0E    // 16 bits | 
| SCC_SCCE    = 0x10    // 16 bits | 
| SCC_SCCM    = 0x14    // 16 bits | 
| SCC_SCCS    = 0x17    // 8 bits | 
|   | 
| #if QUICC_MEMCPY_USES_PLX | 
|     .macro memcpy_from_pci src, dest, len // len must be < 8 MB | 
|     addl #3, \len | 
|     andl #0xFFFFFFFC, \len        // always copy n * 4 bytes | 
|     movel \src, PLX_DMA_0_PCI | 
|     movel \dest, PLX_DMA_0_LOCAL | 
|     movel \len, PLX_DMA_0_LENGTH | 
|     movel #0x0103, PLX_DMA_CMD_STS    // start channel 0 transfer | 
|     bsr memcpy_from_pci_run | 
|     .endm | 
|   | 
|     .macro memcpy_to_pci src, dest, len | 
|     addl #3, \len | 
|     andl #0xFFFFFFFC, \len        // always copy n * 4 bytes | 
|     movel \src, PLX_DMA_1_LOCAL | 
|     movel \dest, PLX_DMA_1_PCI | 
|     movel \len, PLX_DMA_1_LENGTH | 
|     movel #0x0301, PLX_DMA_CMD_STS    // start channel 1 transfer | 
|     bsr memcpy_to_pci_run | 
|     .endm | 
|   | 
| #else | 
|   | 
|     .macro memcpy src, dest, len    // len must be < 65536 bytes | 
|     movel %d7, -(%sp)        // src and dest must be < 256 MB | 
|     movel \len, %d7            // bits 0 and 1 | 
|     lsrl #2, \len | 
|     andl \len, \len | 
|     beq 99f                // only 0 - 3 bytes | 
|     subl #1, \len            // for dbf | 
| 98:    movel (\src)+, (\dest)+ | 
|     dbfw \len, 98b | 
| 99:    movel %d7, \len | 
|     btstl #1, \len | 
|     beq 99f | 
|     movew (\src)+, (\dest)+ | 
| 99:    btstl #0, \len | 
|     beq 99f | 
|     moveb (\src)+, (\dest)+ | 
| 99: | 
|     movel (%sp)+, %d7 | 
|     .endm | 
|   | 
|     .macro memcpy_from_pci src, dest, len | 
|     addl #VALUE_WINDOW, \src | 
|     memcpy \src, \dest, \len | 
|     .endm | 
|   | 
|     .macro memcpy_to_pci src, dest, len | 
|     addl #VALUE_WINDOW, \dest | 
|     memcpy \src, \dest, \len | 
|     .endm | 
| #endif | 
|   | 
|   | 
|     .macro wait_for_command | 
| 99:    btstl #0, CR | 
|     bne 99b | 
|     .endm | 
|   | 
|   | 
|   | 
|   | 
| /****************************** card initialization *******************/ | 
|     .text | 
|     .global _start | 
| _start:    bra init | 
|   | 
|     .org _start + 4 | 
| ch_status_addr:    .long 0, 0, 0, 0 | 
| rx_descs_addr:    .long 0 | 
|   | 
| init: | 
| #if DETECT_RAM | 
|     movel OR1, %d0 | 
|     andl #0xF00007FF, %d0        // mask AMxx bits | 
|     orl #0xFFFF800 & ~(MAX_RAM_SIZE - 1), %d0 // update RAM bank size | 
|     movel %d0, OR1 | 
| #endif | 
|   | 
|     addl #VALUE_WINDOW, rx_descs_addr // PCI addresses of shared data | 
|     clrl %d0            // D0 = 4 * port | 
| init_1:    tstl ch_status_addr(%d0) | 
|     beq init_2 | 
|     addl #VALUE_WINDOW, ch_status_addr(%d0) | 
| init_2:    addl #4, %d0 | 
|     cmpl #4 * 4, %d0 | 
|     bne init_1 | 
|   | 
|     movel #pci9060_interrupt, PCI9060_VECTOR | 
|     movel #error_interrupt, ERROR_VECTOR | 
|     movel #port_interrupt_1, SCC1_VECTOR | 
|     movel #port_interrupt_2, SCC2_VECTOR | 
|     movel #port_interrupt_3, SCC3_VECTOR | 
|     movel #port_interrupt_4, SCC4_VECTOR | 
|     movel #timer_interrupt, TIMER_IRQ * 4 | 
|   | 
|     movel #0x78000000, CIMR        // only SCCx IRQs from CPM | 
|     movew #(TIMER_IRQ_LEVEL << 8) + TIMER_IRQ, PICR    // interrupt from PIT | 
|     movew #PITR_CONST, PITR | 
|   | 
|     // SCC1=SCCa SCC2=SCCb SCC3=SCCc SCC4=SCCd prio=4 HP=-1 IRQ=64-79 | 
|     movel #0xD41F40 + (CPM_IRQ_LEVEL << 13), CICR | 
|     movel #0x543, PLX_DMA_0_MODE    // 32-bit, Ready, Burst, IRQ | 
|     movel #0x543, PLX_DMA_1_MODE | 
|     movel #0x0, PLX_DMA_0_DESC    // from PCI to local | 
|     movel #0x8, PLX_DMA_1_DESC    // from local to PCI | 
|     movel #0x101, PLX_DMA_CMD_STS    // enable both DMA channels | 
|     // enable local IRQ, DMA, doorbells and PCI IRQ | 
|     orl #0x000F0300, PLX_INTERRUPT_CS | 
|   | 
| #if DETECT_RAM | 
|     bsr ram_test | 
| #else | 
|     movel #1, PLX_MAILBOX_5        // non-zero value = init complete | 
| #endif | 
|     bsr check_csr | 
|   | 
|     movew #0xFFFF, PAPAR        // all pins are clocks/data | 
|     clrw PADIR            // first function | 
|     clrw PCSO            // CD and CTS always active | 
|   | 
|   | 
| /****************************** main loop *****************************/ | 
|   | 
| main:    movel channel_stats, %d7    // D7 = doorbell + irq status | 
|     clrl channel_stats | 
|   | 
|     tstl %d7 | 
|     bne main_1 | 
|     // nothing to do - wait for next event | 
|     stop #0x2200            // supervisor + IRQ level 2 | 
|     movew #0x2700, %sr        // disable IRQs again | 
|     bra main | 
|   | 
| main_1:    clrl %d0            // D0 = 4 * port | 
|     clrl %d6            // D6 = doorbell to host value | 
|   | 
| main_l: btstl #DOORBELL_TO_CARD_CLOSE_0, %d7 | 
|     beq main_op | 
|     bclrl #DOORBELL_TO_CARD_OPEN_0, %d7 // in case both bits are set | 
|     bsr close_port | 
| main_op: | 
|     btstl #DOORBELL_TO_CARD_OPEN_0, %d7 | 
|     beq main_cl | 
|     bsr open_port | 
| main_cl: | 
|     btstl #DOORBELL_TO_CARD_TX_0, %d7 | 
|     beq main_txend | 
|     bsr tx | 
| main_txend: | 
|     btstl #TASK_SCC_0, %d7 | 
|     beq main_next | 
|     bsr tx_end | 
|     bsr rx | 
|   | 
| main_next: | 
|     lsrl #1, %d7            // port status for next port | 
|     addl #4, %d0            // D0 = 4 * next port | 
|     cmpl #4 * 4, %d0 | 
|     bne main_l | 
|     movel %d6, PLX_DOORBELL_FROM_CARD // signal the host | 
|     bra main | 
|   | 
|   | 
| /****************************** open port *****************************/ | 
|   | 
| open_port:                // D0 = 4 * port, D6 = doorbell to host | 
|     movel ch_status_addr(%d0), %a0    // A0 = port status address | 
|     tstl STATUS_OPEN(%a0) | 
|     bne open_port_ret        // port already open | 
|     movel #1, STATUS_OPEN(%a0)    // confirm the port is open | 
| // setup BDs | 
|     clrl tx_in(%d0) | 
|     clrl tx_out(%d0) | 
|     clrl tx_count(%d0) | 
|     clrl rx_in(%d0) | 
|   | 
|     movel SICR, %d1            // D1 = clock settings in SICR | 
|     andl clocking_mask(%d0), %d1 | 
|     cmpl #CLOCK_TXFROMRX, STATUS_CLOCKING(%a0) | 
|     bne open_port_clock_ext | 
|     orl clocking_txfromrx(%d0), %d1 | 
|     bra open_port_set_clock | 
|   | 
| open_port_clock_ext: | 
|     orl clocking_ext(%d0), %d1 | 
| open_port_set_clock: | 
|     movel %d1, SICR            // update clock settings in SICR | 
|   | 
|     orw #STATUS_CABLE_DTR, csr_output(%d0)    // DTR on | 
|     bsr check_csr            // call with disabled timer interrupt | 
|   | 
| // Setup TX descriptors | 
|     movel first_buffer(%d0), %d1    // D1 = starting buffer address | 
|     movel tx_first_bd(%d0), %a1    // A1 = starting TX BD address | 
|     movel #TX_BUFFERS - 2, %d2    // D2 = TX_BUFFERS - 1 counter | 
|     movel #0x18000000, %d3        // D3 = initial TX BD flags: Int + Last | 
|     cmpl #PARITY_NONE, STATUS_PARITY(%a0) | 
|     beq open_port_tx_loop | 
|     bsetl #26, %d3            // TX BD flag: Transmit CRC | 
| open_port_tx_loop: | 
|     movel %d3, (%a1)+        // TX flags + length | 
|     movel %d1, (%a1)+        // buffer address | 
|     addl #BUFFER_LENGTH, %d1 | 
|     dbfw %d2, open_port_tx_loop | 
|   | 
|     bsetl #29, %d3            // TX BD flag: Wrap (last BD) | 
|     movel %d3, (%a1)+        // Final TX flags + length | 
|     movel %d1, (%a1)+        // buffer address | 
|   | 
| // Setup RX descriptors            // A1 = starting RX BD address | 
|     movel #RX_BUFFERS - 2, %d2    // D2 = RX_BUFFERS - 1 counter | 
| open_port_rx_loop: | 
|     movel #0x90000000, (%a1)+    // RX flags + length | 
|     movel %d1, (%a1)+        // buffer address | 
|     addl #BUFFER_LENGTH, %d1 | 
|     dbfw %d2, open_port_rx_loop | 
|   | 
|     movel #0xB0000000, (%a1)+    // Final RX flags + length | 
|     movel %d1, (%a1)+        // buffer address | 
|   | 
| // Setup port parameters | 
|     movel scc_base_addr(%d0), %a1    // A1 = SCC_BASE address | 
|     movel scc_reg_addr(%d0), %a2    // A2 = SCC_REGS address | 
|   | 
|     movel #0xFFFF, SCC_SCCE(%a2)    // clear status bits | 
|     movel #0x0000, SCC_SCCM(%a2)    // interrupt mask | 
|   | 
|     movel tx_first_bd(%d0), %d1 | 
|     movew %d1, SCC_TBASE(%a1)    // D1 = offset of first TxBD | 
|     addl #TX_BUFFERS * 8, %d1 | 
|     movew %d1, SCC_RBASE(%a1)    // D1 = offset of first RxBD | 
|     moveb #0x8, SCC_RFCR(%a1)    // Intel mode, 1000 | 
|     moveb #0x8, SCC_TFCR(%a1) | 
|   | 
| // Parity settings | 
|     cmpl #PARITY_CRC16_PR1_CCITT, STATUS_PARITY(%a0) | 
|     bne open_port_parity_1 | 
|     clrw SCC_PSMR(%a2)        // CRC16-CCITT | 
|     movel #0xF0B8, SCC_C_MASK(%a1) | 
|     movel #0xFFFF, SCC_C_PRES(%a1) | 
|     movew #HDLC_MAX_MRU + 2, SCC_MFLR(%a1) // 2 bytes for CRC | 
|     movew #2, parity_bytes(%d0) | 
|     bra open_port_2 | 
|   | 
| open_port_parity_1: | 
|     cmpl #PARITY_CRC32_PR1_CCITT, STATUS_PARITY(%a0) | 
|     bne open_port_parity_2 | 
|     movew #0x0800, SCC_PSMR(%a2)    // CRC32-CCITT | 
|     movel #0xDEBB20E3, SCC_C_MASK(%a1) | 
|     movel #0xFFFFFFFF, SCC_C_PRES(%a1) | 
|     movew #HDLC_MAX_MRU + 4, SCC_MFLR(%a1) // 4 bytes for CRC | 
|     movew #4, parity_bytes(%d0) | 
|     bra open_port_2 | 
|   | 
| open_port_parity_2: | 
|     cmpl #PARITY_CRC16_PR0_CCITT, STATUS_PARITY(%a0) | 
|     bne open_port_parity_3 | 
|     clrw SCC_PSMR(%a2)        // CRC16-CCITT preset 0 | 
|     movel #0xF0B8, SCC_C_MASK(%a1) | 
|     clrl SCC_C_PRES(%a1) | 
|     movew #HDLC_MAX_MRU + 2, SCC_MFLR(%a1) // 2 bytes for CRC | 
|     movew #2, parity_bytes(%d0) | 
|     bra open_port_2 | 
|   | 
| open_port_parity_3: | 
|     cmpl #PARITY_CRC32_PR0_CCITT, STATUS_PARITY(%a0) | 
|     bne open_port_parity_4 | 
|     movew #0x0800, SCC_PSMR(%a2)    // CRC32-CCITT preset 0 | 
|     movel #0xDEBB20E3, SCC_C_MASK(%a1) | 
|     clrl SCC_C_PRES(%a1) | 
|     movew #HDLC_MAX_MRU + 4, SCC_MFLR(%a1) // 4 bytes for CRC | 
|     movew #4, parity_bytes(%d0) | 
|     bra open_port_2 | 
|   | 
| open_port_parity_4: | 
|     clrw SCC_PSMR(%a2)        // no parity | 
|     movel #0xF0B8, SCC_C_MASK(%a1) | 
|     movel #0xFFFF, SCC_C_PRES(%a1) | 
|     movew #HDLC_MAX_MRU, SCC_MFLR(%a1) // 0 bytes for CRC | 
|     clrw parity_bytes(%d0) | 
|   | 
| open_port_2: | 
|     movel #0x00000003, SCC_GSMR_H(%a2) // RTSM | 
|     cmpl #ENCODING_NRZI, STATUS_ENCODING(%a0) | 
|     bne open_port_nrz | 
|     movel #0x10040900, SCC_GSMR_L(%a2) // NRZI: TCI Tend RECN+TENC=1 | 
|     bra open_port_3 | 
|   | 
| open_port_nrz: | 
|     movel #0x10040000, SCC_GSMR_L(%a2) // NRZ: TCI Tend RECN+TENC=0 | 
| open_port_3: | 
|     movew #BUFFER_LENGTH, SCC_MRBLR(%a1) | 
|     movel %d0, %d1 | 
|     lsll #4, %d1            // D1 bits 7 and 6 = port | 
|     orl #1, %d1 | 
|     movew %d1, CR            // Init SCC RX and TX params | 
|     wait_for_command | 
|   | 
|     // TCI Tend ENR ENT | 
|     movew #0x001F, SCC_SCCM(%a2)    // TXE RXF BSY TXB RXB interrupts | 
|     orl #0x00000030, SCC_GSMR_L(%a2) // enable SCC | 
| open_port_ret: | 
|     rts | 
|   | 
|   | 
| /****************************** close port ****************************/ | 
|   | 
| close_port:                // D0 = 4 * port, D6 = doorbell to host | 
|     movel scc_reg_addr(%d0), %a0    // A0 = SCC_REGS address | 
|     clrw SCC_SCCM(%a0)        // no SCC interrupts | 
|     andl #0xFFFFFFCF, SCC_GSMR_L(%a0) // Disable ENT and ENR | 
|   | 
|     andw #~STATUS_CABLE_DTR, csr_output(%d0) // DTR off | 
|     bsr check_csr            // call with disabled timer interrupt | 
|   | 
|     movel ch_status_addr(%d0), %d1 | 
|     clrl STATUS_OPEN(%d1)        // confirm the port is closed | 
|     rts | 
|   | 
|   | 
| /****************************** transmit packet ***********************/ | 
| // queue packets for transmission | 
| tx:                    // D0 = 4 * port, D6 = doorbell to host | 
|     cmpl #TX_BUFFERS, tx_count(%d0) | 
|     beq tx_ret            // all DB's = descs in use | 
|   | 
|     movel tx_out(%d0), %d1 | 
|     movel %d1, %d2            // D1 = D2 = tx_out BD# = desc# | 
|     mulul #DESC_LENGTH, %d2        // D2 = TX desc offset | 
|     addl ch_status_addr(%d0), %d2 | 
|     addl #STATUS_TX_DESCS, %d2    // D2 = TX desc address | 
|     cmpl #PACKET_FULL, (%d2)    // desc status | 
|     bne tx_ret | 
|   | 
| // queue it | 
|     movel 4(%d2), %a0        // PCI address | 
|     lsll #3, %d1            // BD is 8-bytes long | 
|     addl tx_first_bd(%d0), %d1    // D1 = current tx_out BD addr | 
|   | 
|     movel 4(%d1), %a1        // A1 = dest address | 
|     movel 8(%d2), %d2        // D2 = length | 
|     movew %d2, 2(%d1)        // length into BD | 
|     memcpy_from_pci %a0, %a1, %d2 | 
|     bsetl #31, (%d1)        // CP go ahead | 
|   | 
| // update tx_out and tx_count | 
|     movel tx_out(%d0), %d1 | 
|     addl #1, %d1 | 
|     cmpl #TX_BUFFERS, %d1 | 
|     bne tx_1 | 
|     clrl %d1 | 
| tx_1:    movel %d1, tx_out(%d0) | 
|   | 
|     addl #1, tx_count(%d0) | 
|     bra tx | 
|   | 
| tx_ret: rts | 
|   | 
|   | 
| /****************************** packet received ***********************/ | 
|   | 
| // Service receive buffers        // D0 = 4 * port, D6 = doorbell to host | 
| rx:    movel rx_in(%d0), %d1        // D1 = rx_in BD# | 
|     lsll #3, %d1            // BD is 8-bytes long | 
|     addl rx_first_bd(%d0), %d1    // D1 = current rx_in BD address | 
|     movew (%d1), %d2        // D2 = RX BD flags | 
|     btstl #15, %d2 | 
|     bne rx_ret            // BD still empty | 
|   | 
|     btstl #1, %d2 | 
|     bne rx_overrun | 
|   | 
|     tstw parity_bytes(%d0) | 
|     bne rx_parity | 
|     bclrl #2, %d2            // do not test for CRC errors | 
| rx_parity: | 
|     andw #0x0CBC, %d2        // mask status bits | 
|     cmpw #0x0C00, %d2        // correct frame | 
|     bne rx_bad_frame | 
|     clrl %d3 | 
|     movew 2(%d1), %d3 | 
|     subw parity_bytes(%d0), %d3    // D3 = packet length | 
|     cmpw #HDLC_MAX_MRU, %d3 | 
|     bgt rx_bad_frame | 
|   | 
| rx_good_frame: | 
|     movel rx_out, %d2 | 
|     mulul #DESC_LENGTH, %d2 | 
|     addl rx_descs_addr, %d2        // D2 = RX desc address | 
|     cmpl #PACKET_EMPTY, (%d2)    // desc stat | 
|     bne rx_overrun | 
|   | 
|     movel %d3, 8(%d2) | 
|     movel 4(%d1), %a0        // A0 = source address | 
|     movel 4(%d2), %a1 | 
|     tstl %a1 | 
|     beq rx_ignore_data | 
|     memcpy_to_pci %a0, %a1, %d3 | 
| rx_ignore_data: | 
|     movel packet_full(%d0), (%d2)    // update desc stat | 
|   | 
| // update D6 and rx_out | 
|     bsetl #DOORBELL_FROM_CARD_RX, %d6 // signal host that RX completed | 
|     movel rx_out, %d2 | 
|     addl #1, %d2 | 
|     cmpl #RX_QUEUE_LENGTH, %d2 | 
|     bne rx_1 | 
|     clrl %d2 | 
| rx_1:    movel %d2, rx_out | 
|   | 
| rx_free_bd: | 
|     andw #0xF000, (%d1)        // clear CM and error bits | 
|     bsetl #31, (%d1)        // free BD | 
| // update rx_in | 
|     movel rx_in(%d0), %d1 | 
|     addl #1, %d1 | 
|     cmpl #RX_BUFFERS, %d1 | 
|     bne rx_2 | 
|     clrl %d1 | 
| rx_2:    movel %d1, rx_in(%d0) | 
|     bra rx | 
|   | 
| rx_overrun: | 
|     movel ch_status_addr(%d0), %d2 | 
|     addl #1, STATUS_RX_OVERRUNS(%d2) | 
|     bra rx_free_bd | 
|   | 
| rx_bad_frame: | 
|     movel ch_status_addr(%d0), %d2 | 
|     addl #1, STATUS_RX_FRAME_ERRORS(%d2) | 
|     bra rx_free_bd | 
|   | 
| rx_ret: rts | 
|   | 
|   | 
| /****************************** packet transmitted ********************/ | 
|   | 
| // Service transmit buffers        // D0 = 4 * port, D6 = doorbell to host | 
| tx_end:    tstl tx_count(%d0) | 
|     beq tx_end_ret            // TX buffers already empty | 
|   | 
|     movel tx_in(%d0), %d1 | 
|     movel %d1, %d2            // D1 = D2 = tx_in BD# = desc# | 
|     lsll #3, %d1            // BD is 8-bytes long | 
|     addl tx_first_bd(%d0), %d1    // D1 = current tx_in BD address | 
|     movew (%d1), %d3        // D3 = TX BD flags | 
|     btstl #15, %d3 | 
|     bne tx_end_ret            // BD still being transmitted | 
|   | 
| // update D6, tx_in and tx_count | 
|     orl bell_tx(%d0), %d6        // signal host that TX desc freed | 
|     subl #1, tx_count(%d0) | 
|     movel tx_in(%d0), %d1 | 
|     addl #1, %d1 | 
|     cmpl #TX_BUFFERS, %d1 | 
|     bne tx_end_1 | 
|     clrl %d1 | 
| tx_end_1: | 
|     movel %d1, tx_in(%d0) | 
|   | 
| // free host's descriptor | 
|     mulul #DESC_LENGTH, %d2        // D2 = TX desc offset | 
|     addl ch_status_addr(%d0), %d2 | 
|     addl #STATUS_TX_DESCS, %d2    // D2 = TX desc address | 
|     btstl #1, %d3 | 
|     bne tx_end_underrun | 
|     movel #PACKET_SENT, (%d2) | 
|     bra tx_end | 
|   | 
| tx_end_underrun: | 
|     movel #PACKET_UNDERRUN, (%d2) | 
|     bra tx_end | 
|   | 
| tx_end_ret: rts | 
|   | 
|   | 
| /****************************** PLX PCI9060 DMA memcpy ****************/ | 
|   | 
| #if QUICC_MEMCPY_USES_PLX | 
| // called with interrupts disabled | 
| memcpy_from_pci_run: | 
|     movel %d0, -(%sp) | 
|     movew %sr, -(%sp) | 
| memcpy_1: | 
|     movel PLX_DMA_CMD_STS, %d0    // do not btst PLX register directly | 
|     btstl #4, %d0            // transfer done? | 
|     bne memcpy_end | 
|     stop #0x2200            // enable PCI9060 interrupts | 
|     movew #0x2700, %sr        // disable interrupts again | 
|     bra memcpy_1 | 
|   | 
| memcpy_to_pci_run: | 
|     movel %d0, -(%sp) | 
|     movew %sr, -(%sp) | 
| memcpy_2: | 
|     movel PLX_DMA_CMD_STS, %d0    // do not btst PLX register directly | 
|     btstl #12, %d0            // transfer done? | 
|     bne memcpy_end | 
|     stop #0x2200            // enable PCI9060 interrupts | 
|     movew #0x2700, %sr        // disable interrupts again | 
|     bra memcpy_2 | 
|   | 
| memcpy_end: | 
|     movew (%sp)+, %sr | 
|     movel (%sp)+, %d0 | 
|     rts | 
| #endif | 
|   | 
|   | 
|   | 
|   | 
|   | 
|   | 
| /****************************** PLX PCI9060 interrupt *****************/ | 
|   | 
| pci9060_interrupt: | 
|     movel %d0, -(%sp) | 
|   | 
|     movel PLX_DOORBELL_TO_CARD, %d0 | 
|     movel %d0, PLX_DOORBELL_TO_CARD    // confirm all requests | 
|     orl %d0, channel_stats | 
|   | 
|     movel #0x0909, PLX_DMA_CMD_STS    // clear DMA ch #0 and #1 interrupts | 
|   | 
|     movel (%sp)+, %d0 | 
|     rte | 
|   | 
| /****************************** SCC interrupts ************************/ | 
|   | 
| port_interrupt_1: | 
|     orl #0, SCC1_REGS + SCC_SCCE; // confirm SCC events | 
|     orl #1 << TASK_SCC_0, channel_stats | 
|     movel #0x40000000, CISR | 
|     rte | 
|   | 
| port_interrupt_2: | 
|     orl #0, SCC2_REGS + SCC_SCCE; // confirm SCC events | 
|     orl #1 << TASK_SCC_1, channel_stats | 
|     movel #0x20000000, CISR | 
|     rte | 
|   | 
| port_interrupt_3: | 
|     orl #0, SCC3_REGS + SCC_SCCE; // confirm SCC events | 
|     orl #1 << TASK_SCC_2, channel_stats | 
|     movel #0x10000000, CISR | 
|     rte | 
|   | 
| port_interrupt_4: | 
|     orl #0, SCC4_REGS + SCC_SCCE; // confirm SCC events | 
|     orl #1 << TASK_SCC_3, channel_stats | 
|     movel #0x08000000, CISR | 
|     rte | 
|   | 
| error_interrupt: | 
|     rte | 
|   | 
|   | 
| /****************************** cable and PM routine ******************/ | 
| // modified registers: none | 
| check_csr: | 
|     movel %d0, -(%sp) | 
|     movel %d1, -(%sp) | 
|     movel %d2, -(%sp) | 
|     movel %a0, -(%sp) | 
|     movel %a1, -(%sp) | 
|   | 
|     clrl %d0            // D0 = 4 * port | 
|     movel #CSRA, %a0        // A0 = CSR address | 
|   | 
| check_csr_loop: | 
|     movew (%a0), %d1        // D1 = CSR input bits | 
|     andl #0xE7, %d1            // PM and cable sense bits (no DCE bit) | 
|     cmpw #STATUS_CABLE_V35 * (1 + 1 << STATUS_CABLE_PM_SHIFT), %d1 | 
|     bne check_csr_1 | 
|     movew #0x0E08, %d1 | 
|     bra check_csr_valid | 
|   | 
| check_csr_1: | 
|     cmpw #STATUS_CABLE_X21 * (1 + 1 << STATUS_CABLE_PM_SHIFT), %d1 | 
|     bne check_csr_2 | 
|     movew #0x0408, %d1 | 
|     bra check_csr_valid | 
|   | 
| check_csr_2: | 
|     cmpw #STATUS_CABLE_V24 * (1 + 1 << STATUS_CABLE_PM_SHIFT), %d1 | 
|     bne check_csr_3 | 
|     movew #0x0208, %d1 | 
|     bra check_csr_valid | 
|   | 
| check_csr_3: | 
|     cmpw #STATUS_CABLE_EIA530 * (1 + 1 << STATUS_CABLE_PM_SHIFT), %d1 | 
|     bne check_csr_disable | 
|     movew #0x0D08, %d1 | 
|     bra check_csr_valid | 
|   | 
| check_csr_disable: | 
|     movew #0x0008, %d1        // D1 = disable everything | 
|     movew #0x80E7, %d2        // D2 = input mask: ignore DSR | 
|     bra check_csr_write | 
|   | 
| check_csr_valid:            // D1 = mode and IRQ bits | 
|     movew csr_output(%d0), %d2 | 
|     andw #0x3000, %d2        // D2 = requested LL and DTR bits | 
|     orw %d2, %d1            // D1 = all requested output bits | 
|     movew #0x80FF, %d2        // D2 = input mask: include DSR | 
|   | 
| check_csr_write: | 
|     cmpw old_csr_output(%d0), %d1 | 
|     beq check_csr_input | 
|     movew %d1, old_csr_output(%d0) | 
|     movew %d1, (%a0)        // Write CSR output bits | 
|   | 
| check_csr_input: | 
|     movew (PCDAT), %d1 | 
|     andw dcd_mask(%d0), %d1 | 
|     beq check_csr_dcd_on        // DCD and CTS signals are negated | 
|     movew (%a0), %d1        // D1 = CSR input bits | 
|     andw #~STATUS_CABLE_DCD, %d1    // DCD off | 
|     bra check_csr_previous | 
|   | 
| check_csr_dcd_on: | 
|     movew (%a0), %d1        // D1 = CSR input bits | 
|     orw #STATUS_CABLE_DCD, %d1    // DCD on | 
| check_csr_previous: | 
|     andw %d2, %d1            // input mask | 
|     movel ch_status_addr(%d0), %a1 | 
|     cmpl STATUS_CABLE(%a1), %d1    // check for change | 
|     beq check_csr_next | 
|     movel %d1, STATUS_CABLE(%a1)    // update status | 
|     movel bell_cable(%d0), PLX_DOORBELL_FROM_CARD    // signal the host | 
|   | 
| check_csr_next: | 
|     addl #2, %a0            // next CSR register | 
|     addl #4, %d0            // D0 = 4 * next port | 
|     cmpl #4 * 4, %d0 | 
|     bne check_csr_loop | 
|   | 
|     movel (%sp)+, %a1 | 
|     movel (%sp)+, %a0 | 
|     movel (%sp)+, %d2 | 
|     movel (%sp)+, %d1 | 
|     movel (%sp)+, %d0 | 
|     rts | 
|   | 
|   | 
| /****************************** timer interrupt ***********************/ | 
|   | 
| timer_interrupt: | 
|     bsr check_csr | 
|     rte | 
|   | 
|   | 
| /****************************** RAM sizing and test *******************/ | 
| #if DETECT_RAM | 
| ram_test: | 
|     movel #0x12345678, %d1        // D1 = test value | 
|     movel %d1, (128 * 1024 - 4) | 
|     movel #128 * 1024, %d0        // D0 = RAM size tested | 
| ram_test_size: | 
|     cmpl #MAX_RAM_SIZE, %d0 | 
|     beq ram_test_size_found | 
|     movel %d0, %a0 | 
|     addl #128 * 1024 - 4, %a0 | 
|     cmpl (%a0), %d1 | 
|     beq ram_test_size_check | 
| ram_test_next_size: | 
|     lsll #1, %d0 | 
|     bra ram_test_size | 
|   | 
| ram_test_size_check: | 
|     eorl #0xFFFFFFFF, %d1 | 
|     movel %d1, (128 * 1024 - 4) | 
|     cmpl (%a0), %d1 | 
|     bne ram_test_next_size | 
|   | 
| ram_test_size_found:            // D0 = RAM size | 
|     movel %d0, %a0            // A0 = fill ptr | 
|     subl #firmware_end + 4, %d0 | 
|     lsrl #2, %d0 | 
|     movel %d0, %d1            // D1 = DBf counter | 
| ram_test_fill: | 
|     movel %a0, -(%a0) | 
|     dbfw %d1, ram_test_fill | 
|     subl #0x10000, %d1 | 
|     cmpl #0xFFFFFFFF, %d1 | 
|     bne ram_test_fill | 
|   | 
| ram_test_loop:                // D0 = DBf counter | 
|     cmpl (%a0)+, %a0 | 
|     dbnew %d0, ram_test_loop | 
|     bne ram_test_found_bad | 
|     subl #0x10000, %d0 | 
|     cmpl #0xFFFFFFFF, %d0 | 
|     bne ram_test_loop | 
|     bra ram_test_all_ok | 
|   | 
| ram_test_found_bad: | 
|     subl #4, %a0 | 
| ram_test_all_ok: | 
|     movel %a0, PLX_MAILBOX_5 | 
|     rts | 
| #endif | 
|   | 
|   | 
| /****************************** constants *****************************/ | 
|   | 
| scc_reg_addr: | 
|     .long SCC1_REGS, SCC2_REGS, SCC3_REGS, SCC4_REGS | 
| scc_base_addr: | 
|     .long SCC1_BASE, SCC2_BASE, SCC3_BASE, SCC4_BASE | 
|   | 
| tx_first_bd: | 
|     .long DPRBASE | 
|     .long DPRBASE + (TX_BUFFERS + RX_BUFFERS) * 8 | 
|     .long DPRBASE + (TX_BUFFERS + RX_BUFFERS) * 8 * 2 | 
|     .long DPRBASE + (TX_BUFFERS + RX_BUFFERS) * 8 * 3 | 
|   | 
| rx_first_bd: | 
|     .long DPRBASE + TX_BUFFERS * 8 | 
|     .long DPRBASE + TX_BUFFERS * 8 + (TX_BUFFERS + RX_BUFFERS) * 8 | 
|     .long DPRBASE + TX_BUFFERS * 8 + (TX_BUFFERS + RX_BUFFERS) * 8 * 2 | 
|     .long DPRBASE + TX_BUFFERS * 8 + (TX_BUFFERS + RX_BUFFERS) * 8 * 3 | 
|   | 
| first_buffer: | 
|     .long BUFFERS_ADDR | 
|     .long BUFFERS_ADDR + (TX_BUFFERS + RX_BUFFERS) * BUFFER_LENGTH | 
|     .long BUFFERS_ADDR + (TX_BUFFERS + RX_BUFFERS) * BUFFER_LENGTH * 2 | 
|     .long BUFFERS_ADDR + (TX_BUFFERS + RX_BUFFERS) * BUFFER_LENGTH * 3 | 
|   | 
| bell_tx: | 
|     .long 1 << DOORBELL_FROM_CARD_TX_0, 1 << DOORBELL_FROM_CARD_TX_1 | 
|     .long 1 << DOORBELL_FROM_CARD_TX_2, 1 << DOORBELL_FROM_CARD_TX_3 | 
|   | 
| bell_cable: | 
|     .long 1 << DOORBELL_FROM_CARD_CABLE_0, 1 << DOORBELL_FROM_CARD_CABLE_1 | 
|     .long 1 << DOORBELL_FROM_CARD_CABLE_2, 1 << DOORBELL_FROM_CARD_CABLE_3 | 
|   | 
| packet_full: | 
|     .long PACKET_FULL, PACKET_FULL + 1, PACKET_FULL + 2, PACKET_FULL + 3 | 
|   | 
| clocking_ext: | 
|     .long 0x0000002C, 0x00003E00, 0x002C0000, 0x3E000000 | 
| clocking_txfromrx: | 
|     .long 0x0000002D, 0x00003F00, 0x002D0000, 0x3F000000 | 
| clocking_mask: | 
|     .long 0x000000FF, 0x0000FF00, 0x00FF0000, 0xFF000000 | 
| dcd_mask: | 
|     .word 0x020, 0, 0x080, 0, 0x200, 0, 0x800 | 
|   | 
|     .ascii "wanXL firmware\n" | 
|     .asciz "Copyright (C) 2003 Krzysztof Halasa <khc@pm.waw.pl>\n" | 
|   | 
|   | 
| /****************************** variables *****************************/ | 
|   | 
|         .align 4 | 
| channel_stats:    .long 0 | 
|   | 
| tx_in:        .long 0, 0, 0, 0    // transmitted | 
| tx_out:        .long 0, 0, 0, 0    // received from host for transmission | 
| tx_count:    .long 0, 0, 0, 0    // currently in transmit queue | 
|   | 
| rx_in:        .long 0, 0, 0, 0    // received from port | 
| rx_out:        .long 0            // transmitted to host | 
| parity_bytes:    .word 0, 0, 0, 0, 0, 0, 0 // only 4 words are used | 
|   | 
| csr_output:    .word 0 | 
| old_csr_output:    .word 0, 0, 0, 0, 0, 0, 0 | 
|         .align 4 | 
| firmware_end:                // must be dword-aligned |