Subversion Repositories test_project

.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 "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