forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
894 lines
23 KiB
894 lines
23 KiB
/* SPDX-License-Identifier: GPL-2.0-only */ |
|
.psize 0 |
|
/* |
|
wanXL serial card driver for Linux |
|
card firmware part |
|
|
|
Copyright (C) 2003 Krzysztof Halasa <khc@pm.waw.pl> |
|
|
|
|
|
|
|
|
|
|
|
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
|
|
|