Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / net / wan / wanxlfw.S
1 .psize 0
2 /*
3   wanXL serial card driver for Linux
4   card firmware part
5
6   Copyright (C) 2003 Krzysztof Halasa <khc@pm.waw.pl>
7
8   This program is free software; you can redistribute it and/or modify it
9   under the terms of version 2 of the GNU General Public License
10   as published by the Free Software Foundation.
11
12
13
14
15         DPRAM BDs:
16         0x000 - 0x050 TX#0      0x050 - 0x140 RX#0
17         0x140 - 0x190 TX#1      0x190 - 0x280 RX#1
18         0x280 - 0x2D0 TX#2      0x2D0 - 0x3C0 RX#2
19         0x3C0 - 0x410 TX#3      0x410 - 0x500 RX#3
20
21
22         000 5FF 1536 Bytes Dual-Port RAM User Data / BDs
23         600 6FF 256 Bytes Dual-Port RAM User Data / BDs
24         700 7FF 256 Bytes Dual-Port RAM User Data / BDs
25         C00 CBF 192 Bytes Dual-Port RAM Parameter RAM Page 1
26         D00 DBF 192 Bytes Dual-Port RAM Parameter RAM Page 2
27         E00 EBF 192 Bytes Dual-Port RAM Parameter RAM Page 3
28         F00 FBF 192 Bytes Dual-Port RAM Parameter RAM Page 4
29
30         local interrupts                    level
31         NMI                                     7
32         PIT timer, CPM (RX/TX complete)         4
33         PCI9060 DMA and PCI doorbells           3
34         Cable - not used                        1
35 */
36
37 #include <linux/hdlc.h>
38 #include <linux/hdlc/ioctl.h>
39 #include "wanxl.h"
40
41 /* memory addresses and offsets */
42
43 MAX_RAM_SIZE    = 16 * 1024 * 1024      // max RAM supported by hardware
44
45 PCI9060_VECTOR  = 0x0000006C
46 CPM_IRQ_BASE    = 0x40
47 ERROR_VECTOR    = CPM_IRQ_BASE * 4
48 SCC1_VECTOR     = (CPM_IRQ_BASE + 0x1E) * 4
49 SCC2_VECTOR     = (CPM_IRQ_BASE + 0x1D) * 4
50 SCC3_VECTOR     = (CPM_IRQ_BASE + 0x1C) * 4
51 SCC4_VECTOR     = (CPM_IRQ_BASE + 0x1B) * 4
52 CPM_IRQ_LEVEL   = 4
53 TIMER_IRQ       = 128
54 TIMER_IRQ_LEVEL = 4
55 PITR_CONST      = 0x100 + 16            // 1 Hz timer
56
57 MBAR            = 0x0003FF00
58
59 VALUE_WINDOW    = 0x40000000
60 ORDER_WINDOW    = 0xC0000000
61
62 PLX             = 0xFFF90000
63
64 CSRA            = 0xFFFB0000
65 CSRB            = 0xFFFB0002
66 CSRC            = 0xFFFB0004
67 CSRD            = 0xFFFB0006
68 STATUS_CABLE_LL         = 0x2000
69 STATUS_CABLE_DTR        = 0x1000
70
71 DPRBASE         = 0xFFFC0000
72
73 SCC1_BASE       = DPRBASE + 0xC00
74 MISC_BASE       = DPRBASE + 0xCB0
75 SCC2_BASE       = DPRBASE + 0xD00
76 SCC3_BASE       = DPRBASE + 0xE00
77 SCC4_BASE       = DPRBASE + 0xF00
78
79 // offset from SCCx_BASE
80 // SCC_xBASE contain offsets from DPRBASE and must be divisible by 8
81 SCC_RBASE       = 0             // 16-bit RxBD base address
82 SCC_TBASE       = 2             // 16-bit TxBD base address
83 SCC_RFCR        = 4             // 8-bit Rx function code
84 SCC_TFCR        = 5             // 8-bit Tx function code
85 SCC_MRBLR       = 6             // 16-bit maximum Rx buffer length
86 SCC_C_MASK      = 0x34          // 32-bit CRC constant
87 SCC_C_PRES      = 0x38          // 32-bit CRC preset
88 SCC_MFLR        = 0x46          // 16-bit max Rx frame length (without flags)
89
90 REGBASE         = DPRBASE + 0x1000
91 PICR            = REGBASE + 0x026       // 16-bit periodic irq control
92 PITR            = REGBASE + 0x02A       // 16-bit periodic irq timing
93 OR1             = REGBASE + 0x064       // 32-bit RAM bank #1 options
94 CICR            = REGBASE + 0x540       // 32(24)-bit CP interrupt config
95 CIMR            = REGBASE + 0x548       // 32-bit CP interrupt mask
96 CISR            = REGBASE + 0x54C       // 32-bit CP interrupts in-service
97 PADIR           = REGBASE + 0x550       // 16-bit PortA data direction bitmap
98 PAPAR           = REGBASE + 0x552       // 16-bit PortA pin assignment bitmap
99 PAODR           = REGBASE + 0x554       // 16-bit PortA open drain bitmap
100 PADAT           = REGBASE + 0x556       // 16-bit PortA data register
101
102 PCDIR           = REGBASE + 0x560       // 16-bit PortC data direction bitmap
103 PCPAR           = REGBASE + 0x562       // 16-bit PortC pin assignment bitmap
104 PCSO            = REGBASE + 0x564       // 16-bit PortC special options
105 PCDAT           = REGBASE + 0x566       // 16-bit PortC data register
106 PCINT           = REGBASE + 0x568       // 16-bit PortC interrupt control
107 CR              = REGBASE + 0x5C0       // 16-bit Command register
108
109 SCC1_REGS       = REGBASE + 0x600
110 SCC2_REGS       = REGBASE + 0x620
111 SCC3_REGS       = REGBASE + 0x640
112 SCC4_REGS       = REGBASE + 0x660
113 SICR            = REGBASE + 0x6EC       // 32-bit SI clock route
114
115 // offset from SCCx_REGS
116 SCC_GSMR_L      = 0x00  // 32 bits
117 SCC_GSMR_H      = 0x04  // 32 bits
118 SCC_PSMR        = 0x08  // 16 bits
119 SCC_TODR        = 0x0C  // 16 bits
120 SCC_DSR         = 0x0E  // 16 bits
121 SCC_SCCE        = 0x10  // 16 bits
122 SCC_SCCM        = 0x14  // 16 bits
123 SCC_SCCS        = 0x17  // 8 bits
124
125 #if QUICC_MEMCPY_USES_PLX
126         .macro memcpy_from_pci src, dest, len // len must be < 8 MB
127         addl #3, \len
128         andl #0xFFFFFFFC, \len          // always copy n * 4 bytes
129         movel \src, PLX_DMA_0_PCI
130         movel \dest, PLX_DMA_0_LOCAL
131         movel \len, PLX_DMA_0_LENGTH
132         movel #0x0103, PLX_DMA_CMD_STS  // start channel 0 transfer
133         bsr memcpy_from_pci_run
134         .endm
135
136         .macro memcpy_to_pci src, dest, len
137         addl #3, \len
138         andl #0xFFFFFFFC, \len          // always copy n * 4 bytes
139         movel \src, PLX_DMA_1_LOCAL
140         movel \dest, PLX_DMA_1_PCI
141         movel \len, PLX_DMA_1_LENGTH
142         movel #0x0301, PLX_DMA_CMD_STS  // start channel 1 transfer
143         bsr memcpy_to_pci_run
144         .endm
145
146 #else
147
148         .macro memcpy src, dest, len    // len must be < 65536 bytes
149         movel %d7, -(%sp)               // src and dest must be < 256 MB
150         movel \len, %d7                 // bits 0 and 1
151         lsrl #2, \len
152         andl \len, \len
153         beq 99f                         // only 0 - 3 bytes
154         subl #1, \len                   // for dbf
155 98:     movel (\src)+, (\dest)+
156         dbfw \len, 98b
157 99:     movel %d7, \len
158         btstl #1, \len
159         beq 99f
160         movew (\src)+, (\dest)+
161 99:     btstl #0, \len
162         beq 99f
163         moveb (\src)+, (\dest)+
164 99:
165         movel (%sp)+, %d7
166         .endm
167
168         .macro memcpy_from_pci src, dest, len
169         addl #VALUE_WINDOW, \src
170         memcpy \src, \dest, \len
171         .endm
172
173         .macro memcpy_to_pci src, dest, len
174         addl #VALUE_WINDOW, \dest
175         memcpy \src, \dest, \len
176         .endm
177 #endif
178
179
180         .macro wait_for_command
181 99:     btstl #0, CR
182         bne 99b
183         .endm
184
185
186
187
188 /****************************** card initialization *******************/
189         .text
190         .global _start
191 _start: bra init
192
193         .org _start + 4
194 ch_status_addr: .long 0, 0, 0, 0
195 rx_descs_addr:  .long 0
196
197 init:
198 #if DETECT_RAM
199         movel OR1, %d0
200         andl #0xF00007FF, %d0           // mask AMxx bits
201         orl #0xFFFF800 & ~(MAX_RAM_SIZE - 1), %d0 // update RAM bank size
202         movel %d0, OR1
203 #endif
204
205         addl #VALUE_WINDOW, rx_descs_addr // PCI addresses of shared data
206         clrl %d0                        // D0 = 4 * port
207 init_1: tstl ch_status_addr(%d0)
208         beq init_2
209         addl #VALUE_WINDOW, ch_status_addr(%d0)
210 init_2: addl #4, %d0
211         cmpl #4 * 4, %d0
212         bne init_1
213
214         movel #pci9060_interrupt, PCI9060_VECTOR
215         movel #error_interrupt, ERROR_VECTOR
216         movel #port_interrupt_1, SCC1_VECTOR
217         movel #port_interrupt_2, SCC2_VECTOR
218         movel #port_interrupt_3, SCC3_VECTOR
219         movel #port_interrupt_4, SCC4_VECTOR
220         movel #timer_interrupt, TIMER_IRQ * 4
221
222         movel #0x78000000, CIMR         // only SCCx IRQs from CPM
223         movew #(TIMER_IRQ_LEVEL << 8) + TIMER_IRQ, PICR // interrupt from PIT
224         movew #PITR_CONST, PITR
225
226         // SCC1=SCCa SCC2=SCCb SCC3=SCCc SCC4=SCCd prio=4 HP=-1 IRQ=64-79
227         movel #0xD41F40 + (CPM_IRQ_LEVEL << 13), CICR
228         movel #0x543, PLX_DMA_0_MODE    // 32-bit, Ready, Burst, IRQ
229         movel #0x543, PLX_DMA_1_MODE
230         movel #0x0, PLX_DMA_0_DESC      // from PCI to local
231         movel #0x8, PLX_DMA_1_DESC      // from local to PCI
232         movel #0x101, PLX_DMA_CMD_STS   // enable both DMA channels
233         // enable local IRQ, DMA, doorbells and PCI IRQ
234         orl #0x000F0300, PLX_INTERRUPT_CS
235
236 #if DETECT_RAM
237         bsr ram_test
238 #else
239         movel #1, PLX_MAILBOX_5         // non-zero value = init complete
240 #endif
241         bsr check_csr
242
243         movew #0xFFFF, PAPAR            // all pins are clocks/data
244         clrw PADIR                      // first function
245         clrw PCSO                       // CD and CTS always active
246
247
248 /****************************** main loop *****************************/
249
250 main:   movel channel_stats, %d7        // D7 = doorbell + irq status
251         clrl channel_stats
252
253         tstl %d7
254         bne main_1
255         // nothing to do - wait for next event
256         stop #0x2200                    // supervisor + IRQ level 2
257         movew #0x2700, %sr              // disable IRQs again
258         bra main
259
260 main_1: clrl %d0                        // D0 = 4 * port
261         clrl %d6                        // D6 = doorbell to host value
262
263 main_l: btstl #DOORBELL_TO_CARD_CLOSE_0, %d7
264         beq main_op
265         bclrl #DOORBELL_TO_CARD_OPEN_0, %d7 // in case both bits are set
266         bsr close_port
267 main_op:
268         btstl #DOORBELL_TO_CARD_OPEN_0, %d7
269         beq main_cl
270         bsr open_port
271 main_cl:
272         btstl #DOORBELL_TO_CARD_TX_0, %d7
273         beq main_txend
274         bsr tx
275 main_txend:
276         btstl #TASK_SCC_0, %d7
277         beq main_next
278         bsr tx_end
279         bsr rx
280
281 main_next:
282         lsrl #1, %d7                    // port status for next port
283         addl #4, %d0                    // D0 = 4 * next port
284         cmpl #4 * 4, %d0
285         bne main_l
286         movel %d6, PLX_DOORBELL_FROM_CARD // signal the host
287         bra main
288
289
290 /****************************** open port *****************************/
291
292 open_port:                              // D0 = 4 * port, D6 = doorbell to host
293         movel ch_status_addr(%d0), %a0  // A0 = port status address
294         tstl STATUS_OPEN(%a0)
295         bne open_port_ret               // port already open
296         movel #1, STATUS_OPEN(%a0)      // confirm the port is open
297 // setup BDs
298         clrl tx_in(%d0)
299         clrl tx_out(%d0)
300         clrl tx_count(%d0)
301         clrl rx_in(%d0)
302
303         movel SICR, %d1                 // D1 = clock settings in SICR
304         andl clocking_mask(%d0), %d1
305         cmpl #CLOCK_TXFROMRX, STATUS_CLOCKING(%a0)
306         bne open_port_clock_ext
307         orl clocking_txfromrx(%d0), %d1
308         bra open_port_set_clock
309
310 open_port_clock_ext:
311         orl clocking_ext(%d0), %d1
312 open_port_set_clock:
313         movel %d1, SICR                 // update clock settings in SICR
314
315         orw #STATUS_CABLE_DTR, csr_output(%d0)  // DTR on
316         bsr check_csr                   // call with disabled timer interrupt
317
318 // Setup TX descriptors
319         movel first_buffer(%d0), %d1    // D1 = starting buffer address
320         movel tx_first_bd(%d0), %a1     // A1 = starting TX BD address
321         movel #TX_BUFFERS - 2, %d2      // D2 = TX_BUFFERS - 1 counter
322         movel #0x18000000, %d3          // D3 = initial TX BD flags: Int + Last
323         cmpl #PARITY_NONE, STATUS_PARITY(%a0)
324         beq open_port_tx_loop
325         bsetl #26, %d3                  // TX BD flag: Transmit CRC
326 open_port_tx_loop:
327         movel %d3, (%a1)+               // TX flags + length
328         movel %d1, (%a1)+               // buffer address
329         addl #BUFFER_LENGTH, %d1
330         dbfw %d2, open_port_tx_loop
331
332         bsetl #29, %d3                  // TX BD flag: Wrap (last BD)
333         movel %d3, (%a1)+               // Final TX flags + length
334         movel %d1, (%a1)+               // buffer address
335
336 // Setup RX descriptors                 // A1 = starting RX BD address
337         movel #RX_BUFFERS - 2, %d2      // D2 = RX_BUFFERS - 1 counter
338 open_port_rx_loop:
339         movel #0x90000000, (%a1)+       // RX flags + length
340         movel %d1, (%a1)+               // buffer address
341         addl #BUFFER_LENGTH, %d1
342         dbfw %d2, open_port_rx_loop
343
344         movel #0xB0000000, (%a1)+       // Final RX flags + length
345         movel %d1, (%a1)+               // buffer address
346
347 // Setup port parameters
348         movel scc_base_addr(%d0), %a1   // A1 = SCC_BASE address
349         movel scc_reg_addr(%d0), %a2    // A2 = SCC_REGS address
350
351         movel #0xFFFF, SCC_SCCE(%a2)    // clear status bits
352         movel #0x0000, SCC_SCCM(%a2)    // interrupt mask
353
354         movel tx_first_bd(%d0), %d1
355         movew %d1, SCC_TBASE(%a1)       // D1 = offset of first TxBD
356         addl #TX_BUFFERS * 8, %d1
357         movew %d1, SCC_RBASE(%a1)       // D1 = offset of first RxBD
358         moveb #0x8, SCC_RFCR(%a1)       // Intel mode, 1000
359         moveb #0x8, SCC_TFCR(%a1)
360
361 // Parity settings
362         cmpl #PARITY_CRC16_PR1_CCITT, STATUS_PARITY(%a0)
363         bne open_port_parity_1
364         clrw SCC_PSMR(%a2)              // CRC16-CCITT
365         movel #0xF0B8, SCC_C_MASK(%a1)
366         movel #0xFFFF, SCC_C_PRES(%a1)
367         movew #HDLC_MAX_MRU + 2, SCC_MFLR(%a1) // 2 bytes for CRC
368         movew #2, parity_bytes(%d0)
369         bra open_port_2
370
371 open_port_parity_1:
372         cmpl #PARITY_CRC32_PR1_CCITT, STATUS_PARITY(%a0)
373         bne open_port_parity_2
374         movew #0x0800, SCC_PSMR(%a2)    // CRC32-CCITT
375         movel #0xDEBB20E3, SCC_C_MASK(%a1)
376         movel #0xFFFFFFFF, SCC_C_PRES(%a1)
377         movew #HDLC_MAX_MRU + 4, SCC_MFLR(%a1) // 4 bytes for CRC
378         movew #4, parity_bytes(%d0)
379         bra open_port_2
380
381 open_port_parity_2:
382         cmpl #PARITY_CRC16_PR0_CCITT, STATUS_PARITY(%a0)
383         bne open_port_parity_3
384         clrw SCC_PSMR(%a2)              // CRC16-CCITT preset 0
385         movel #0xF0B8, SCC_C_MASK(%a1)
386         clrl SCC_C_PRES(%a1)
387         movew #HDLC_MAX_MRU + 2, SCC_MFLR(%a1) // 2 bytes for CRC
388         movew #2, parity_bytes(%d0)
389         bra open_port_2
390
391 open_port_parity_3:
392         cmpl #PARITY_CRC32_PR0_CCITT, STATUS_PARITY(%a0)
393         bne open_port_parity_4
394         movew #0x0800, SCC_PSMR(%a2)    // CRC32-CCITT preset 0
395         movel #0xDEBB20E3, SCC_C_MASK(%a1)
396         clrl SCC_C_PRES(%a1)
397         movew #HDLC_MAX_MRU + 4, SCC_MFLR(%a1) // 4 bytes for CRC
398         movew #4, parity_bytes(%d0)
399         bra open_port_2
400
401 open_port_parity_4:
402         clrw SCC_PSMR(%a2)              // no parity
403         movel #0xF0B8, SCC_C_MASK(%a1)
404         movel #0xFFFF, SCC_C_PRES(%a1)
405         movew #HDLC_MAX_MRU, SCC_MFLR(%a1) // 0 bytes for CRC
406         clrw parity_bytes(%d0)
407
408 open_port_2:
409         movel #0x00000003, SCC_GSMR_H(%a2) // RTSM
410         cmpl #ENCODING_NRZI, STATUS_ENCODING(%a0)
411         bne open_port_nrz
412         movel #0x10040900, SCC_GSMR_L(%a2) // NRZI: TCI Tend RECN+TENC=1
413         bra open_port_3
414
415 open_port_nrz:
416         movel #0x10040000, SCC_GSMR_L(%a2) // NRZ: TCI Tend RECN+TENC=0
417 open_port_3:
418         movew #BUFFER_LENGTH, SCC_MRBLR(%a1)
419         movel %d0, %d1
420         lsll #4, %d1                    // D1 bits 7 and 6 = port
421         orl #1, %d1
422         movew %d1, CR                   // Init SCC RX and TX params
423         wait_for_command
424
425         // TCI Tend ENR ENT
426         movew #0x001F, SCC_SCCM(%a2)    // TXE RXF BSY TXB RXB interrupts
427         orl #0x00000030, SCC_GSMR_L(%a2) // enable SCC
428 open_port_ret:
429         rts
430
431
432 /****************************** close port ****************************/
433
434 close_port:                             // D0 = 4 * port, D6 = doorbell to host
435         movel scc_reg_addr(%d0), %a0    // A0 = SCC_REGS address
436         clrw SCC_SCCM(%a0)              // no SCC interrupts
437         andl #0xFFFFFFCF, SCC_GSMR_L(%a0) // Disable ENT and ENR
438
439         andw #~STATUS_CABLE_DTR, csr_output(%d0) // DTR off
440         bsr check_csr                   // call with disabled timer interrupt
441
442         movel ch_status_addr(%d0), %d1
443         clrl STATUS_OPEN(%d1)           // confirm the port is closed
444         rts
445
446
447 /****************************** transmit packet ***********************/
448 // queue packets for transmission
449 tx:                                     // D0 = 4 * port, D6 = doorbell to host
450         cmpl #TX_BUFFERS, tx_count(%d0)
451         beq tx_ret                      // all DB's = descs in use
452
453         movel tx_out(%d0), %d1
454         movel %d1, %d2                  // D1 = D2 = tx_out BD# = desc#
455         mulul #DESC_LENGTH, %d2         // D2 = TX desc offset
456         addl ch_status_addr(%d0), %d2
457         addl #STATUS_TX_DESCS, %d2      // D2 = TX desc address
458         cmpl #PACKET_FULL, (%d2)        // desc status
459         bne tx_ret
460
461 // queue it
462         movel 4(%d2), %a0               // PCI address
463         lsll #3, %d1                    // BD is 8-bytes long
464         addl tx_first_bd(%d0), %d1      // D1 = current tx_out BD addr
465
466         movel 4(%d1), %a1               // A1 = dest address
467         movel 8(%d2), %d2               // D2 = length
468         movew %d2, 2(%d1)               // length into BD
469         memcpy_from_pci %a0, %a1, %d2
470         bsetl #31, (%d1)                // CP go ahead
471
472 // update tx_out and tx_count
473         movel tx_out(%d0), %d1
474         addl #1, %d1
475         cmpl #TX_BUFFERS, %d1
476         bne tx_1
477         clrl %d1
478 tx_1:   movel %d1, tx_out(%d0)
479
480         addl #1, tx_count(%d0)
481         bra tx
482
483 tx_ret: rts
484
485
486 /****************************** packet received ***********************/
487
488 // Service receive buffers              // D0 = 4 * port, D6 = doorbell to host
489 rx:     movel rx_in(%d0), %d1           // D1 = rx_in BD#
490         lsll #3, %d1                    // BD is 8-bytes long
491         addl rx_first_bd(%d0), %d1      // D1 = current rx_in BD address
492         movew (%d1), %d2                // D2 = RX BD flags
493         btstl #15, %d2
494         bne rx_ret                      // BD still empty
495
496         btstl #1, %d2
497         bne rx_overrun
498
499         tstw parity_bytes(%d0)
500         bne rx_parity
501         bclrl #2, %d2                   // do not test for CRC errors
502 rx_parity:
503         andw #0x0CBC, %d2               // mask status bits
504         cmpw #0x0C00, %d2               // correct frame
505         bne rx_bad_frame
506         clrl %d3
507         movew 2(%d1), %d3
508         subw parity_bytes(%d0), %d3     // D3 = packet length
509         cmpw #HDLC_MAX_MRU, %d3
510         bgt rx_bad_frame
511
512 rx_good_frame:
513         movel rx_out, %d2
514         mulul #DESC_LENGTH, %d2
515         addl rx_descs_addr, %d2         // D2 = RX desc address
516         cmpl #PACKET_EMPTY, (%d2)       // desc stat
517         bne rx_overrun
518
519         movel %d3, 8(%d2)
520         movel 4(%d1), %a0               // A0 = source address
521         movel 4(%d2), %a1
522         tstl %a1
523         beq rx_ignore_data
524         memcpy_to_pci %a0, %a1, %d3
525 rx_ignore_data:
526         movel packet_full(%d0), (%d2)   // update desc stat
527
528 // update D6 and rx_out
529         bsetl #DOORBELL_FROM_CARD_RX, %d6 // signal host that RX completed
530         movel rx_out, %d2
531         addl #1, %d2
532         cmpl #RX_QUEUE_LENGTH, %d2
533         bne rx_1
534         clrl %d2
535 rx_1:   movel %d2, rx_out
536
537 rx_free_bd:
538         andw #0xF000, (%d1)             // clear CM and error bits
539         bsetl #31, (%d1)                // free BD
540 // update rx_in
541         movel rx_in(%d0), %d1
542         addl #1, %d1
543         cmpl #RX_BUFFERS, %d1
544         bne rx_2
545         clrl %d1
546 rx_2:   movel %d1, rx_in(%d0)
547         bra rx
548
549 rx_overrun:
550         movel ch_status_addr(%d0), %d2
551         addl #1, STATUS_RX_OVERRUNS(%d2)
552         bra rx_free_bd
553
554 rx_bad_frame:
555         movel ch_status_addr(%d0), %d2
556         addl #1, STATUS_RX_FRAME_ERRORS(%d2)
557         bra rx_free_bd
558
559 rx_ret: rts
560
561
562 /****************************** packet transmitted ********************/
563
564 // Service transmit buffers             // D0 = 4 * port, D6 = doorbell to host
565 tx_end: tstl tx_count(%d0)
566         beq tx_end_ret                  // TX buffers already empty
567
568         movel tx_in(%d0), %d1
569         movel %d1, %d2                  // D1 = D2 = tx_in BD# = desc#
570         lsll #3, %d1                    // BD is 8-bytes long
571         addl tx_first_bd(%d0), %d1      // D1 = current tx_in BD address
572         movew (%d1), %d3                // D3 = TX BD flags
573         btstl #15, %d3
574         bne tx_end_ret                  // BD still being transmitted
575
576 // update D6, tx_in and tx_count
577         orl bell_tx(%d0), %d6           // signal host that TX desc freed
578         subl #1, tx_count(%d0)
579         movel tx_in(%d0), %d1
580         addl #1, %d1
581         cmpl #TX_BUFFERS, %d1
582         bne tx_end_1
583         clrl %d1
584 tx_end_1:
585         movel %d1, tx_in(%d0)
586
587 // free host's descriptor
588         mulul #DESC_LENGTH, %d2         // D2 = TX desc offset
589         addl ch_status_addr(%d0), %d2
590         addl #STATUS_TX_DESCS, %d2      // D2 = TX desc address
591         btstl #1, %d3
592         bne tx_end_underrun
593         movel #PACKET_SENT, (%d2)
594         bra tx_end
595
596 tx_end_underrun:
597         movel #PACKET_UNDERRUN, (%d2)
598         bra tx_end
599
600 tx_end_ret: rts
601
602
603 /****************************** PLX PCI9060 DMA memcpy ****************/
604
605 #if QUICC_MEMCPY_USES_PLX
606 // called with interrupts disabled
607 memcpy_from_pci_run:
608         movel %d0, -(%sp)
609         movew %sr, -(%sp)
610 memcpy_1:
611         movel PLX_DMA_CMD_STS, %d0      // do not btst PLX register directly
612         btstl #4, %d0                   // transfer done?
613         bne memcpy_end
614         stop #0x2200                    // enable PCI9060 interrupts
615         movew #0x2700, %sr              // disable interrupts again
616         bra memcpy_1
617
618 memcpy_to_pci_run:
619         movel %d0, -(%sp)
620         movew %sr, -(%sp)
621 memcpy_2:
622         movel PLX_DMA_CMD_STS, %d0      // do not btst PLX register directly
623         btstl #12, %d0                  // transfer done?
624         bne memcpy_end
625         stop #0x2200                    // enable PCI9060 interrupts
626         movew #0x2700, %sr              // disable interrupts again
627         bra memcpy_2
628
629 memcpy_end:
630         movew (%sp)+, %sr
631         movel (%sp)+, %d0
632         rts
633 #endif
634
635
636
637
638
639
640 /****************************** PLX PCI9060 interrupt *****************/
641
642 pci9060_interrupt:
643         movel %d0, -(%sp)
644
645         movel PLX_DOORBELL_TO_CARD, %d0
646         movel %d0, PLX_DOORBELL_TO_CARD // confirm all requests
647         orl %d0, channel_stats
648
649         movel #0x0909, PLX_DMA_CMD_STS  // clear DMA ch #0 and #1 interrupts
650
651         movel (%sp)+, %d0
652         rte
653
654 /****************************** SCC interrupts ************************/
655
656 port_interrupt_1:
657         orl #0, SCC1_REGS + SCC_SCCE; // confirm SCC events
658         orl #1 << TASK_SCC_0, channel_stats
659         movel #0x40000000, CISR
660         rte
661
662 port_interrupt_2:
663         orl #0, SCC2_REGS + SCC_SCCE; // confirm SCC events
664         orl #1 << TASK_SCC_1, channel_stats
665         movel #0x20000000, CISR
666         rte
667
668 port_interrupt_3:
669         orl #0, SCC3_REGS + SCC_SCCE; // confirm SCC events
670         orl #1 << TASK_SCC_2, channel_stats
671         movel #0x10000000, CISR
672         rte
673
674 port_interrupt_4:
675         orl #0, SCC4_REGS + SCC_SCCE; // confirm SCC events
676         orl #1 << TASK_SCC_3, channel_stats
677         movel #0x08000000, CISR
678         rte
679
680 error_interrupt:
681         rte
682
683
684 /****************************** cable and PM routine ******************/
685 // modified registers: none
686 check_csr:
687         movel %d0, -(%sp)
688         movel %d1, -(%sp)
689         movel %d2, -(%sp)
690         movel %a0, -(%sp)
691         movel %a1, -(%sp)
692
693         clrl %d0                        // D0 = 4 * port
694         movel #CSRA, %a0                // A0 = CSR address
695
696 check_csr_loop:
697         movew (%a0), %d1                // D1 = CSR input bits
698         andl #0xE7, %d1                 // PM and cable sense bits (no DCE bit)
699         cmpw #STATUS_CABLE_V35 * (1 + 1 << STATUS_CABLE_PM_SHIFT), %d1
700         bne check_csr_1
701         movew #0x0E08, %d1
702         bra check_csr_valid
703
704 check_csr_1:
705         cmpw #STATUS_CABLE_X21 * (1 + 1 << STATUS_CABLE_PM_SHIFT), %d1
706         bne check_csr_2
707         movew #0x0408, %d1
708         bra check_csr_valid
709
710 check_csr_2:
711         cmpw #STATUS_CABLE_V24 * (1 + 1 << STATUS_CABLE_PM_SHIFT), %d1
712         bne check_csr_3
713         movew #0x0208, %d1
714         bra check_csr_valid
715
716 check_csr_3:
717         cmpw #STATUS_CABLE_EIA530 * (1 + 1 << STATUS_CABLE_PM_SHIFT), %d1
718         bne check_csr_disable
719         movew #0x0D08, %d1
720         bra check_csr_valid
721
722 check_csr_disable:
723         movew #0x0008, %d1              // D1 = disable everything
724         movew #0x80E7, %d2              // D2 = input mask: ignore DSR
725         bra check_csr_write
726
727 check_csr_valid:                        // D1 = mode and IRQ bits
728         movew csr_output(%d0), %d2
729         andw #0x3000, %d2               // D2 = requested LL and DTR bits
730         orw %d2, %d1                    // D1 = all requested output bits
731         movew #0x80FF, %d2              // D2 = input mask: include DSR
732
733 check_csr_write:
734         cmpw old_csr_output(%d0), %d1
735         beq check_csr_input
736         movew %d1, old_csr_output(%d0)
737         movew %d1, (%a0)                // Write CSR output bits
738
739 check_csr_input:
740         movew (PCDAT), %d1
741         andw dcd_mask(%d0), %d1
742         beq check_csr_dcd_on            // DCD and CTS signals are negated
743         movew (%a0), %d1                // D1 = CSR input bits
744         andw #~STATUS_CABLE_DCD, %d1    // DCD off
745         bra check_csr_previous
746
747 check_csr_dcd_on:
748         movew (%a0), %d1                // D1 = CSR input bits
749         orw #STATUS_CABLE_DCD, %d1      // DCD on
750 check_csr_previous:
751         andw %d2, %d1                   // input mask
752         movel ch_status_addr(%d0), %a1
753         cmpl STATUS_CABLE(%a1), %d1     // check for change
754         beq check_csr_next
755         movel %d1, STATUS_CABLE(%a1)    // update status
756         movel bell_cable(%d0), PLX_DOORBELL_FROM_CARD   // signal the host
757
758 check_csr_next:
759         addl #2, %a0                    // next CSR register
760         addl #4, %d0                    // D0 = 4 * next port
761         cmpl #4 * 4, %d0
762         bne check_csr_loop
763
764         movel (%sp)+, %a1
765         movel (%sp)+, %a0
766         movel (%sp)+, %d2
767         movel (%sp)+, %d1
768         movel (%sp)+, %d0
769         rts
770
771
772 /****************************** timer interrupt ***********************/
773
774 timer_interrupt:
775         bsr check_csr
776         rte
777
778
779 /****************************** RAM sizing and test *******************/
780 #if DETECT_RAM
781 ram_test:
782         movel #0x12345678, %d1          // D1 = test value
783         movel %d1, (128 * 1024 - 4)
784         movel #128 * 1024, %d0          // D0 = RAM size tested
785 ram_test_size:
786         cmpl #MAX_RAM_SIZE, %d0
787         beq ram_test_size_found
788         movel %d0, %a0
789         addl #128 * 1024 - 4, %a0
790         cmpl (%a0), %d1
791         beq ram_test_size_check
792 ram_test_next_size:
793         lsll #1, %d0
794         bra ram_test_size
795
796 ram_test_size_check:
797         eorl #0xFFFFFFFF, %d1
798         movel %d1, (128 * 1024 - 4)
799         cmpl (%a0), %d1
800         bne ram_test_next_size
801
802 ram_test_size_found:                    // D0 = RAM size
803         movel %d0, %a0                  // A0 = fill ptr
804         subl #firmware_end + 4, %d0
805         lsrl #2, %d0
806         movel %d0, %d1                  // D1 = DBf counter
807 ram_test_fill:
808         movel %a0, -(%a0)
809         dbfw %d1, ram_test_fill
810         subl #0x10000, %d1
811         cmpl #0xFFFFFFFF, %d1
812         bne ram_test_fill
813
814 ram_test_loop:                          // D0 = DBf counter
815         cmpl (%a0)+, %a0
816         dbnew %d0, ram_test_loop
817         bne ram_test_found_bad
818         subl #0x10000, %d0
819         cmpl #0xFFFFFFFF, %d0
820         bne ram_test_loop
821         bra ram_test_all_ok
822
823 ram_test_found_bad:
824         subl #4, %a0
825 ram_test_all_ok:
826         movel %a0, PLX_MAILBOX_5
827         rts
828 #endif
829
830
831 /****************************** constants *****************************/
832
833 scc_reg_addr:
834         .long SCC1_REGS, SCC2_REGS, SCC3_REGS, SCC4_REGS
835 scc_base_addr:
836         .long SCC1_BASE, SCC2_BASE, SCC3_BASE, SCC4_BASE
837
838 tx_first_bd:
839         .long DPRBASE
840         .long DPRBASE + (TX_BUFFERS + RX_BUFFERS) * 8
841         .long DPRBASE + (TX_BUFFERS + RX_BUFFERS) * 8 * 2
842         .long DPRBASE + (TX_BUFFERS + RX_BUFFERS) * 8 * 3
843
844 rx_first_bd:
845         .long DPRBASE + TX_BUFFERS * 8
846         .long DPRBASE + TX_BUFFERS * 8 + (TX_BUFFERS + RX_BUFFERS) * 8
847         .long DPRBASE + TX_BUFFERS * 8 + (TX_BUFFERS + RX_BUFFERS) * 8 * 2
848         .long DPRBASE + TX_BUFFERS * 8 + (TX_BUFFERS + RX_BUFFERS) * 8 * 3
849
850 first_buffer:
851         .long BUFFERS_ADDR
852         .long BUFFERS_ADDR + (TX_BUFFERS + RX_BUFFERS) * BUFFER_LENGTH
853         .long BUFFERS_ADDR + (TX_BUFFERS + RX_BUFFERS) * BUFFER_LENGTH * 2
854         .long BUFFERS_ADDR + (TX_BUFFERS + RX_BUFFERS) * BUFFER_LENGTH * 3
855
856 bell_tx:
857         .long 1 << DOORBELL_FROM_CARD_TX_0, 1 << DOORBELL_FROM_CARD_TX_1
858         .long 1 << DOORBELL_FROM_CARD_TX_2, 1 << DOORBELL_FROM_CARD_TX_3
859
860 bell_cable:
861         .long 1 << DOORBELL_FROM_CARD_CABLE_0, 1 << DOORBELL_FROM_CARD_CABLE_1
862         .long 1 << DOORBELL_FROM_CARD_CABLE_2, 1 << DOORBELL_FROM_CARD_CABLE_3
863
864 packet_full:
865         .long PACKET_FULL, PACKET_FULL + 1, PACKET_FULL + 2, PACKET_FULL + 3
866
867 clocking_ext:
868         .long 0x0000002C, 0x00003E00, 0x002C0000, 0x3E000000
869 clocking_txfromrx:
870         .long 0x0000002D, 0x00003F00, 0x002D0000, 0x3F000000
871 clocking_mask:
872         .long 0x000000FF, 0x0000FF00, 0x00FF0000, 0xFF000000
873 dcd_mask:
874         .word 0x020, 0, 0x080, 0, 0x200, 0, 0x800
875
876         .ascii "wanXL firmware\n"
877         .asciz "Copyright (C) 2003 Krzysztof Halasa <khc@pm.waw.pl>\n"
878
879
880 /****************************** variables *****************************/
881
882                 .align 4
883 channel_stats:  .long 0
884
885 tx_in:          .long 0, 0, 0, 0        // transmitted
886 tx_out:         .long 0, 0, 0, 0        // received from host for transmission
887 tx_count:       .long 0, 0, 0, 0        // currently in transmit queue
888
889 rx_in:          .long 0, 0, 0, 0        // received from port
890 rx_out:         .long 0                 // transmitted to host
891 parity_bytes:   .word 0, 0, 0, 0, 0, 0, 0 // only 4 words are used
892
893 csr_output:     .word 0
894 old_csr_output: .word 0, 0, 0, 0, 0, 0, 0
895                 .align 4
896 firmware_end:                           // must be dword-aligned