xref: /OK3568_Linux_fs/kernel/drivers/atm/horizon.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun   Madge Horizon ATM Adapter driver.
4*4882a593Smuzhiyun   Copyright (C) 1995-1999  Madge Networks Ltd.
5*4882a593Smuzhiyun 
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun /*
9*4882a593Smuzhiyun   IMPORTANT NOTE: Madge Networks no longer makes the adapters
10*4882a593Smuzhiyun   supported by this driver and makes no commitment to maintain it.
11*4882a593Smuzhiyun */
12*4882a593Smuzhiyun 
13*4882a593Smuzhiyun #include <linux/module.h>
14*4882a593Smuzhiyun #include <linux/kernel.h>
15*4882a593Smuzhiyun #include <linux/sched/signal.h>
16*4882a593Smuzhiyun #include <linux/mm.h>
17*4882a593Smuzhiyun #include <linux/pci.h>
18*4882a593Smuzhiyun #include <linux/errno.h>
19*4882a593Smuzhiyun #include <linux/atm.h>
20*4882a593Smuzhiyun #include <linux/atmdev.h>
21*4882a593Smuzhiyun #include <linux/sonet.h>
22*4882a593Smuzhiyun #include <linux/skbuff.h>
23*4882a593Smuzhiyun #include <linux/time.h>
24*4882a593Smuzhiyun #include <linux/delay.h>
25*4882a593Smuzhiyun #include <linux/uio.h>
26*4882a593Smuzhiyun #include <linux/init.h>
27*4882a593Smuzhiyun #include <linux/interrupt.h>
28*4882a593Smuzhiyun #include <linux/ioport.h>
29*4882a593Smuzhiyun #include <linux/wait.h>
30*4882a593Smuzhiyun #include <linux/slab.h>
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun #include <asm/io.h>
33*4882a593Smuzhiyun #include <linux/atomic.h>
34*4882a593Smuzhiyun #include <linux/uaccess.h>
35*4882a593Smuzhiyun #include <asm/string.h>
36*4882a593Smuzhiyun #include <asm/byteorder.h>
37*4882a593Smuzhiyun 
38*4882a593Smuzhiyun #include "horizon.h"
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun #define maintainer_string "Giuliano Procida at Madge Networks <gprocida@madge.com>"
41*4882a593Smuzhiyun #define description_string "Madge ATM Horizon [Ultra] driver"
42*4882a593Smuzhiyun #define version_string "1.2.1"
43*4882a593Smuzhiyun 
show_version(void)44*4882a593Smuzhiyun static inline void __init show_version (void) {
45*4882a593Smuzhiyun   printk ("%s version %s\n", description_string, version_string);
46*4882a593Smuzhiyun }
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun /*
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun   CREDITS
51*4882a593Smuzhiyun 
52*4882a593Smuzhiyun   Driver and documentation by:
53*4882a593Smuzhiyun 
54*4882a593Smuzhiyun   Chris Aston        Madge Networks
55*4882a593Smuzhiyun   Giuliano Procida   Madge Networks
56*4882a593Smuzhiyun   Simon Benham       Madge Networks
57*4882a593Smuzhiyun   Simon Johnson      Madge Networks
58*4882a593Smuzhiyun   Various Others     Madge Networks
59*4882a593Smuzhiyun 
60*4882a593Smuzhiyun   Some inspiration taken from other drivers by:
61*4882a593Smuzhiyun 
62*4882a593Smuzhiyun   Alexandru Cucos    UTBv
63*4882a593Smuzhiyun   Kari Mettinen      University of Helsinki
64*4882a593Smuzhiyun   Werner Almesberger EPFL LRC
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun   Theory of Operation
67*4882a593Smuzhiyun 
68*4882a593Smuzhiyun   I Hardware, detection, initialisation and shutdown.
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun   1. Supported Hardware
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun   This driver should handle all variants of the PCI Madge ATM adapters
73*4882a593Smuzhiyun   with the Horizon chipset. These are all PCI cards supporting PIO, BM
74*4882a593Smuzhiyun   DMA and a form of MMIO (registers only, not internal RAM).
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun   The driver is only known to work with SONET and UTP Horizon Ultra
77*4882a593Smuzhiyun   cards at 155Mb/s. However, code is in place to deal with both the
78*4882a593Smuzhiyun   original Horizon and 25Mb/s operation.
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun   There are two revisions of the Horizon ASIC: the original and the
81*4882a593Smuzhiyun   Ultra. Details of hardware bugs are in section III.
82*4882a593Smuzhiyun 
83*4882a593Smuzhiyun   The ASIC version can be distinguished by chip markings but is NOT
84*4882a593Smuzhiyun   indicated by the PCI revision (all adapters seem to have PCI rev 1).
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun   I believe that:
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun   Horizon       => Collage  25 PCI Adapter (UTP and STP)
89*4882a593Smuzhiyun   Horizon Ultra => Collage 155 PCI Client (UTP or SONET)
90*4882a593Smuzhiyun   Ambassador x  => Collage 155 PCI Server (completely different)
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun   Horizon (25Mb/s) is fitted with UTP and STP connectors. It seems to
93*4882a593Smuzhiyun   have a Madge B154 plus glue logic serializer. I have also found a
94*4882a593Smuzhiyun   really ancient version of this with slightly different glue. It
95*4882a593Smuzhiyun   comes with the revision 0 (140-025-01) ASIC.
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun   Horizon Ultra (155Mb/s) is fitted with either a Pulse Medialink
98*4882a593Smuzhiyun   output (UTP) or an HP HFBR 5205 output (SONET). It has either
99*4882a593Smuzhiyun   Madge's SAMBA framer or a SUNI-lite device (early versions). It
100*4882a593Smuzhiyun   comes with the revision 1 (140-027-01) ASIC.
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun   2. Detection
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun   All Horizon-based cards present with the same PCI Vendor and Device
105*4882a593Smuzhiyun   IDs. The standard Linux 2.2 PCI API is used to locate any cards and
106*4882a593Smuzhiyun   to enable bus-mastering (with appropriate latency).
107*4882a593Smuzhiyun 
108*4882a593Smuzhiyun   ATM_LAYER_STATUS in the control register distinguishes between the
109*4882a593Smuzhiyun   two possible physical layers (25 and 155). It is not clear whether
110*4882a593Smuzhiyun   the 155 cards can also operate at 25Mbps. We rely on the fact that a
111*4882a593Smuzhiyun   card operates at 155 if and only if it has the newer Horizon Ultra
112*4882a593Smuzhiyun   ASIC.
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun   For 155 cards the two possible framers are probed for and then set
115*4882a593Smuzhiyun   up for loop-timing.
116*4882a593Smuzhiyun 
117*4882a593Smuzhiyun   3. Initialisation
118*4882a593Smuzhiyun 
119*4882a593Smuzhiyun   The card is reset and then put into a known state. The physical
120*4882a593Smuzhiyun   layer is configured for normal operation at the appropriate speed;
121*4882a593Smuzhiyun   in the case of the 155 cards, the framer is initialised with
122*4882a593Smuzhiyun   line-based timing; the internal RAM is zeroed and the allocation of
123*4882a593Smuzhiyun   buffers for RX and TX is made; the Burnt In Address is read and
124*4882a593Smuzhiyun   copied to the ATM ESI; various policy settings for RX (VPI bits,
125*4882a593Smuzhiyun   unknown VCs, oam cells) are made. Ideally all policy items should be
126*4882a593Smuzhiyun   configurable at module load (if not actually on-demand), however,
127*4882a593Smuzhiyun   only the vpi vs vci bit allocation can be specified at insmod.
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun   4. Shutdown
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun   This is in response to module_cleaup. No VCs are in use and the card
132*4882a593Smuzhiyun   should be idle; it is reset.
133*4882a593Smuzhiyun 
134*4882a593Smuzhiyun   II Driver software (as it should be)
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun   0. Traffic Parameters
137*4882a593Smuzhiyun 
138*4882a593Smuzhiyun   The traffic classes (not an enumeration) are currently: ATM_NONE (no
139*4882a593Smuzhiyun   traffic), ATM_UBR, ATM_CBR, ATM_VBR and ATM_ABR, ATM_ANYCLASS
140*4882a593Smuzhiyun   (compatible with everything). Together with (perhaps only some of)
141*4882a593Smuzhiyun   the following items they make up the traffic specification.
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun   struct atm_trafprm {
144*4882a593Smuzhiyun     unsigned char traffic_class; traffic class (ATM_UBR, ...)
145*4882a593Smuzhiyun     int           max_pcr;       maximum PCR in cells per second
146*4882a593Smuzhiyun     int           pcr;           desired PCR in cells per second
147*4882a593Smuzhiyun     int           min_pcr;       minimum PCR in cells per second
148*4882a593Smuzhiyun     int           max_cdv;       maximum CDV in microseconds
149*4882a593Smuzhiyun     int           max_sdu;       maximum SDU in bytes
150*4882a593Smuzhiyun   };
151*4882a593Smuzhiyun 
152*4882a593Smuzhiyun   Note that these denote bandwidth available not bandwidth used; the
153*4882a593Smuzhiyun   possibilities according to ATMF are:
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun   Real Time (cdv and max CDT given)
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun   CBR(pcr)             pcr bandwidth always available
158*4882a593Smuzhiyun   rtVBR(pcr,scr,mbs)   scr bandwidth always available, up to pcr at mbs too
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun   Non Real Time
161*4882a593Smuzhiyun 
162*4882a593Smuzhiyun   nrtVBR(pcr,scr,mbs)  scr bandwidth always available, up to pcr at mbs too
163*4882a593Smuzhiyun   UBR()
164*4882a593Smuzhiyun   ABR(mcr,pcr)         mcr bandwidth always available, up to pcr (depending) too
165*4882a593Smuzhiyun 
166*4882a593Smuzhiyun   mbs is max burst size (bucket)
167*4882a593Smuzhiyun   pcr and scr have associated cdvt values
168*4882a593Smuzhiyun   mcr is like scr but has no cdtv
169*4882a593Smuzhiyun   cdtv may differ at each hop
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun   Some of the above items are qos items (as opposed to traffic
172*4882a593Smuzhiyun   parameters). We have nothing to do with qos. All except ABR can have
173*4882a593Smuzhiyun   their traffic parameters converted to GCRA parameters. The GCRA may
174*4882a593Smuzhiyun   be implemented as a (real-number) leaky bucket. The GCRA can be used
175*4882a593Smuzhiyun   in complicated ways by switches and in simpler ways by end-stations.
176*4882a593Smuzhiyun   It can be used both to filter incoming cells and shape out-going
177*4882a593Smuzhiyun   cells.
178*4882a593Smuzhiyun 
179*4882a593Smuzhiyun   ATM Linux actually supports:
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun   ATM_NONE() (no traffic in this direction)
182*4882a593Smuzhiyun   ATM_UBR(max_frame_size)
183*4882a593Smuzhiyun   ATM_CBR(max/min_pcr, max_cdv, max_frame_size)
184*4882a593Smuzhiyun 
185*4882a593Smuzhiyun   0 or ATM_MAX_PCR are used to indicate maximum available PCR
186*4882a593Smuzhiyun 
187*4882a593Smuzhiyun   A traffic specification consists of the AAL type and separate
188*4882a593Smuzhiyun   traffic specifications for either direction. In ATM Linux it is:
189*4882a593Smuzhiyun 
190*4882a593Smuzhiyun   struct atm_qos {
191*4882a593Smuzhiyun   struct atm_trafprm txtp;
192*4882a593Smuzhiyun   struct atm_trafprm rxtp;
193*4882a593Smuzhiyun   unsigned char aal;
194*4882a593Smuzhiyun   };
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun   AAL types are:
197*4882a593Smuzhiyun 
198*4882a593Smuzhiyun   ATM_NO_AAL    AAL not specified
199*4882a593Smuzhiyun   ATM_AAL0      "raw" ATM cells
200*4882a593Smuzhiyun   ATM_AAL1      AAL1 (CBR)
201*4882a593Smuzhiyun   ATM_AAL2      AAL2 (VBR)
202*4882a593Smuzhiyun   ATM_AAL34     AAL3/4 (data)
203*4882a593Smuzhiyun   ATM_AAL5      AAL5 (data)
204*4882a593Smuzhiyun   ATM_SAAL      signaling AAL
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun   The Horizon has support for AAL frame types: 0, 3/4 and 5. However,
207*4882a593Smuzhiyun   it does not implement AAL 3/4 SAR and it has a different notion of
208*4882a593Smuzhiyun   "raw cell" to ATM Linux's (48 bytes vs. 52 bytes) so neither are
209*4882a593Smuzhiyun   supported by this driver.
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun   The Horizon has limited support for ABR (including UBR), VBR and
212*4882a593Smuzhiyun   CBR. Each TX channel has a bucket (containing up to 31 cell units)
213*4882a593Smuzhiyun   and two timers (PCR and SCR) associated with it that can be used to
214*4882a593Smuzhiyun   govern cell emissions and host notification (in the case of ABR this
215*4882a593Smuzhiyun   is presumably so that RM cells may be emitted at appropriate times).
216*4882a593Smuzhiyun   The timers may either be disabled or may be set to any of 240 values
217*4882a593Smuzhiyun   (determined by the clock crystal, a fixed (?) per-device divider, a
218*4882a593Smuzhiyun   configurable divider and a configurable timer preload value).
219*4882a593Smuzhiyun 
220*4882a593Smuzhiyun   At the moment only UBR and CBR are supported by the driver. VBR will
221*4882a593Smuzhiyun   be supported as soon as ATM for Linux supports it. ABR support is
222*4882a593Smuzhiyun   very unlikely as RM cell handling is completely up to the driver.
223*4882a593Smuzhiyun 
224*4882a593Smuzhiyun   1. TX (TX channel setup and TX transfer)
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun   The TX half of the driver owns the TX Horizon registers. The TX
227*4882a593Smuzhiyun   component in the IRQ handler is the BM completion handler. This can
228*4882a593Smuzhiyun   only be entered when tx_busy is true (enforced by hardware). The
229*4882a593Smuzhiyun   other TX component can only be entered when tx_busy is false
230*4882a593Smuzhiyun   (enforced by driver). So TX is single-threaded.
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun   Apart from a minor optimisation to not re-select the last channel,
233*4882a593Smuzhiyun   the TX send component works as follows:
234*4882a593Smuzhiyun 
235*4882a593Smuzhiyun   Atomic test and set tx_busy until we succeed; we should implement
236*4882a593Smuzhiyun   some sort of timeout so that tx_busy will never be stuck at true.
237*4882a593Smuzhiyun 
238*4882a593Smuzhiyun   If no TX channel is set up for this VC we wait for an idle one (if
239*4882a593Smuzhiyun   necessary) and set it up.
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun   At this point we have a TX channel ready for use. We wait for enough
242*4882a593Smuzhiyun   buffers to become available then start a TX transmit (set the TX
243*4882a593Smuzhiyun   descriptor, schedule transfer, exit).
244*4882a593Smuzhiyun 
245*4882a593Smuzhiyun   The IRQ component handles TX completion (stats, free buffer, tx_busy
246*4882a593Smuzhiyun   unset, exit). We also re-schedule further transfers for the same
247*4882a593Smuzhiyun   frame if needed.
248*4882a593Smuzhiyun 
249*4882a593Smuzhiyun   TX setup in more detail:
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun   TX open is a nop, the relevant information is held in the hrz_vcc
252*4882a593Smuzhiyun   (vcc->dev_data) structure and is "cached" on the card.
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun   TX close gets the TX lock and clears the channel from the "cache".
255*4882a593Smuzhiyun 
256*4882a593Smuzhiyun   2. RX (Data Available and RX transfer)
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun   The RX half of the driver owns the RX registers. There are two RX
259*4882a593Smuzhiyun   components in the IRQ handler: the data available handler deals with
260*4882a593Smuzhiyun   fresh data that has arrived on the card, the BM completion handler
261*4882a593Smuzhiyun   is very similar to the TX completion handler. The data available
262*4882a593Smuzhiyun   handler grabs the rx_lock and it is only released once the data has
263*4882a593Smuzhiyun   been discarded or completely transferred to the host. The BM
264*4882a593Smuzhiyun   completion handler only runs when the lock is held; the data
265*4882a593Smuzhiyun   available handler is locked out over the same period.
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun   Data available on the card triggers an interrupt. If the data is not
268*4882a593Smuzhiyun   suitable for our existing RX channels or we cannot allocate a buffer
269*4882a593Smuzhiyun   it is flushed. Otherwise an RX receive is scheduled. Multiple RX
270*4882a593Smuzhiyun   transfers may be scheduled for the same frame.
271*4882a593Smuzhiyun 
272*4882a593Smuzhiyun   RX setup in more detail:
273*4882a593Smuzhiyun 
274*4882a593Smuzhiyun   RX open...
275*4882a593Smuzhiyun   RX close...
276*4882a593Smuzhiyun 
277*4882a593Smuzhiyun   III Hardware Bugs
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun   0. Byte vs Word addressing of adapter RAM.
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun   A design feature; see the .h file (especially the memory map).
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun   1. Bus Master Data Transfers (original Horizon only, fixed in Ultra)
284*4882a593Smuzhiyun 
285*4882a593Smuzhiyun   The host must not start a transmit direction transfer at a
286*4882a593Smuzhiyun   non-four-byte boundary in host memory. Instead the host should
287*4882a593Smuzhiyun   perform a byte, or a two byte, or one byte followed by two byte
288*4882a593Smuzhiyun   transfer in order to start the rest of the transfer on a four byte
289*4882a593Smuzhiyun   boundary. RX is OK.
290*4882a593Smuzhiyun 
291*4882a593Smuzhiyun   Simultaneous transmit and receive direction bus master transfers are
292*4882a593Smuzhiyun   not allowed.
293*4882a593Smuzhiyun 
294*4882a593Smuzhiyun   The simplest solution to these two is to always do PIO (never DMA)
295*4882a593Smuzhiyun   in the TX direction on the original Horizon. More complicated
296*4882a593Smuzhiyun   solutions are likely to hurt my brain.
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun   2. Loss of buffer on close VC
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun   When a VC is being closed, the buffer associated with it is not
301*4882a593Smuzhiyun   returned to the pool. The host must store the reference to this
302*4882a593Smuzhiyun   buffer and when opening a new VC then give it to that new VC.
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun   The host intervention currently consists of stacking such a buffer
305*4882a593Smuzhiyun   pointer at VC close and checking the stack at VC open.
306*4882a593Smuzhiyun 
307*4882a593Smuzhiyun   3. Failure to close a VC
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun   If a VC is currently receiving a frame then closing the VC may fail
310*4882a593Smuzhiyun   and the frame continues to be received.
311*4882a593Smuzhiyun 
312*4882a593Smuzhiyun   The solution is to make sure any received frames are flushed when
313*4882a593Smuzhiyun   ready. This is currently done just before the solution to 2.
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun   4. PCI bus (original Horizon only, fixed in Ultra)
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun   Reading from the data port prior to initialisation will hang the PCI
318*4882a593Smuzhiyun   bus. Just don't do that then! We don't.
319*4882a593Smuzhiyun 
320*4882a593Smuzhiyun   IV To Do List
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun   . Timer code may be broken.
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun   . Allow users to specify buffer allocation split for TX and RX.
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun   . Deal once and for all with buggy VC close.
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun   . Handle interrupted and/or non-blocking operations.
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun   . Change some macros to functions and move from .h to .c.
331*4882a593Smuzhiyun 
332*4882a593Smuzhiyun   . Try to limit the number of TX frames each VC may have queued, in
333*4882a593Smuzhiyun     order to reduce the chances of TX buffer exhaustion.
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun   . Implement VBR (bucket and timers not understood) and ABR (need to
336*4882a593Smuzhiyun     do RM cells manually); also no Linux support for either.
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun   . Implement QoS changes on open VCs (involves extracting parts of VC open
339*4882a593Smuzhiyun     and close into separate functions and using them to make changes).
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun */
342*4882a593Smuzhiyun 
343*4882a593Smuzhiyun /********** globals **********/
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun static void do_housekeeping (struct timer_list *t);
346*4882a593Smuzhiyun 
347*4882a593Smuzhiyun static unsigned short debug = 0;
348*4882a593Smuzhiyun static unsigned short vpi_bits = 0;
349*4882a593Smuzhiyun static int max_tx_size = 9000;
350*4882a593Smuzhiyun static int max_rx_size = 9000;
351*4882a593Smuzhiyun static unsigned char pci_lat = 0;
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun /********** access functions **********/
354*4882a593Smuzhiyun 
355*4882a593Smuzhiyun /* Read / Write Horizon registers */
wr_regl(const hrz_dev * dev,unsigned char reg,u32 data)356*4882a593Smuzhiyun static inline void wr_regl (const hrz_dev * dev, unsigned char reg, u32 data) {
357*4882a593Smuzhiyun   outl (cpu_to_le32 (data), dev->iobase + reg);
358*4882a593Smuzhiyun }
359*4882a593Smuzhiyun 
rd_regl(const hrz_dev * dev,unsigned char reg)360*4882a593Smuzhiyun static inline u32 rd_regl (const hrz_dev * dev, unsigned char reg) {
361*4882a593Smuzhiyun   return le32_to_cpu (inl (dev->iobase + reg));
362*4882a593Smuzhiyun }
363*4882a593Smuzhiyun 
wr_regw(const hrz_dev * dev,unsigned char reg,u16 data)364*4882a593Smuzhiyun static inline void wr_regw (const hrz_dev * dev, unsigned char reg, u16 data) {
365*4882a593Smuzhiyun   outw (cpu_to_le16 (data), dev->iobase + reg);
366*4882a593Smuzhiyun }
367*4882a593Smuzhiyun 
rd_regw(const hrz_dev * dev,unsigned char reg)368*4882a593Smuzhiyun static inline u16 rd_regw (const hrz_dev * dev, unsigned char reg) {
369*4882a593Smuzhiyun   return le16_to_cpu (inw (dev->iobase + reg));
370*4882a593Smuzhiyun }
371*4882a593Smuzhiyun 
wrs_regb(const hrz_dev * dev,unsigned char reg,void * addr,u32 len)372*4882a593Smuzhiyun static inline void wrs_regb (const hrz_dev * dev, unsigned char reg, void * addr, u32 len) {
373*4882a593Smuzhiyun   outsb (dev->iobase + reg, addr, len);
374*4882a593Smuzhiyun }
375*4882a593Smuzhiyun 
rds_regb(const hrz_dev * dev,unsigned char reg,void * addr,u32 len)376*4882a593Smuzhiyun static inline void rds_regb (const hrz_dev * dev, unsigned char reg, void * addr, u32 len) {
377*4882a593Smuzhiyun   insb (dev->iobase + reg, addr, len);
378*4882a593Smuzhiyun }
379*4882a593Smuzhiyun 
380*4882a593Smuzhiyun /* Read / Write to a given address in Horizon buffer memory.
381*4882a593Smuzhiyun    Interrupts must be disabled between the address register and data
382*4882a593Smuzhiyun    port accesses as these must form an atomic operation. */
wr_mem(const hrz_dev * dev,HDW * addr,u32 data)383*4882a593Smuzhiyun static inline void wr_mem (const hrz_dev * dev, HDW * addr, u32 data) {
384*4882a593Smuzhiyun   // wr_regl (dev, MEM_WR_ADDR_REG_OFF, (u32) addr);
385*4882a593Smuzhiyun   wr_regl (dev, MEM_WR_ADDR_REG_OFF, (addr - (HDW *) 0) * sizeof(HDW));
386*4882a593Smuzhiyun   wr_regl (dev, MEMORY_PORT_OFF, data);
387*4882a593Smuzhiyun }
388*4882a593Smuzhiyun 
rd_mem(const hrz_dev * dev,HDW * addr)389*4882a593Smuzhiyun static inline u32 rd_mem (const hrz_dev * dev, HDW * addr) {
390*4882a593Smuzhiyun   // wr_regl (dev, MEM_RD_ADDR_REG_OFF, (u32) addr);
391*4882a593Smuzhiyun   wr_regl (dev, MEM_RD_ADDR_REG_OFF, (addr - (HDW *) 0) * sizeof(HDW));
392*4882a593Smuzhiyun   return rd_regl (dev, MEMORY_PORT_OFF);
393*4882a593Smuzhiyun }
394*4882a593Smuzhiyun 
wr_framer(const hrz_dev * dev,u32 addr,u32 data)395*4882a593Smuzhiyun static inline void wr_framer (const hrz_dev * dev, u32 addr, u32 data) {
396*4882a593Smuzhiyun   wr_regl (dev, MEM_WR_ADDR_REG_OFF, (u32) addr | 0x80000000);
397*4882a593Smuzhiyun   wr_regl (dev, MEMORY_PORT_OFF, data);
398*4882a593Smuzhiyun }
399*4882a593Smuzhiyun 
rd_framer(const hrz_dev * dev,u32 addr)400*4882a593Smuzhiyun static inline u32 rd_framer (const hrz_dev * dev, u32 addr) {
401*4882a593Smuzhiyun   wr_regl (dev, MEM_RD_ADDR_REG_OFF, (u32) addr | 0x80000000);
402*4882a593Smuzhiyun   return rd_regl (dev, MEMORY_PORT_OFF);
403*4882a593Smuzhiyun }
404*4882a593Smuzhiyun 
405*4882a593Smuzhiyun /********** specialised access functions **********/
406*4882a593Smuzhiyun 
407*4882a593Smuzhiyun /* RX */
408*4882a593Smuzhiyun 
FLUSH_RX_CHANNEL(hrz_dev * dev,u16 channel)409*4882a593Smuzhiyun static inline void FLUSH_RX_CHANNEL (hrz_dev * dev, u16 channel) {
410*4882a593Smuzhiyun   wr_regw (dev, RX_CHANNEL_PORT_OFF, FLUSH_CHANNEL | channel);
411*4882a593Smuzhiyun   return;
412*4882a593Smuzhiyun }
413*4882a593Smuzhiyun 
WAIT_FLUSH_RX_COMPLETE(hrz_dev * dev)414*4882a593Smuzhiyun static void WAIT_FLUSH_RX_COMPLETE (hrz_dev * dev) {
415*4882a593Smuzhiyun   while (rd_regw (dev, RX_CHANNEL_PORT_OFF) & FLUSH_CHANNEL)
416*4882a593Smuzhiyun     ;
417*4882a593Smuzhiyun   return;
418*4882a593Smuzhiyun }
419*4882a593Smuzhiyun 
SELECT_RX_CHANNEL(hrz_dev * dev,u16 channel)420*4882a593Smuzhiyun static inline void SELECT_RX_CHANNEL (hrz_dev * dev, u16 channel) {
421*4882a593Smuzhiyun   wr_regw (dev, RX_CHANNEL_PORT_OFF, channel);
422*4882a593Smuzhiyun   return;
423*4882a593Smuzhiyun }
424*4882a593Smuzhiyun 
WAIT_UPDATE_COMPLETE(hrz_dev * dev)425*4882a593Smuzhiyun static void WAIT_UPDATE_COMPLETE (hrz_dev * dev) {
426*4882a593Smuzhiyun   while (rd_regw (dev, RX_CHANNEL_PORT_OFF) & RX_CHANNEL_UPDATE_IN_PROGRESS)
427*4882a593Smuzhiyun     ;
428*4882a593Smuzhiyun   return;
429*4882a593Smuzhiyun }
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun /* TX */
432*4882a593Smuzhiyun 
SELECT_TX_CHANNEL(hrz_dev * dev,u16 tx_channel)433*4882a593Smuzhiyun static inline void SELECT_TX_CHANNEL (hrz_dev * dev, u16 tx_channel) {
434*4882a593Smuzhiyun   wr_regl (dev, TX_CHANNEL_PORT_OFF, tx_channel);
435*4882a593Smuzhiyun   return;
436*4882a593Smuzhiyun }
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun /* Update or query one configuration parameter of a particular channel. */
439*4882a593Smuzhiyun 
update_tx_channel_config(hrz_dev * dev,short chan,u8 mode,u16 value)440*4882a593Smuzhiyun static inline void update_tx_channel_config (hrz_dev * dev, short chan, u8 mode, u16 value) {
441*4882a593Smuzhiyun   wr_regw (dev, TX_CHANNEL_CONFIG_COMMAND_OFF,
442*4882a593Smuzhiyun 	   chan * TX_CHANNEL_CONFIG_MULT | mode);
443*4882a593Smuzhiyun     wr_regw (dev, TX_CHANNEL_CONFIG_DATA_OFF, value);
444*4882a593Smuzhiyun     return;
445*4882a593Smuzhiyun }
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun /********** dump functions **********/
448*4882a593Smuzhiyun 
dump_skb(char * prefix,unsigned int vc,struct sk_buff * skb)449*4882a593Smuzhiyun static inline void dump_skb (char * prefix, unsigned int vc, struct sk_buff * skb) {
450*4882a593Smuzhiyun #ifdef DEBUG_HORIZON
451*4882a593Smuzhiyun   unsigned int i;
452*4882a593Smuzhiyun   unsigned char * data = skb->data;
453*4882a593Smuzhiyun   PRINTDB (DBG_DATA, "%s(%u) ", prefix, vc);
454*4882a593Smuzhiyun   for (i=0; i<skb->len && i < 256;i++)
455*4882a593Smuzhiyun     PRINTDM (DBG_DATA, "%02x ", data[i]);
456*4882a593Smuzhiyun   PRINTDE (DBG_DATA,"");
457*4882a593Smuzhiyun #else
458*4882a593Smuzhiyun   (void) prefix;
459*4882a593Smuzhiyun   (void) vc;
460*4882a593Smuzhiyun   (void) skb;
461*4882a593Smuzhiyun #endif
462*4882a593Smuzhiyun   return;
463*4882a593Smuzhiyun }
464*4882a593Smuzhiyun 
dump_regs(hrz_dev * dev)465*4882a593Smuzhiyun static inline void dump_regs (hrz_dev * dev) {
466*4882a593Smuzhiyun #ifdef DEBUG_HORIZON
467*4882a593Smuzhiyun   PRINTD (DBG_REGS, "CONTROL 0: %#x", rd_regl (dev, CONTROL_0_REG));
468*4882a593Smuzhiyun   PRINTD (DBG_REGS, "RX CONFIG: %#x", rd_regw (dev, RX_CONFIG_OFF));
469*4882a593Smuzhiyun   PRINTD (DBG_REGS, "TX CONFIG: %#x", rd_regw (dev, TX_CONFIG_OFF));
470*4882a593Smuzhiyun   PRINTD (DBG_REGS, "TX STATUS: %#x", rd_regw (dev, TX_STATUS_OFF));
471*4882a593Smuzhiyun   PRINTD (DBG_REGS, "IRQ ENBLE: %#x", rd_regl (dev, INT_ENABLE_REG_OFF));
472*4882a593Smuzhiyun   PRINTD (DBG_REGS, "IRQ SORCE: %#x", rd_regl (dev, INT_SOURCE_REG_OFF));
473*4882a593Smuzhiyun #else
474*4882a593Smuzhiyun   (void) dev;
475*4882a593Smuzhiyun #endif
476*4882a593Smuzhiyun   return;
477*4882a593Smuzhiyun }
478*4882a593Smuzhiyun 
dump_framer(hrz_dev * dev)479*4882a593Smuzhiyun static inline void dump_framer (hrz_dev * dev) {
480*4882a593Smuzhiyun #ifdef DEBUG_HORIZON
481*4882a593Smuzhiyun   unsigned int i;
482*4882a593Smuzhiyun   PRINTDB (DBG_REGS, "framer registers:");
483*4882a593Smuzhiyun   for (i = 0; i < 0x10; ++i)
484*4882a593Smuzhiyun     PRINTDM (DBG_REGS, " %02x", rd_framer (dev, i));
485*4882a593Smuzhiyun   PRINTDE (DBG_REGS,"");
486*4882a593Smuzhiyun #else
487*4882a593Smuzhiyun   (void) dev;
488*4882a593Smuzhiyun #endif
489*4882a593Smuzhiyun   return;
490*4882a593Smuzhiyun }
491*4882a593Smuzhiyun 
492*4882a593Smuzhiyun /********** VPI/VCI <-> (RX) channel conversions **********/
493*4882a593Smuzhiyun 
494*4882a593Smuzhiyun /* RX channels are 10 bit integers, these fns are quite paranoid */
495*4882a593Smuzhiyun 
vpivci_to_channel(u16 * channel,const short vpi,const int vci)496*4882a593Smuzhiyun static inline int vpivci_to_channel (u16 * channel, const short vpi, const int vci) {
497*4882a593Smuzhiyun   unsigned short vci_bits = 10 - vpi_bits;
498*4882a593Smuzhiyun   if (0 <= vpi && vpi < 1<<vpi_bits && 0 <= vci && vci < 1<<vci_bits) {
499*4882a593Smuzhiyun     *channel = vpi<<vci_bits | vci;
500*4882a593Smuzhiyun     return *channel ? 0 : -EINVAL;
501*4882a593Smuzhiyun   }
502*4882a593Smuzhiyun   return -EINVAL;
503*4882a593Smuzhiyun }
504*4882a593Smuzhiyun 
505*4882a593Smuzhiyun /********** decode RX queue entries **********/
506*4882a593Smuzhiyun 
rx_q_entry_to_length(u32 x)507*4882a593Smuzhiyun static inline u16 rx_q_entry_to_length (u32 x) {
508*4882a593Smuzhiyun   return x & RX_Q_ENTRY_LENGTH_MASK;
509*4882a593Smuzhiyun }
510*4882a593Smuzhiyun 
rx_q_entry_to_rx_channel(u32 x)511*4882a593Smuzhiyun static inline u16 rx_q_entry_to_rx_channel (u32 x) {
512*4882a593Smuzhiyun   return (x>>RX_Q_ENTRY_CHANNEL_SHIFT) & RX_CHANNEL_MASK;
513*4882a593Smuzhiyun }
514*4882a593Smuzhiyun 
515*4882a593Smuzhiyun /* Cell Transmit Rate Values
516*4882a593Smuzhiyun  *
517*4882a593Smuzhiyun  * the cell transmit rate (cells per sec) can be set to a variety of
518*4882a593Smuzhiyun  * different values by specifying two parameters: a timer preload from
519*4882a593Smuzhiyun  * 1 to 16 (stored as 0 to 15) and a clock divider (2 to the power of
520*4882a593Smuzhiyun  * an exponent from 0 to 14; the special value 15 disables the timer).
521*4882a593Smuzhiyun  *
522*4882a593Smuzhiyun  * cellrate = baserate / (preload * 2^divider)
523*4882a593Smuzhiyun  *
524*4882a593Smuzhiyun  * The maximum cell rate that can be specified is therefore just the
525*4882a593Smuzhiyun  * base rate. Halving the preload is equivalent to adding 1 to the
526*4882a593Smuzhiyun  * divider and so values 1 to 8 of the preload are redundant except
527*4882a593Smuzhiyun  * in the case of a maximal divider (14).
528*4882a593Smuzhiyun  *
529*4882a593Smuzhiyun  * Given a desired cell rate, an algorithm to determine the preload
530*4882a593Smuzhiyun  * and divider is:
531*4882a593Smuzhiyun  *
532*4882a593Smuzhiyun  * a) x = baserate / cellrate, want p * 2^d = x (as far as possible)
533*4882a593Smuzhiyun  * b) if x > 16 * 2^14 then set p = 16, d = 14 (min rate), done
534*4882a593Smuzhiyun  *    if x <= 16 then set p = x, d = 0 (high rates), done
535*4882a593Smuzhiyun  * c) now have 16 < x <= 2^18, or 1 < x/16 <= 2^14 and we want to
536*4882a593Smuzhiyun  *    know n such that 2^(n-1) < x/16 <= 2^n, so slide a bit until
537*4882a593Smuzhiyun  *    we find the range (n will be between 1 and 14), set d = n
538*4882a593Smuzhiyun  * d) Also have 8 < x/2^n <= 16, so set p nearest x/2^n
539*4882a593Smuzhiyun  *
540*4882a593Smuzhiyun  * The algorithm used below is a minor variant of the above.
541*4882a593Smuzhiyun  *
542*4882a593Smuzhiyun  * The base rate is derived from the oscillator frequency (Hz) using a
543*4882a593Smuzhiyun  * fixed divider:
544*4882a593Smuzhiyun  *
545*4882a593Smuzhiyun  * baserate = freq / 32 in the case of some Unknown Card
546*4882a593Smuzhiyun  * baserate = freq / 8  in the case of the Horizon        25
547*4882a593Smuzhiyun  * baserate = freq / 8  in the case of the Horizon Ultra 155
548*4882a593Smuzhiyun  *
549*4882a593Smuzhiyun  * The Horizon cards have oscillators and base rates as follows:
550*4882a593Smuzhiyun  *
551*4882a593Smuzhiyun  * Card               Oscillator  Base Rate
552*4882a593Smuzhiyun  * Unknown Card       33 MHz      1.03125 MHz (33 MHz = PCI freq)
553*4882a593Smuzhiyun  * Horizon        25  32 MHz      4       MHz
554*4882a593Smuzhiyun  * Horizon Ultra 155  40 MHz      5       MHz
555*4882a593Smuzhiyun  *
556*4882a593Smuzhiyun  * The following defines give the base rates in Hz. These were
557*4882a593Smuzhiyun  * previously a factor of 100 larger, no doubt someone was using
558*4882a593Smuzhiyun  * cps*100.
559*4882a593Smuzhiyun  */
560*4882a593Smuzhiyun 
561*4882a593Smuzhiyun #define BR_UKN 1031250l
562*4882a593Smuzhiyun #define BR_HRZ 4000000l
563*4882a593Smuzhiyun #define BR_ULT 5000000l
564*4882a593Smuzhiyun 
565*4882a593Smuzhiyun // d is an exponent
566*4882a593Smuzhiyun #define CR_MIND 0
567*4882a593Smuzhiyun #define CR_MAXD 14
568*4882a593Smuzhiyun 
569*4882a593Smuzhiyun // p ranges from 1 to a power of 2
570*4882a593Smuzhiyun #define CR_MAXPEXP 4
571*4882a593Smuzhiyun 
make_rate(const hrz_dev * dev,u32 c,rounding r,u16 * bits,unsigned int * actual)572*4882a593Smuzhiyun static int make_rate (const hrz_dev * dev, u32 c, rounding r,
573*4882a593Smuzhiyun 		      u16 * bits, unsigned int * actual)
574*4882a593Smuzhiyun {
575*4882a593Smuzhiyun 	// note: rounding the rate down means rounding 'p' up
576*4882a593Smuzhiyun 	const unsigned long br = test_bit(ultra, &dev->flags) ? BR_ULT : BR_HRZ;
577*4882a593Smuzhiyun 
578*4882a593Smuzhiyun 	u32 div = CR_MIND;
579*4882a593Smuzhiyun 	u32 pre;
580*4882a593Smuzhiyun 
581*4882a593Smuzhiyun 	// br_exp and br_man are used to avoid overflowing (c*maxp*2^d) in
582*4882a593Smuzhiyun 	// the tests below. We could think harder about exact possibilities
583*4882a593Smuzhiyun 	// of failure...
584*4882a593Smuzhiyun 
585*4882a593Smuzhiyun 	unsigned long br_man = br;
586*4882a593Smuzhiyun 	unsigned int br_exp = 0;
587*4882a593Smuzhiyun 
588*4882a593Smuzhiyun 	PRINTD (DBG_QOS|DBG_FLOW, "make_rate b=%lu, c=%u, %s", br, c,
589*4882a593Smuzhiyun 		r == round_up ? "up" : r == round_down ? "down" : "nearest");
590*4882a593Smuzhiyun 
591*4882a593Smuzhiyun 	// avoid div by zero
592*4882a593Smuzhiyun 	if (!c) {
593*4882a593Smuzhiyun 		PRINTD (DBG_QOS|DBG_ERR, "zero rate is not allowed!");
594*4882a593Smuzhiyun 		return -EINVAL;
595*4882a593Smuzhiyun 	}
596*4882a593Smuzhiyun 
597*4882a593Smuzhiyun 	while (br_exp < CR_MAXPEXP + CR_MIND && (br_man % 2 == 0)) {
598*4882a593Smuzhiyun 		br_man = br_man >> 1;
599*4882a593Smuzhiyun 		++br_exp;
600*4882a593Smuzhiyun 	}
601*4882a593Smuzhiyun 	// (br >>br_exp) <<br_exp == br and
602*4882a593Smuzhiyun 	// br_exp <= CR_MAXPEXP+CR_MIND
603*4882a593Smuzhiyun 
604*4882a593Smuzhiyun 	if (br_man <= (c << (CR_MAXPEXP+CR_MIND-br_exp))) {
605*4882a593Smuzhiyun 		// Equivalent to: B <= (c << (MAXPEXP+MIND))
606*4882a593Smuzhiyun 		// take care of rounding
607*4882a593Smuzhiyun 		switch (r) {
608*4882a593Smuzhiyun 			case round_down:
609*4882a593Smuzhiyun 				pre = DIV_ROUND_UP(br, c<<div);
610*4882a593Smuzhiyun 				// but p must be non-zero
611*4882a593Smuzhiyun 				if (!pre)
612*4882a593Smuzhiyun 					pre = 1;
613*4882a593Smuzhiyun 				break;
614*4882a593Smuzhiyun 			case round_nearest:
615*4882a593Smuzhiyun 				pre = DIV_ROUND_CLOSEST(br, c<<div);
616*4882a593Smuzhiyun 				// but p must be non-zero
617*4882a593Smuzhiyun 				if (!pre)
618*4882a593Smuzhiyun 					pre = 1;
619*4882a593Smuzhiyun 				break;
620*4882a593Smuzhiyun 			default:	/* round_up */
621*4882a593Smuzhiyun 				pre = br/(c<<div);
622*4882a593Smuzhiyun 				// but p must be non-zero
623*4882a593Smuzhiyun 				if (!pre)
624*4882a593Smuzhiyun 					return -EINVAL;
625*4882a593Smuzhiyun 		}
626*4882a593Smuzhiyun 		PRINTD (DBG_QOS, "A: p=%u, d=%u", pre, div);
627*4882a593Smuzhiyun 		goto got_it;
628*4882a593Smuzhiyun 	}
629*4882a593Smuzhiyun 
630*4882a593Smuzhiyun 	// at this point we have
631*4882a593Smuzhiyun 	// d == MIND and (c << (MAXPEXP+MIND)) < B
632*4882a593Smuzhiyun 	while (div < CR_MAXD) {
633*4882a593Smuzhiyun 		div++;
634*4882a593Smuzhiyun 		if (br_man <= (c << (CR_MAXPEXP+div-br_exp))) {
635*4882a593Smuzhiyun 			// Equivalent to: B <= (c << (MAXPEXP+d))
636*4882a593Smuzhiyun 			// c << (MAXPEXP+d-1) < B <= c << (MAXPEXP+d)
637*4882a593Smuzhiyun 			// 1 << (MAXPEXP-1) < B/2^d/c <= 1 << MAXPEXP
638*4882a593Smuzhiyun 			// MAXP/2 < B/c2^d <= MAXP
639*4882a593Smuzhiyun 			// take care of rounding
640*4882a593Smuzhiyun 			switch (r) {
641*4882a593Smuzhiyun 				case round_down:
642*4882a593Smuzhiyun 					pre = DIV_ROUND_UP(br, c<<div);
643*4882a593Smuzhiyun 					break;
644*4882a593Smuzhiyun 				case round_nearest:
645*4882a593Smuzhiyun 					pre = DIV_ROUND_CLOSEST(br, c<<div);
646*4882a593Smuzhiyun 					break;
647*4882a593Smuzhiyun 				default: /* round_up */
648*4882a593Smuzhiyun 					pre = br/(c<<div);
649*4882a593Smuzhiyun 			}
650*4882a593Smuzhiyun 			PRINTD (DBG_QOS, "B: p=%u, d=%u", pre, div);
651*4882a593Smuzhiyun 			goto got_it;
652*4882a593Smuzhiyun 		}
653*4882a593Smuzhiyun 	}
654*4882a593Smuzhiyun 	// at this point we have
655*4882a593Smuzhiyun 	// d == MAXD and (c << (MAXPEXP+MAXD)) < B
656*4882a593Smuzhiyun 	// but we cannot go any higher
657*4882a593Smuzhiyun 	// take care of rounding
658*4882a593Smuzhiyun 	if (r == round_down)
659*4882a593Smuzhiyun 		return -EINVAL;
660*4882a593Smuzhiyun 	pre = 1 << CR_MAXPEXP;
661*4882a593Smuzhiyun 	PRINTD (DBG_QOS, "C: p=%u, d=%u", pre, div);
662*4882a593Smuzhiyun got_it:
663*4882a593Smuzhiyun 	// paranoia
664*4882a593Smuzhiyun 	if (div > CR_MAXD || (!pre) || pre > 1<<CR_MAXPEXP) {
665*4882a593Smuzhiyun 		PRINTD (DBG_QOS, "set_cr internal failure: d=%u p=%u",
666*4882a593Smuzhiyun 			div, pre);
667*4882a593Smuzhiyun 		return -EINVAL;
668*4882a593Smuzhiyun 	} else {
669*4882a593Smuzhiyun 		if (bits)
670*4882a593Smuzhiyun 			*bits = (div<<CLOCK_SELECT_SHIFT) | (pre-1);
671*4882a593Smuzhiyun 		if (actual) {
672*4882a593Smuzhiyun 			*actual = DIV_ROUND_UP(br, pre<<div);
673*4882a593Smuzhiyun 			PRINTD (DBG_QOS, "actual rate: %u", *actual);
674*4882a593Smuzhiyun 		}
675*4882a593Smuzhiyun 		return 0;
676*4882a593Smuzhiyun 	}
677*4882a593Smuzhiyun }
678*4882a593Smuzhiyun 
make_rate_with_tolerance(const hrz_dev * dev,u32 c,rounding r,unsigned int tol,u16 * bit_pattern,unsigned int * actual)679*4882a593Smuzhiyun static int make_rate_with_tolerance (const hrz_dev * dev, u32 c, rounding r, unsigned int tol,
680*4882a593Smuzhiyun 				     u16 * bit_pattern, unsigned int * actual) {
681*4882a593Smuzhiyun   unsigned int my_actual;
682*4882a593Smuzhiyun 
683*4882a593Smuzhiyun   PRINTD (DBG_QOS|DBG_FLOW, "make_rate_with_tolerance c=%u, %s, tol=%u",
684*4882a593Smuzhiyun 	  c, (r == round_up) ? "up" : (r == round_down) ? "down" : "nearest", tol);
685*4882a593Smuzhiyun 
686*4882a593Smuzhiyun   if (!actual)
687*4882a593Smuzhiyun     // actual rate is not returned
688*4882a593Smuzhiyun     actual = &my_actual;
689*4882a593Smuzhiyun 
690*4882a593Smuzhiyun   if (make_rate (dev, c, round_nearest, bit_pattern, actual))
691*4882a593Smuzhiyun     // should never happen as round_nearest always succeeds
692*4882a593Smuzhiyun     return -1;
693*4882a593Smuzhiyun 
694*4882a593Smuzhiyun   if (c - tol <= *actual && *actual <= c + tol)
695*4882a593Smuzhiyun     // within tolerance
696*4882a593Smuzhiyun     return 0;
697*4882a593Smuzhiyun   else
698*4882a593Smuzhiyun     // intolerant, try rounding instead
699*4882a593Smuzhiyun     return make_rate (dev, c, r, bit_pattern, actual);
700*4882a593Smuzhiyun }
701*4882a593Smuzhiyun 
702*4882a593Smuzhiyun /********** Listen on a VC **********/
703*4882a593Smuzhiyun 
hrz_open_rx(hrz_dev * dev,u16 channel)704*4882a593Smuzhiyun static int hrz_open_rx (hrz_dev * dev, u16 channel) {
705*4882a593Smuzhiyun   // is there any guarantee that we don't get two simulataneous
706*4882a593Smuzhiyun   // identical calls of this function from different processes? yes
707*4882a593Smuzhiyun   // rate_lock
708*4882a593Smuzhiyun   unsigned long flags;
709*4882a593Smuzhiyun   u32 channel_type; // u16?
710*4882a593Smuzhiyun 
711*4882a593Smuzhiyun   u16 buf_ptr = RX_CHANNEL_IDLE;
712*4882a593Smuzhiyun 
713*4882a593Smuzhiyun   rx_ch_desc * rx_desc = &memmap->rx_descs[channel];
714*4882a593Smuzhiyun 
715*4882a593Smuzhiyun   PRINTD (DBG_FLOW, "hrz_open_rx %x", channel);
716*4882a593Smuzhiyun 
717*4882a593Smuzhiyun   spin_lock_irqsave (&dev->mem_lock, flags);
718*4882a593Smuzhiyun   channel_type = rd_mem (dev, &rx_desc->wr_buf_type) & BUFFER_PTR_MASK;
719*4882a593Smuzhiyun   spin_unlock_irqrestore (&dev->mem_lock, flags);
720*4882a593Smuzhiyun 
721*4882a593Smuzhiyun   // very serious error, should never occur
722*4882a593Smuzhiyun   if (channel_type != RX_CHANNEL_DISABLED) {
723*4882a593Smuzhiyun     PRINTD (DBG_ERR|DBG_VCC, "RX channel for VC already open");
724*4882a593Smuzhiyun     return -EBUSY; // clean up?
725*4882a593Smuzhiyun   }
726*4882a593Smuzhiyun 
727*4882a593Smuzhiyun   // Give back spare buffer
728*4882a593Smuzhiyun   if (dev->noof_spare_buffers) {
729*4882a593Smuzhiyun     buf_ptr = dev->spare_buffers[--dev->noof_spare_buffers];
730*4882a593Smuzhiyun     PRINTD (DBG_VCC, "using a spare buffer: %u", buf_ptr);
731*4882a593Smuzhiyun     // should never occur
732*4882a593Smuzhiyun     if (buf_ptr == RX_CHANNEL_DISABLED || buf_ptr == RX_CHANNEL_IDLE) {
733*4882a593Smuzhiyun       // but easy to recover from
734*4882a593Smuzhiyun       PRINTD (DBG_ERR|DBG_VCC, "bad spare buffer pointer, using IDLE");
735*4882a593Smuzhiyun       buf_ptr = RX_CHANNEL_IDLE;
736*4882a593Smuzhiyun     }
737*4882a593Smuzhiyun   } else {
738*4882a593Smuzhiyun     PRINTD (DBG_VCC, "using IDLE buffer pointer");
739*4882a593Smuzhiyun   }
740*4882a593Smuzhiyun 
741*4882a593Smuzhiyun   // Channel is currently disabled so change its status to idle
742*4882a593Smuzhiyun 
743*4882a593Smuzhiyun   // do we really need to save the flags again?
744*4882a593Smuzhiyun   spin_lock_irqsave (&dev->mem_lock, flags);
745*4882a593Smuzhiyun 
746*4882a593Smuzhiyun   wr_mem (dev, &rx_desc->wr_buf_type,
747*4882a593Smuzhiyun 	  buf_ptr | CHANNEL_TYPE_AAL5 | FIRST_CELL_OF_AAL5_FRAME);
748*4882a593Smuzhiyun   if (buf_ptr != RX_CHANNEL_IDLE)
749*4882a593Smuzhiyun     wr_mem (dev, &rx_desc->rd_buf_type, buf_ptr);
750*4882a593Smuzhiyun 
751*4882a593Smuzhiyun   spin_unlock_irqrestore (&dev->mem_lock, flags);
752*4882a593Smuzhiyun 
753*4882a593Smuzhiyun   // rxer->rate = make_rate (qos->peak_cells);
754*4882a593Smuzhiyun 
755*4882a593Smuzhiyun   PRINTD (DBG_FLOW, "hrz_open_rx ok");
756*4882a593Smuzhiyun 
757*4882a593Smuzhiyun   return 0;
758*4882a593Smuzhiyun }
759*4882a593Smuzhiyun 
760*4882a593Smuzhiyun #if 0
761*4882a593Smuzhiyun /********** change vc rate for a given vc **********/
762*4882a593Smuzhiyun 
763*4882a593Smuzhiyun static void hrz_change_vc_qos (ATM_RXER * rxer, MAAL_QOS * qos) {
764*4882a593Smuzhiyun   rxer->rate = make_rate (qos->peak_cells);
765*4882a593Smuzhiyun }
766*4882a593Smuzhiyun #endif
767*4882a593Smuzhiyun 
768*4882a593Smuzhiyun /********** free an skb (as per ATM device driver documentation) **********/
769*4882a593Smuzhiyun 
hrz_kfree_skb(struct sk_buff * skb)770*4882a593Smuzhiyun static void hrz_kfree_skb (struct sk_buff * skb) {
771*4882a593Smuzhiyun   if (ATM_SKB(skb)->vcc->pop) {
772*4882a593Smuzhiyun     ATM_SKB(skb)->vcc->pop (ATM_SKB(skb)->vcc, skb);
773*4882a593Smuzhiyun   } else {
774*4882a593Smuzhiyun     dev_kfree_skb_any (skb);
775*4882a593Smuzhiyun   }
776*4882a593Smuzhiyun }
777*4882a593Smuzhiyun 
778*4882a593Smuzhiyun /********** cancel listen on a VC **********/
779*4882a593Smuzhiyun 
hrz_close_rx(hrz_dev * dev,u16 vc)780*4882a593Smuzhiyun static void hrz_close_rx (hrz_dev * dev, u16 vc) {
781*4882a593Smuzhiyun   unsigned long flags;
782*4882a593Smuzhiyun 
783*4882a593Smuzhiyun   u32 value;
784*4882a593Smuzhiyun 
785*4882a593Smuzhiyun   u32 r1, r2;
786*4882a593Smuzhiyun 
787*4882a593Smuzhiyun   rx_ch_desc * rx_desc = &memmap->rx_descs[vc];
788*4882a593Smuzhiyun 
789*4882a593Smuzhiyun   int was_idle = 0;
790*4882a593Smuzhiyun 
791*4882a593Smuzhiyun   spin_lock_irqsave (&dev->mem_lock, flags);
792*4882a593Smuzhiyun   value = rd_mem (dev, &rx_desc->wr_buf_type) & BUFFER_PTR_MASK;
793*4882a593Smuzhiyun   spin_unlock_irqrestore (&dev->mem_lock, flags);
794*4882a593Smuzhiyun 
795*4882a593Smuzhiyun   if (value == RX_CHANNEL_DISABLED) {
796*4882a593Smuzhiyun     // I suppose this could happen once we deal with _NONE traffic properly
797*4882a593Smuzhiyun     PRINTD (DBG_VCC, "closing VC: RX channel %u already disabled", vc);
798*4882a593Smuzhiyun     return;
799*4882a593Smuzhiyun   }
800*4882a593Smuzhiyun   if (value == RX_CHANNEL_IDLE)
801*4882a593Smuzhiyun     was_idle = 1;
802*4882a593Smuzhiyun 
803*4882a593Smuzhiyun   spin_lock_irqsave (&dev->mem_lock, flags);
804*4882a593Smuzhiyun 
805*4882a593Smuzhiyun   for (;;) {
806*4882a593Smuzhiyun     wr_mem (dev, &rx_desc->wr_buf_type, RX_CHANNEL_DISABLED);
807*4882a593Smuzhiyun 
808*4882a593Smuzhiyun     if ((rd_mem (dev, &rx_desc->wr_buf_type) & BUFFER_PTR_MASK) == RX_CHANNEL_DISABLED)
809*4882a593Smuzhiyun       break;
810*4882a593Smuzhiyun 
811*4882a593Smuzhiyun     was_idle = 0;
812*4882a593Smuzhiyun   }
813*4882a593Smuzhiyun 
814*4882a593Smuzhiyun   if (was_idle) {
815*4882a593Smuzhiyun     spin_unlock_irqrestore (&dev->mem_lock, flags);
816*4882a593Smuzhiyun     return;
817*4882a593Smuzhiyun   }
818*4882a593Smuzhiyun 
819*4882a593Smuzhiyun   WAIT_FLUSH_RX_COMPLETE(dev);
820*4882a593Smuzhiyun 
821*4882a593Smuzhiyun   // XXX Is this all really necessary? We can rely on the rx_data_av
822*4882a593Smuzhiyun   // handler to discard frames that remain queued for delivery. If the
823*4882a593Smuzhiyun   // worry is that immediately reopening the channel (perhaps by a
824*4882a593Smuzhiyun   // different process) may cause some data to be mis-delivered then
825*4882a593Smuzhiyun   // there may still be a simpler solution (such as busy-waiting on
826*4882a593Smuzhiyun   // rx_busy once the channel is disabled or before a new one is
827*4882a593Smuzhiyun   // opened - does this leave any holes?). Arguably setting up and
828*4882a593Smuzhiyun   // tearing down the TX and RX halves of each virtual circuit could
829*4882a593Smuzhiyun   // most safely be done within ?x_busy protected regions.
830*4882a593Smuzhiyun 
831*4882a593Smuzhiyun   // OK, current changes are that Simon's marker is disabled and we DO
832*4882a593Smuzhiyun   // look for NULL rxer elsewhere. The code here seems flush frames
833*4882a593Smuzhiyun   // and then remember the last dead cell belonging to the channel
834*4882a593Smuzhiyun   // just disabled - the cell gets relinked at the next vc_open.
835*4882a593Smuzhiyun   // However, when all VCs are closed or only a few opened there are a
836*4882a593Smuzhiyun   // handful of buffers that are unusable.
837*4882a593Smuzhiyun 
838*4882a593Smuzhiyun   // Does anyone feel like documenting spare_buffers properly?
839*4882a593Smuzhiyun   // Does anyone feel like fixing this in a nicer way?
840*4882a593Smuzhiyun 
841*4882a593Smuzhiyun   // Flush any data which is left in the channel
842*4882a593Smuzhiyun   for (;;) {
843*4882a593Smuzhiyun     // Change the rx channel port to something different to the RX
844*4882a593Smuzhiyun     // channel we are trying to close to force Horizon to flush the rx
845*4882a593Smuzhiyun     // channel read and write pointers.
846*4882a593Smuzhiyun 
847*4882a593Smuzhiyun     u16 other = vc^(RX_CHANS/2);
848*4882a593Smuzhiyun 
849*4882a593Smuzhiyun     SELECT_RX_CHANNEL (dev, other);
850*4882a593Smuzhiyun     WAIT_UPDATE_COMPLETE (dev);
851*4882a593Smuzhiyun 
852*4882a593Smuzhiyun     r1 = rd_mem (dev, &rx_desc->rd_buf_type);
853*4882a593Smuzhiyun 
854*4882a593Smuzhiyun     // Select this RX channel. Flush doesn't seem to work unless we
855*4882a593Smuzhiyun     // select an RX channel before hand
856*4882a593Smuzhiyun 
857*4882a593Smuzhiyun     SELECT_RX_CHANNEL (dev, vc);
858*4882a593Smuzhiyun     WAIT_UPDATE_COMPLETE (dev);
859*4882a593Smuzhiyun 
860*4882a593Smuzhiyun     // Attempt to flush a frame on this RX channel
861*4882a593Smuzhiyun 
862*4882a593Smuzhiyun     FLUSH_RX_CHANNEL (dev, vc);
863*4882a593Smuzhiyun     WAIT_FLUSH_RX_COMPLETE (dev);
864*4882a593Smuzhiyun 
865*4882a593Smuzhiyun     // Force Horizon to flush rx channel read and write pointers as before
866*4882a593Smuzhiyun 
867*4882a593Smuzhiyun     SELECT_RX_CHANNEL (dev, other);
868*4882a593Smuzhiyun     WAIT_UPDATE_COMPLETE (dev);
869*4882a593Smuzhiyun 
870*4882a593Smuzhiyun     r2 = rd_mem (dev, &rx_desc->rd_buf_type);
871*4882a593Smuzhiyun 
872*4882a593Smuzhiyun     PRINTD (DBG_VCC|DBG_RX, "r1 = %u, r2 = %u", r1, r2);
873*4882a593Smuzhiyun 
874*4882a593Smuzhiyun     if (r1 == r2) {
875*4882a593Smuzhiyun       dev->spare_buffers[dev->noof_spare_buffers++] = (u16)r1;
876*4882a593Smuzhiyun       break;
877*4882a593Smuzhiyun     }
878*4882a593Smuzhiyun   }
879*4882a593Smuzhiyun 
880*4882a593Smuzhiyun #if 0
881*4882a593Smuzhiyun   {
882*4882a593Smuzhiyun     rx_q_entry * wr_ptr = &memmap->rx_q_entries[rd_regw (dev, RX_QUEUE_WR_PTR_OFF)];
883*4882a593Smuzhiyun     rx_q_entry * rd_ptr = dev->rx_q_entry;
884*4882a593Smuzhiyun 
885*4882a593Smuzhiyun     PRINTD (DBG_VCC|DBG_RX, "rd_ptr = %u, wr_ptr = %u", rd_ptr, wr_ptr);
886*4882a593Smuzhiyun 
887*4882a593Smuzhiyun     while (rd_ptr != wr_ptr) {
888*4882a593Smuzhiyun       u32 x = rd_mem (dev, (HDW *) rd_ptr);
889*4882a593Smuzhiyun 
890*4882a593Smuzhiyun       if (vc == rx_q_entry_to_rx_channel (x)) {
891*4882a593Smuzhiyun 	x |= SIMONS_DODGEY_MARKER;
892*4882a593Smuzhiyun 
893*4882a593Smuzhiyun 	PRINTD (DBG_RX|DBG_VCC|DBG_WARN, "marking a frame as dodgey");
894*4882a593Smuzhiyun 
895*4882a593Smuzhiyun 	wr_mem (dev, (HDW *) rd_ptr, x);
896*4882a593Smuzhiyun       }
897*4882a593Smuzhiyun 
898*4882a593Smuzhiyun       if (rd_ptr == dev->rx_q_wrap)
899*4882a593Smuzhiyun 	rd_ptr = dev->rx_q_reset;
900*4882a593Smuzhiyun       else
901*4882a593Smuzhiyun 	rd_ptr++;
902*4882a593Smuzhiyun     }
903*4882a593Smuzhiyun   }
904*4882a593Smuzhiyun #endif
905*4882a593Smuzhiyun 
906*4882a593Smuzhiyun   spin_unlock_irqrestore (&dev->mem_lock, flags);
907*4882a593Smuzhiyun 
908*4882a593Smuzhiyun   return;
909*4882a593Smuzhiyun }
910*4882a593Smuzhiyun 
911*4882a593Smuzhiyun /********** schedule RX transfers **********/
912*4882a593Smuzhiyun 
913*4882a593Smuzhiyun // Note on tail recursion: a GCC developer said that it is not likely
914*4882a593Smuzhiyun // to be fixed soon, so do not define TAILRECUSRIONWORKS unless you
915*4882a593Smuzhiyun // are sure it does as you may otherwise overflow the kernel stack.
916*4882a593Smuzhiyun 
917*4882a593Smuzhiyun // giving this fn a return value would help GCC, allegedly
918*4882a593Smuzhiyun 
rx_schedule(hrz_dev * dev,int irq)919*4882a593Smuzhiyun static void rx_schedule (hrz_dev * dev, int irq) {
920*4882a593Smuzhiyun   unsigned int rx_bytes;
921*4882a593Smuzhiyun 
922*4882a593Smuzhiyun   int pio_instead = 0;
923*4882a593Smuzhiyun #ifndef TAILRECURSIONWORKS
924*4882a593Smuzhiyun   pio_instead = 1;
925*4882a593Smuzhiyun   while (pio_instead) {
926*4882a593Smuzhiyun #endif
927*4882a593Smuzhiyun     // bytes waiting for RX transfer
928*4882a593Smuzhiyun     rx_bytes = dev->rx_bytes;
929*4882a593Smuzhiyun 
930*4882a593Smuzhiyun #if 0
931*4882a593Smuzhiyun     spin_count = 0;
932*4882a593Smuzhiyun     while (rd_regl (dev, MASTER_RX_COUNT_REG_OFF)) {
933*4882a593Smuzhiyun       PRINTD (DBG_RX|DBG_WARN, "RX error: other PCI Bus Master RX still in progress!");
934*4882a593Smuzhiyun       if (++spin_count > 10) {
935*4882a593Smuzhiyun 	PRINTD (DBG_RX|DBG_ERR, "spun out waiting PCI Bus Master RX completion");
936*4882a593Smuzhiyun 	wr_regl (dev, MASTER_RX_COUNT_REG_OFF, 0);
937*4882a593Smuzhiyun 	clear_bit (rx_busy, &dev->flags);
938*4882a593Smuzhiyun 	hrz_kfree_skb (dev->rx_skb);
939*4882a593Smuzhiyun 	return;
940*4882a593Smuzhiyun       }
941*4882a593Smuzhiyun     }
942*4882a593Smuzhiyun #endif
943*4882a593Smuzhiyun 
944*4882a593Smuzhiyun     // this code follows the TX code but (at the moment) there is only
945*4882a593Smuzhiyun     // one region - the skb itself. I don't know if this will change,
946*4882a593Smuzhiyun     // but it doesn't hurt to have the code here, disabled.
947*4882a593Smuzhiyun 
948*4882a593Smuzhiyun     if (rx_bytes) {
949*4882a593Smuzhiyun       // start next transfer within same region
950*4882a593Smuzhiyun       if (rx_bytes <= MAX_PIO_COUNT) {
951*4882a593Smuzhiyun 	PRINTD (DBG_RX|DBG_BUS, "(pio)");
952*4882a593Smuzhiyun 	pio_instead = 1;
953*4882a593Smuzhiyun       }
954*4882a593Smuzhiyun       if (rx_bytes <= MAX_TRANSFER_COUNT) {
955*4882a593Smuzhiyun 	PRINTD (DBG_RX|DBG_BUS, "(simple or last multi)");
956*4882a593Smuzhiyun 	dev->rx_bytes = 0;
957*4882a593Smuzhiyun       } else {
958*4882a593Smuzhiyun 	PRINTD (DBG_RX|DBG_BUS, "(continuing multi)");
959*4882a593Smuzhiyun 	dev->rx_bytes = rx_bytes - MAX_TRANSFER_COUNT;
960*4882a593Smuzhiyun 	rx_bytes = MAX_TRANSFER_COUNT;
961*4882a593Smuzhiyun       }
962*4882a593Smuzhiyun     } else {
963*4882a593Smuzhiyun       // rx_bytes == 0 -- we're between regions
964*4882a593Smuzhiyun       // regions remaining to transfer
965*4882a593Smuzhiyun #if 0
966*4882a593Smuzhiyun       unsigned int rx_regions = dev->rx_regions;
967*4882a593Smuzhiyun #else
968*4882a593Smuzhiyun       unsigned int rx_regions = 0;
969*4882a593Smuzhiyun #endif
970*4882a593Smuzhiyun 
971*4882a593Smuzhiyun       if (rx_regions) {
972*4882a593Smuzhiyun #if 0
973*4882a593Smuzhiyun 	// start a new region
974*4882a593Smuzhiyun 	dev->rx_addr = dev->rx_iovec->iov_base;
975*4882a593Smuzhiyun 	rx_bytes = dev->rx_iovec->iov_len;
976*4882a593Smuzhiyun 	++dev->rx_iovec;
977*4882a593Smuzhiyun 	dev->rx_regions = rx_regions - 1;
978*4882a593Smuzhiyun 
979*4882a593Smuzhiyun 	if (rx_bytes <= MAX_PIO_COUNT) {
980*4882a593Smuzhiyun 	  PRINTD (DBG_RX|DBG_BUS, "(pio)");
981*4882a593Smuzhiyun 	  pio_instead = 1;
982*4882a593Smuzhiyun 	}
983*4882a593Smuzhiyun 	if (rx_bytes <= MAX_TRANSFER_COUNT) {
984*4882a593Smuzhiyun 	  PRINTD (DBG_RX|DBG_BUS, "(full region)");
985*4882a593Smuzhiyun 	  dev->rx_bytes = 0;
986*4882a593Smuzhiyun 	} else {
987*4882a593Smuzhiyun 	  PRINTD (DBG_RX|DBG_BUS, "(start multi region)");
988*4882a593Smuzhiyun 	  dev->rx_bytes = rx_bytes - MAX_TRANSFER_COUNT;
989*4882a593Smuzhiyun 	  rx_bytes = MAX_TRANSFER_COUNT;
990*4882a593Smuzhiyun 	}
991*4882a593Smuzhiyun #endif
992*4882a593Smuzhiyun       } else {
993*4882a593Smuzhiyun 	// rx_regions == 0
994*4882a593Smuzhiyun 	// that's all folks - end of frame
995*4882a593Smuzhiyun 	struct sk_buff * skb = dev->rx_skb;
996*4882a593Smuzhiyun 	// dev->rx_iovec = 0;
997*4882a593Smuzhiyun 
998*4882a593Smuzhiyun 	FLUSH_RX_CHANNEL (dev, dev->rx_channel);
999*4882a593Smuzhiyun 
1000*4882a593Smuzhiyun 	dump_skb ("<<<", dev->rx_channel, skb);
1001*4882a593Smuzhiyun 
1002*4882a593Smuzhiyun 	PRINTD (DBG_RX|DBG_SKB, "push %p %u", skb->data, skb->len);
1003*4882a593Smuzhiyun 
1004*4882a593Smuzhiyun 	{
1005*4882a593Smuzhiyun 	  struct atm_vcc * vcc = ATM_SKB(skb)->vcc;
1006*4882a593Smuzhiyun 	  // VC layer stats
1007*4882a593Smuzhiyun 	  atomic_inc(&vcc->stats->rx);
1008*4882a593Smuzhiyun 	  __net_timestamp(skb);
1009*4882a593Smuzhiyun 	  // end of our responsibility
1010*4882a593Smuzhiyun 	  vcc->push (vcc, skb);
1011*4882a593Smuzhiyun 	}
1012*4882a593Smuzhiyun       }
1013*4882a593Smuzhiyun     }
1014*4882a593Smuzhiyun 
1015*4882a593Smuzhiyun     // note: writing RX_COUNT clears any interrupt condition
1016*4882a593Smuzhiyun     if (rx_bytes) {
1017*4882a593Smuzhiyun       if (pio_instead) {
1018*4882a593Smuzhiyun 	if (irq)
1019*4882a593Smuzhiyun 	  wr_regl (dev, MASTER_RX_COUNT_REG_OFF, 0);
1020*4882a593Smuzhiyun 	rds_regb (dev, DATA_PORT_OFF, dev->rx_addr, rx_bytes);
1021*4882a593Smuzhiyun       } else {
1022*4882a593Smuzhiyun 	wr_regl (dev, MASTER_RX_ADDR_REG_OFF, virt_to_bus (dev->rx_addr));
1023*4882a593Smuzhiyun 	wr_regl (dev, MASTER_RX_COUNT_REG_OFF, rx_bytes);
1024*4882a593Smuzhiyun       }
1025*4882a593Smuzhiyun       dev->rx_addr += rx_bytes;
1026*4882a593Smuzhiyun     } else {
1027*4882a593Smuzhiyun       if (irq)
1028*4882a593Smuzhiyun 	wr_regl (dev, MASTER_RX_COUNT_REG_OFF, 0);
1029*4882a593Smuzhiyun       // allow another RX thread to start
1030*4882a593Smuzhiyun       YELLOW_LED_ON(dev);
1031*4882a593Smuzhiyun       clear_bit (rx_busy, &dev->flags);
1032*4882a593Smuzhiyun       PRINTD (DBG_RX, "cleared rx_busy for dev %p", dev);
1033*4882a593Smuzhiyun     }
1034*4882a593Smuzhiyun 
1035*4882a593Smuzhiyun #ifdef TAILRECURSIONWORKS
1036*4882a593Smuzhiyun     // and we all bless optimised tail calls
1037*4882a593Smuzhiyun     if (pio_instead)
1038*4882a593Smuzhiyun       return rx_schedule (dev, 0);
1039*4882a593Smuzhiyun     return;
1040*4882a593Smuzhiyun #else
1041*4882a593Smuzhiyun     // grrrrrrr!
1042*4882a593Smuzhiyun     irq = 0;
1043*4882a593Smuzhiyun   }
1044*4882a593Smuzhiyun   return;
1045*4882a593Smuzhiyun #endif
1046*4882a593Smuzhiyun }
1047*4882a593Smuzhiyun 
1048*4882a593Smuzhiyun /********** handle RX bus master complete events **********/
1049*4882a593Smuzhiyun 
rx_bus_master_complete_handler(hrz_dev * dev)1050*4882a593Smuzhiyun static void rx_bus_master_complete_handler (hrz_dev * dev) {
1051*4882a593Smuzhiyun   if (test_bit (rx_busy, &dev->flags)) {
1052*4882a593Smuzhiyun     rx_schedule (dev, 1);
1053*4882a593Smuzhiyun   } else {
1054*4882a593Smuzhiyun     PRINTD (DBG_RX|DBG_ERR, "unexpected RX bus master completion");
1055*4882a593Smuzhiyun     // clear interrupt condition on adapter
1056*4882a593Smuzhiyun     wr_regl (dev, MASTER_RX_COUNT_REG_OFF, 0);
1057*4882a593Smuzhiyun   }
1058*4882a593Smuzhiyun   return;
1059*4882a593Smuzhiyun }
1060*4882a593Smuzhiyun 
1061*4882a593Smuzhiyun /********** (queue to) become the next TX thread **********/
1062*4882a593Smuzhiyun 
tx_hold(hrz_dev * dev)1063*4882a593Smuzhiyun static int tx_hold (hrz_dev * dev) {
1064*4882a593Smuzhiyun   PRINTD (DBG_TX, "sleeping at tx lock %p %lu", dev, dev->flags);
1065*4882a593Smuzhiyun   wait_event_interruptible(dev->tx_queue, (!test_and_set_bit(tx_busy, &dev->flags)));
1066*4882a593Smuzhiyun   PRINTD (DBG_TX, "woken at tx lock %p %lu", dev, dev->flags);
1067*4882a593Smuzhiyun   if (signal_pending (current))
1068*4882a593Smuzhiyun     return -1;
1069*4882a593Smuzhiyun   PRINTD (DBG_TX, "set tx_busy for dev %p", dev);
1070*4882a593Smuzhiyun   return 0;
1071*4882a593Smuzhiyun }
1072*4882a593Smuzhiyun 
1073*4882a593Smuzhiyun /********** allow another TX thread to start **********/
1074*4882a593Smuzhiyun 
tx_release(hrz_dev * dev)1075*4882a593Smuzhiyun static inline void tx_release (hrz_dev * dev) {
1076*4882a593Smuzhiyun   clear_bit (tx_busy, &dev->flags);
1077*4882a593Smuzhiyun   PRINTD (DBG_TX, "cleared tx_busy for dev %p", dev);
1078*4882a593Smuzhiyun   wake_up_interruptible (&dev->tx_queue);
1079*4882a593Smuzhiyun }
1080*4882a593Smuzhiyun 
1081*4882a593Smuzhiyun /********** schedule TX transfers **********/
1082*4882a593Smuzhiyun 
tx_schedule(hrz_dev * const dev,int irq)1083*4882a593Smuzhiyun static void tx_schedule (hrz_dev * const dev, int irq) {
1084*4882a593Smuzhiyun   unsigned int tx_bytes;
1085*4882a593Smuzhiyun 
1086*4882a593Smuzhiyun   int append_desc = 0;
1087*4882a593Smuzhiyun 
1088*4882a593Smuzhiyun   int pio_instead = 0;
1089*4882a593Smuzhiyun #ifndef TAILRECURSIONWORKS
1090*4882a593Smuzhiyun   pio_instead = 1;
1091*4882a593Smuzhiyun   while (pio_instead) {
1092*4882a593Smuzhiyun #endif
1093*4882a593Smuzhiyun     // bytes in current region waiting for TX transfer
1094*4882a593Smuzhiyun     tx_bytes = dev->tx_bytes;
1095*4882a593Smuzhiyun 
1096*4882a593Smuzhiyun #if 0
1097*4882a593Smuzhiyun     spin_count = 0;
1098*4882a593Smuzhiyun     while (rd_regl (dev, MASTER_TX_COUNT_REG_OFF)) {
1099*4882a593Smuzhiyun       PRINTD (DBG_TX|DBG_WARN, "TX error: other PCI Bus Master TX still in progress!");
1100*4882a593Smuzhiyun       if (++spin_count > 10) {
1101*4882a593Smuzhiyun 	PRINTD (DBG_TX|DBG_ERR, "spun out waiting PCI Bus Master TX completion");
1102*4882a593Smuzhiyun 	wr_regl (dev, MASTER_TX_COUNT_REG_OFF, 0);
1103*4882a593Smuzhiyun 	tx_release (dev);
1104*4882a593Smuzhiyun 	hrz_kfree_skb (dev->tx_skb);
1105*4882a593Smuzhiyun 	return;
1106*4882a593Smuzhiyun       }
1107*4882a593Smuzhiyun     }
1108*4882a593Smuzhiyun #endif
1109*4882a593Smuzhiyun 
1110*4882a593Smuzhiyun     if (tx_bytes) {
1111*4882a593Smuzhiyun       // start next transfer within same region
1112*4882a593Smuzhiyun       if (!test_bit (ultra, &dev->flags) || tx_bytes <= MAX_PIO_COUNT) {
1113*4882a593Smuzhiyun 	PRINTD (DBG_TX|DBG_BUS, "(pio)");
1114*4882a593Smuzhiyun 	pio_instead = 1;
1115*4882a593Smuzhiyun       }
1116*4882a593Smuzhiyun       if (tx_bytes <= MAX_TRANSFER_COUNT) {
1117*4882a593Smuzhiyun 	PRINTD (DBG_TX|DBG_BUS, "(simple or last multi)");
1118*4882a593Smuzhiyun 	if (!dev->tx_iovec) {
1119*4882a593Smuzhiyun 	  // end of last region
1120*4882a593Smuzhiyun 	  append_desc = 1;
1121*4882a593Smuzhiyun 	}
1122*4882a593Smuzhiyun 	dev->tx_bytes = 0;
1123*4882a593Smuzhiyun       } else {
1124*4882a593Smuzhiyun 	PRINTD (DBG_TX|DBG_BUS, "(continuing multi)");
1125*4882a593Smuzhiyun 	dev->tx_bytes = tx_bytes - MAX_TRANSFER_COUNT;
1126*4882a593Smuzhiyun 	tx_bytes = MAX_TRANSFER_COUNT;
1127*4882a593Smuzhiyun       }
1128*4882a593Smuzhiyun     } else {
1129*4882a593Smuzhiyun       // tx_bytes == 0 -- we're between regions
1130*4882a593Smuzhiyun       // regions remaining to transfer
1131*4882a593Smuzhiyun       unsigned int tx_regions = dev->tx_regions;
1132*4882a593Smuzhiyun 
1133*4882a593Smuzhiyun       if (tx_regions) {
1134*4882a593Smuzhiyun 	// start a new region
1135*4882a593Smuzhiyun 	dev->tx_addr = dev->tx_iovec->iov_base;
1136*4882a593Smuzhiyun 	tx_bytes = dev->tx_iovec->iov_len;
1137*4882a593Smuzhiyun 	++dev->tx_iovec;
1138*4882a593Smuzhiyun 	dev->tx_regions = tx_regions - 1;
1139*4882a593Smuzhiyun 
1140*4882a593Smuzhiyun 	if (!test_bit (ultra, &dev->flags) || tx_bytes <= MAX_PIO_COUNT) {
1141*4882a593Smuzhiyun 	  PRINTD (DBG_TX|DBG_BUS, "(pio)");
1142*4882a593Smuzhiyun 	  pio_instead = 1;
1143*4882a593Smuzhiyun 	}
1144*4882a593Smuzhiyun 	if (tx_bytes <= MAX_TRANSFER_COUNT) {
1145*4882a593Smuzhiyun 	  PRINTD (DBG_TX|DBG_BUS, "(full region)");
1146*4882a593Smuzhiyun 	  dev->tx_bytes = 0;
1147*4882a593Smuzhiyun 	} else {
1148*4882a593Smuzhiyun 	  PRINTD (DBG_TX|DBG_BUS, "(start multi region)");
1149*4882a593Smuzhiyun 	  dev->tx_bytes = tx_bytes - MAX_TRANSFER_COUNT;
1150*4882a593Smuzhiyun 	  tx_bytes = MAX_TRANSFER_COUNT;
1151*4882a593Smuzhiyun 	}
1152*4882a593Smuzhiyun       } else {
1153*4882a593Smuzhiyun 	// tx_regions == 0
1154*4882a593Smuzhiyun 	// that's all folks - end of frame
1155*4882a593Smuzhiyun 	struct sk_buff * skb = dev->tx_skb;
1156*4882a593Smuzhiyun 	dev->tx_iovec = NULL;
1157*4882a593Smuzhiyun 
1158*4882a593Smuzhiyun 	// VC layer stats
1159*4882a593Smuzhiyun 	atomic_inc(&ATM_SKB(skb)->vcc->stats->tx);
1160*4882a593Smuzhiyun 
1161*4882a593Smuzhiyun 	// free the skb
1162*4882a593Smuzhiyun 	hrz_kfree_skb (skb);
1163*4882a593Smuzhiyun       }
1164*4882a593Smuzhiyun     }
1165*4882a593Smuzhiyun 
1166*4882a593Smuzhiyun     // note: writing TX_COUNT clears any interrupt condition
1167*4882a593Smuzhiyun     if (tx_bytes) {
1168*4882a593Smuzhiyun       if (pio_instead) {
1169*4882a593Smuzhiyun 	if (irq)
1170*4882a593Smuzhiyun 	  wr_regl (dev, MASTER_TX_COUNT_REG_OFF, 0);
1171*4882a593Smuzhiyun 	wrs_regb (dev, DATA_PORT_OFF, dev->tx_addr, tx_bytes);
1172*4882a593Smuzhiyun 	if (append_desc)
1173*4882a593Smuzhiyun 	  wr_regl (dev, TX_DESCRIPTOR_PORT_OFF, cpu_to_be32 (dev->tx_skb->len));
1174*4882a593Smuzhiyun       } else {
1175*4882a593Smuzhiyun 	wr_regl (dev, MASTER_TX_ADDR_REG_OFF, virt_to_bus (dev->tx_addr));
1176*4882a593Smuzhiyun 	if (append_desc)
1177*4882a593Smuzhiyun 	  wr_regl (dev, TX_DESCRIPTOR_REG_OFF, cpu_to_be32 (dev->tx_skb->len));
1178*4882a593Smuzhiyun 	wr_regl (dev, MASTER_TX_COUNT_REG_OFF,
1179*4882a593Smuzhiyun 		 append_desc
1180*4882a593Smuzhiyun 		 ? tx_bytes | MASTER_TX_AUTO_APPEND_DESC
1181*4882a593Smuzhiyun 		 : tx_bytes);
1182*4882a593Smuzhiyun       }
1183*4882a593Smuzhiyun       dev->tx_addr += tx_bytes;
1184*4882a593Smuzhiyun     } else {
1185*4882a593Smuzhiyun       if (irq)
1186*4882a593Smuzhiyun 	wr_regl (dev, MASTER_TX_COUNT_REG_OFF, 0);
1187*4882a593Smuzhiyun       YELLOW_LED_ON(dev);
1188*4882a593Smuzhiyun       tx_release (dev);
1189*4882a593Smuzhiyun     }
1190*4882a593Smuzhiyun 
1191*4882a593Smuzhiyun #ifdef TAILRECURSIONWORKS
1192*4882a593Smuzhiyun     // and we all bless optimised tail calls
1193*4882a593Smuzhiyun     if (pio_instead)
1194*4882a593Smuzhiyun       return tx_schedule (dev, 0);
1195*4882a593Smuzhiyun     return;
1196*4882a593Smuzhiyun #else
1197*4882a593Smuzhiyun     // grrrrrrr!
1198*4882a593Smuzhiyun     irq = 0;
1199*4882a593Smuzhiyun   }
1200*4882a593Smuzhiyun   return;
1201*4882a593Smuzhiyun #endif
1202*4882a593Smuzhiyun }
1203*4882a593Smuzhiyun 
1204*4882a593Smuzhiyun /********** handle TX bus master complete events **********/
1205*4882a593Smuzhiyun 
tx_bus_master_complete_handler(hrz_dev * dev)1206*4882a593Smuzhiyun static void tx_bus_master_complete_handler (hrz_dev * dev) {
1207*4882a593Smuzhiyun   if (test_bit (tx_busy, &dev->flags)) {
1208*4882a593Smuzhiyun     tx_schedule (dev, 1);
1209*4882a593Smuzhiyun   } else {
1210*4882a593Smuzhiyun     PRINTD (DBG_TX|DBG_ERR, "unexpected TX bus master completion");
1211*4882a593Smuzhiyun     // clear interrupt condition on adapter
1212*4882a593Smuzhiyun     wr_regl (dev, MASTER_TX_COUNT_REG_OFF, 0);
1213*4882a593Smuzhiyun   }
1214*4882a593Smuzhiyun   return;
1215*4882a593Smuzhiyun }
1216*4882a593Smuzhiyun 
1217*4882a593Smuzhiyun /********** move RX Q pointer to next item in circular buffer **********/
1218*4882a593Smuzhiyun 
1219*4882a593Smuzhiyun // called only from IRQ sub-handler
rx_queue_entry_next(hrz_dev * dev)1220*4882a593Smuzhiyun static u32 rx_queue_entry_next (hrz_dev * dev) {
1221*4882a593Smuzhiyun   u32 rx_queue_entry;
1222*4882a593Smuzhiyun   spin_lock (&dev->mem_lock);
1223*4882a593Smuzhiyun   rx_queue_entry = rd_mem (dev, &dev->rx_q_entry->entry);
1224*4882a593Smuzhiyun   if (dev->rx_q_entry == dev->rx_q_wrap)
1225*4882a593Smuzhiyun     dev->rx_q_entry = dev->rx_q_reset;
1226*4882a593Smuzhiyun   else
1227*4882a593Smuzhiyun     dev->rx_q_entry++;
1228*4882a593Smuzhiyun   wr_regw (dev, RX_QUEUE_RD_PTR_OFF, dev->rx_q_entry - dev->rx_q_reset);
1229*4882a593Smuzhiyun   spin_unlock (&dev->mem_lock);
1230*4882a593Smuzhiyun   return rx_queue_entry;
1231*4882a593Smuzhiyun }
1232*4882a593Smuzhiyun 
1233*4882a593Smuzhiyun /********** handle RX data received by device **********/
1234*4882a593Smuzhiyun 
1235*4882a593Smuzhiyun // called from IRQ handler
rx_data_av_handler(hrz_dev * dev)1236*4882a593Smuzhiyun static void rx_data_av_handler (hrz_dev * dev) {
1237*4882a593Smuzhiyun   u32 rx_queue_entry;
1238*4882a593Smuzhiyun   u32 rx_queue_entry_flags;
1239*4882a593Smuzhiyun   u16 rx_len;
1240*4882a593Smuzhiyun   u16 rx_channel;
1241*4882a593Smuzhiyun 
1242*4882a593Smuzhiyun   PRINTD (DBG_FLOW, "hrz_data_av_handler");
1243*4882a593Smuzhiyun 
1244*4882a593Smuzhiyun   // try to grab rx lock (not possible during RX bus mastering)
1245*4882a593Smuzhiyun   if (test_and_set_bit (rx_busy, &dev->flags)) {
1246*4882a593Smuzhiyun     PRINTD (DBG_RX, "locked out of rx lock");
1247*4882a593Smuzhiyun     return;
1248*4882a593Smuzhiyun   }
1249*4882a593Smuzhiyun   PRINTD (DBG_RX, "set rx_busy for dev %p", dev);
1250*4882a593Smuzhiyun   // lock is cleared if we fail now, o/w after bus master completion
1251*4882a593Smuzhiyun 
1252*4882a593Smuzhiyun   YELLOW_LED_OFF(dev);
1253*4882a593Smuzhiyun 
1254*4882a593Smuzhiyun   rx_queue_entry = rx_queue_entry_next (dev);
1255*4882a593Smuzhiyun 
1256*4882a593Smuzhiyun   rx_len = rx_q_entry_to_length (rx_queue_entry);
1257*4882a593Smuzhiyun   rx_channel = rx_q_entry_to_rx_channel (rx_queue_entry);
1258*4882a593Smuzhiyun 
1259*4882a593Smuzhiyun   WAIT_FLUSH_RX_COMPLETE (dev);
1260*4882a593Smuzhiyun 
1261*4882a593Smuzhiyun   SELECT_RX_CHANNEL (dev, rx_channel);
1262*4882a593Smuzhiyun 
1263*4882a593Smuzhiyun   PRINTD (DBG_RX, "rx_queue_entry is: %#x", rx_queue_entry);
1264*4882a593Smuzhiyun   rx_queue_entry_flags = rx_queue_entry & (RX_CRC_32_OK|RX_COMPLETE_FRAME|SIMONS_DODGEY_MARKER);
1265*4882a593Smuzhiyun 
1266*4882a593Smuzhiyun   if (!rx_len) {
1267*4882a593Smuzhiyun     // (at least) bus-mastering breaks if we try to handle a
1268*4882a593Smuzhiyun     // zero-length frame, besides AAL5 does not support them
1269*4882a593Smuzhiyun     PRINTK (KERN_ERR, "zero-length frame!");
1270*4882a593Smuzhiyun     rx_queue_entry_flags &= ~RX_COMPLETE_FRAME;
1271*4882a593Smuzhiyun   }
1272*4882a593Smuzhiyun 
1273*4882a593Smuzhiyun   if (rx_queue_entry_flags & SIMONS_DODGEY_MARKER) {
1274*4882a593Smuzhiyun     PRINTD (DBG_RX|DBG_ERR, "Simon's marker detected!");
1275*4882a593Smuzhiyun   }
1276*4882a593Smuzhiyun   if (rx_queue_entry_flags == (RX_CRC_32_OK | RX_COMPLETE_FRAME)) {
1277*4882a593Smuzhiyun     struct atm_vcc * atm_vcc;
1278*4882a593Smuzhiyun 
1279*4882a593Smuzhiyun     PRINTD (DBG_RX, "got a frame on rx_channel %x len %u", rx_channel, rx_len);
1280*4882a593Smuzhiyun 
1281*4882a593Smuzhiyun     atm_vcc = dev->rxer[rx_channel];
1282*4882a593Smuzhiyun     // if no vcc is assigned to this channel, we should drop the frame
1283*4882a593Smuzhiyun     // (is this what SIMONS etc. was trying to achieve?)
1284*4882a593Smuzhiyun 
1285*4882a593Smuzhiyun     if (atm_vcc) {
1286*4882a593Smuzhiyun 
1287*4882a593Smuzhiyun       if (atm_vcc->qos.rxtp.traffic_class != ATM_NONE) {
1288*4882a593Smuzhiyun 
1289*4882a593Smuzhiyun 	if (rx_len <= atm_vcc->qos.rxtp.max_sdu) {
1290*4882a593Smuzhiyun 
1291*4882a593Smuzhiyun 	  struct sk_buff * skb = atm_alloc_charge (atm_vcc, rx_len, GFP_ATOMIC);
1292*4882a593Smuzhiyun 	  if (skb) {
1293*4882a593Smuzhiyun 	    // remember this so we can push it later
1294*4882a593Smuzhiyun 	    dev->rx_skb = skb;
1295*4882a593Smuzhiyun 	    // remember this so we can flush it later
1296*4882a593Smuzhiyun 	    dev->rx_channel = rx_channel;
1297*4882a593Smuzhiyun 
1298*4882a593Smuzhiyun 	    // prepare socket buffer
1299*4882a593Smuzhiyun 	    skb_put (skb, rx_len);
1300*4882a593Smuzhiyun 	    ATM_SKB(skb)->vcc = atm_vcc;
1301*4882a593Smuzhiyun 
1302*4882a593Smuzhiyun 	    // simple transfer
1303*4882a593Smuzhiyun 	    // dev->rx_regions = 0;
1304*4882a593Smuzhiyun 	    // dev->rx_iovec = 0;
1305*4882a593Smuzhiyun 	    dev->rx_bytes = rx_len;
1306*4882a593Smuzhiyun 	    dev->rx_addr = skb->data;
1307*4882a593Smuzhiyun 	    PRINTD (DBG_RX, "RX start simple transfer (addr %p, len %d)",
1308*4882a593Smuzhiyun 		    skb->data, rx_len);
1309*4882a593Smuzhiyun 
1310*4882a593Smuzhiyun 	    // do the business
1311*4882a593Smuzhiyun 	    rx_schedule (dev, 0);
1312*4882a593Smuzhiyun 	    return;
1313*4882a593Smuzhiyun 
1314*4882a593Smuzhiyun 	  } else {
1315*4882a593Smuzhiyun 	    PRINTD (DBG_SKB|DBG_WARN, "failed to get skb");
1316*4882a593Smuzhiyun 	  }
1317*4882a593Smuzhiyun 
1318*4882a593Smuzhiyun 	} else {
1319*4882a593Smuzhiyun 	  PRINTK (KERN_INFO, "frame received on TX-only VC %x", rx_channel);
1320*4882a593Smuzhiyun 	  // do we count this?
1321*4882a593Smuzhiyun 	}
1322*4882a593Smuzhiyun 
1323*4882a593Smuzhiyun       } else {
1324*4882a593Smuzhiyun 	PRINTK (KERN_WARNING, "dropped over-size frame");
1325*4882a593Smuzhiyun 	// do we count this?
1326*4882a593Smuzhiyun       }
1327*4882a593Smuzhiyun 
1328*4882a593Smuzhiyun     } else {
1329*4882a593Smuzhiyun       PRINTD (DBG_WARN|DBG_VCC|DBG_RX, "no VCC for this frame (VC closed)");
1330*4882a593Smuzhiyun       // do we count this?
1331*4882a593Smuzhiyun     }
1332*4882a593Smuzhiyun 
1333*4882a593Smuzhiyun   } else {
1334*4882a593Smuzhiyun     // Wait update complete ? SPONG
1335*4882a593Smuzhiyun   }
1336*4882a593Smuzhiyun 
1337*4882a593Smuzhiyun   // RX was aborted
1338*4882a593Smuzhiyun   YELLOW_LED_ON(dev);
1339*4882a593Smuzhiyun 
1340*4882a593Smuzhiyun   FLUSH_RX_CHANNEL (dev,rx_channel);
1341*4882a593Smuzhiyun   clear_bit (rx_busy, &dev->flags);
1342*4882a593Smuzhiyun 
1343*4882a593Smuzhiyun   return;
1344*4882a593Smuzhiyun }
1345*4882a593Smuzhiyun 
1346*4882a593Smuzhiyun /********** interrupt handler **********/
1347*4882a593Smuzhiyun 
interrupt_handler(int irq,void * dev_id)1348*4882a593Smuzhiyun static irqreturn_t interrupt_handler(int irq, void *dev_id)
1349*4882a593Smuzhiyun {
1350*4882a593Smuzhiyun   hrz_dev *dev = dev_id;
1351*4882a593Smuzhiyun   u32 int_source;
1352*4882a593Smuzhiyun   unsigned int irq_ok;
1353*4882a593Smuzhiyun 
1354*4882a593Smuzhiyun   PRINTD (DBG_FLOW, "interrupt_handler: %p", dev_id);
1355*4882a593Smuzhiyun 
1356*4882a593Smuzhiyun   // definitely for us
1357*4882a593Smuzhiyun   irq_ok = 0;
1358*4882a593Smuzhiyun   while ((int_source = rd_regl (dev, INT_SOURCE_REG_OFF)
1359*4882a593Smuzhiyun 	  & INTERESTING_INTERRUPTS)) {
1360*4882a593Smuzhiyun     // In the interests of fairness, the handlers below are
1361*4882a593Smuzhiyun     // called in sequence and without immediate return to the head of
1362*4882a593Smuzhiyun     // the while loop. This is only of issue for slow hosts (or when
1363*4882a593Smuzhiyun     // debugging messages are on). Really slow hosts may find a fast
1364*4882a593Smuzhiyun     // sender keeps them permanently in the IRQ handler. :(
1365*4882a593Smuzhiyun 
1366*4882a593Smuzhiyun     // (only an issue for slow hosts) RX completion goes before
1367*4882a593Smuzhiyun     // rx_data_av as the former implies rx_busy and so the latter
1368*4882a593Smuzhiyun     // would just abort. If it reschedules another transfer
1369*4882a593Smuzhiyun     // (continuing the same frame) then it will not clear rx_busy.
1370*4882a593Smuzhiyun 
1371*4882a593Smuzhiyun     // (only an issue for slow hosts) TX completion goes before RX
1372*4882a593Smuzhiyun     // data available as it is a much shorter routine - there is the
1373*4882a593Smuzhiyun     // chance that any further transfers it schedules will be complete
1374*4882a593Smuzhiyun     // by the time of the return to the head of the while loop
1375*4882a593Smuzhiyun 
1376*4882a593Smuzhiyun     if (int_source & RX_BUS_MASTER_COMPLETE) {
1377*4882a593Smuzhiyun       ++irq_ok;
1378*4882a593Smuzhiyun       PRINTD (DBG_IRQ|DBG_BUS|DBG_RX, "rx_bus_master_complete asserted");
1379*4882a593Smuzhiyun       rx_bus_master_complete_handler (dev);
1380*4882a593Smuzhiyun     }
1381*4882a593Smuzhiyun     if (int_source & TX_BUS_MASTER_COMPLETE) {
1382*4882a593Smuzhiyun       ++irq_ok;
1383*4882a593Smuzhiyun       PRINTD (DBG_IRQ|DBG_BUS|DBG_TX, "tx_bus_master_complete asserted");
1384*4882a593Smuzhiyun       tx_bus_master_complete_handler (dev);
1385*4882a593Smuzhiyun     }
1386*4882a593Smuzhiyun     if (int_source & RX_DATA_AV) {
1387*4882a593Smuzhiyun       ++irq_ok;
1388*4882a593Smuzhiyun       PRINTD (DBG_IRQ|DBG_RX, "rx_data_av asserted");
1389*4882a593Smuzhiyun       rx_data_av_handler (dev);
1390*4882a593Smuzhiyun     }
1391*4882a593Smuzhiyun   }
1392*4882a593Smuzhiyun   if (irq_ok) {
1393*4882a593Smuzhiyun     PRINTD (DBG_IRQ, "work done: %u", irq_ok);
1394*4882a593Smuzhiyun   } else {
1395*4882a593Smuzhiyun     PRINTD (DBG_IRQ|DBG_WARN, "spurious interrupt source: %#x", int_source);
1396*4882a593Smuzhiyun   }
1397*4882a593Smuzhiyun 
1398*4882a593Smuzhiyun   PRINTD (DBG_IRQ|DBG_FLOW, "interrupt_handler done: %p", dev_id);
1399*4882a593Smuzhiyun   if (irq_ok)
1400*4882a593Smuzhiyun 	return IRQ_HANDLED;
1401*4882a593Smuzhiyun   return IRQ_NONE;
1402*4882a593Smuzhiyun }
1403*4882a593Smuzhiyun 
1404*4882a593Smuzhiyun /********** housekeeping **********/
1405*4882a593Smuzhiyun 
do_housekeeping(struct timer_list * t)1406*4882a593Smuzhiyun static void do_housekeeping (struct timer_list *t) {
1407*4882a593Smuzhiyun   // just stats at the moment
1408*4882a593Smuzhiyun   hrz_dev * dev = from_timer(dev, t, housekeeping);
1409*4882a593Smuzhiyun 
1410*4882a593Smuzhiyun   // collect device-specific (not driver/atm-linux) stats here
1411*4882a593Smuzhiyun   dev->tx_cell_count += rd_regw (dev, TX_CELL_COUNT_OFF);
1412*4882a593Smuzhiyun   dev->rx_cell_count += rd_regw (dev, RX_CELL_COUNT_OFF);
1413*4882a593Smuzhiyun   dev->hec_error_count += rd_regw (dev, HEC_ERROR_COUNT_OFF);
1414*4882a593Smuzhiyun   dev->unassigned_cell_count += rd_regw (dev, UNASSIGNED_CELL_COUNT_OFF);
1415*4882a593Smuzhiyun 
1416*4882a593Smuzhiyun   mod_timer (&dev->housekeeping, jiffies + HZ/10);
1417*4882a593Smuzhiyun 
1418*4882a593Smuzhiyun   return;
1419*4882a593Smuzhiyun }
1420*4882a593Smuzhiyun 
1421*4882a593Smuzhiyun /********** find an idle channel for TX and set it up **********/
1422*4882a593Smuzhiyun 
1423*4882a593Smuzhiyun // called with tx_busy set
setup_idle_tx_channel(hrz_dev * dev,hrz_vcc * vcc)1424*4882a593Smuzhiyun static short setup_idle_tx_channel (hrz_dev * dev, hrz_vcc * vcc) {
1425*4882a593Smuzhiyun   unsigned short idle_channels;
1426*4882a593Smuzhiyun   short tx_channel = -1;
1427*4882a593Smuzhiyun   unsigned int spin_count;
1428*4882a593Smuzhiyun   PRINTD (DBG_FLOW|DBG_TX, "setup_idle_tx_channel %p", dev);
1429*4882a593Smuzhiyun 
1430*4882a593Smuzhiyun   // better would be to fail immediately, the caller can then decide whether
1431*4882a593Smuzhiyun   // to wait or drop (depending on whether this is UBR etc.)
1432*4882a593Smuzhiyun   spin_count = 0;
1433*4882a593Smuzhiyun   while (!(idle_channels = rd_regw (dev, TX_STATUS_OFF) & IDLE_CHANNELS_MASK)) {
1434*4882a593Smuzhiyun     PRINTD (DBG_TX|DBG_WARN, "waiting for idle TX channel");
1435*4882a593Smuzhiyun     // delay a bit here
1436*4882a593Smuzhiyun     if (++spin_count > 100) {
1437*4882a593Smuzhiyun       PRINTD (DBG_TX|DBG_ERR, "spun out waiting for idle TX channel");
1438*4882a593Smuzhiyun       return -EBUSY;
1439*4882a593Smuzhiyun     }
1440*4882a593Smuzhiyun   }
1441*4882a593Smuzhiyun 
1442*4882a593Smuzhiyun   // got an idle channel
1443*4882a593Smuzhiyun   {
1444*4882a593Smuzhiyun     // tx_idle ensures we look for idle channels in RR order
1445*4882a593Smuzhiyun     int chan = dev->tx_idle;
1446*4882a593Smuzhiyun 
1447*4882a593Smuzhiyun     int keep_going = 1;
1448*4882a593Smuzhiyun     while (keep_going) {
1449*4882a593Smuzhiyun       if (idle_channels & (1<<chan)) {
1450*4882a593Smuzhiyun 	tx_channel = chan;
1451*4882a593Smuzhiyun 	keep_going = 0;
1452*4882a593Smuzhiyun       }
1453*4882a593Smuzhiyun       ++chan;
1454*4882a593Smuzhiyun       if (chan == TX_CHANS)
1455*4882a593Smuzhiyun 	chan = 0;
1456*4882a593Smuzhiyun     }
1457*4882a593Smuzhiyun 
1458*4882a593Smuzhiyun     dev->tx_idle = chan;
1459*4882a593Smuzhiyun   }
1460*4882a593Smuzhiyun 
1461*4882a593Smuzhiyun   // set up the channel we found
1462*4882a593Smuzhiyun   {
1463*4882a593Smuzhiyun     // Initialise the cell header in the transmit channel descriptor
1464*4882a593Smuzhiyun     // a.k.a. prepare the channel and remember that we have done so.
1465*4882a593Smuzhiyun 
1466*4882a593Smuzhiyun     tx_ch_desc * tx_desc = &memmap->tx_descs[tx_channel];
1467*4882a593Smuzhiyun     u32 rd_ptr;
1468*4882a593Smuzhiyun     u32 wr_ptr;
1469*4882a593Smuzhiyun     u16 channel = vcc->channel;
1470*4882a593Smuzhiyun 
1471*4882a593Smuzhiyun     unsigned long flags;
1472*4882a593Smuzhiyun     spin_lock_irqsave (&dev->mem_lock, flags);
1473*4882a593Smuzhiyun 
1474*4882a593Smuzhiyun     // Update the transmit channel record.
1475*4882a593Smuzhiyun     dev->tx_channel_record[tx_channel] = channel;
1476*4882a593Smuzhiyun 
1477*4882a593Smuzhiyun     // xBR channel
1478*4882a593Smuzhiyun     update_tx_channel_config (dev, tx_channel, RATE_TYPE_ACCESS,
1479*4882a593Smuzhiyun 			      vcc->tx_xbr_bits);
1480*4882a593Smuzhiyun 
1481*4882a593Smuzhiyun     // Update the PCR counter preload value etc.
1482*4882a593Smuzhiyun     update_tx_channel_config (dev, tx_channel, PCR_TIMER_ACCESS,
1483*4882a593Smuzhiyun 			      vcc->tx_pcr_bits);
1484*4882a593Smuzhiyun 
1485*4882a593Smuzhiyun #if 0
1486*4882a593Smuzhiyun     if (vcc->tx_xbr_bits == VBR_RATE_TYPE) {
1487*4882a593Smuzhiyun       // SCR timer
1488*4882a593Smuzhiyun       update_tx_channel_config (dev, tx_channel, SCR_TIMER_ACCESS,
1489*4882a593Smuzhiyun 				vcc->tx_scr_bits);
1490*4882a593Smuzhiyun 
1491*4882a593Smuzhiyun       // Bucket size...
1492*4882a593Smuzhiyun       update_tx_channel_config (dev, tx_channel, BUCKET_CAPACITY_ACCESS,
1493*4882a593Smuzhiyun 				vcc->tx_bucket_bits);
1494*4882a593Smuzhiyun 
1495*4882a593Smuzhiyun       // ... and fullness
1496*4882a593Smuzhiyun       update_tx_channel_config (dev, tx_channel, BUCKET_FULLNESS_ACCESS,
1497*4882a593Smuzhiyun 				vcc->tx_bucket_bits);
1498*4882a593Smuzhiyun     }
1499*4882a593Smuzhiyun #endif
1500*4882a593Smuzhiyun 
1501*4882a593Smuzhiyun     // Initialise the read and write buffer pointers
1502*4882a593Smuzhiyun     rd_ptr = rd_mem (dev, &tx_desc->rd_buf_type) & BUFFER_PTR_MASK;
1503*4882a593Smuzhiyun     wr_ptr = rd_mem (dev, &tx_desc->wr_buf_type) & BUFFER_PTR_MASK;
1504*4882a593Smuzhiyun 
1505*4882a593Smuzhiyun     // idle TX channels should have identical pointers
1506*4882a593Smuzhiyun     if (rd_ptr != wr_ptr) {
1507*4882a593Smuzhiyun       PRINTD (DBG_TX|DBG_ERR, "TX buffer pointers are broken!");
1508*4882a593Smuzhiyun       // spin_unlock... return -E...
1509*4882a593Smuzhiyun       // I wonder if gcc would get rid of one of the pointer aliases
1510*4882a593Smuzhiyun     }
1511*4882a593Smuzhiyun     PRINTD (DBG_TX, "TX buffer pointers are: rd %x, wr %x.",
1512*4882a593Smuzhiyun 	    rd_ptr, wr_ptr);
1513*4882a593Smuzhiyun 
1514*4882a593Smuzhiyun     switch (vcc->aal) {
1515*4882a593Smuzhiyun       case aal0:
1516*4882a593Smuzhiyun 	PRINTD (DBG_QOS|DBG_TX, "tx_channel: aal0");
1517*4882a593Smuzhiyun 	rd_ptr |= CHANNEL_TYPE_RAW_CELLS;
1518*4882a593Smuzhiyun 	wr_ptr |= CHANNEL_TYPE_RAW_CELLS;
1519*4882a593Smuzhiyun 	break;
1520*4882a593Smuzhiyun       case aal34:
1521*4882a593Smuzhiyun 	PRINTD (DBG_QOS|DBG_TX, "tx_channel: aal34");
1522*4882a593Smuzhiyun 	rd_ptr |= CHANNEL_TYPE_AAL3_4;
1523*4882a593Smuzhiyun 	wr_ptr |= CHANNEL_TYPE_AAL3_4;
1524*4882a593Smuzhiyun 	break;
1525*4882a593Smuzhiyun       case aal5:
1526*4882a593Smuzhiyun 	rd_ptr |= CHANNEL_TYPE_AAL5;
1527*4882a593Smuzhiyun 	wr_ptr |= CHANNEL_TYPE_AAL5;
1528*4882a593Smuzhiyun 	// Initialise the CRC
1529*4882a593Smuzhiyun 	wr_mem (dev, &tx_desc->partial_crc, INITIAL_CRC);
1530*4882a593Smuzhiyun 	break;
1531*4882a593Smuzhiyun     }
1532*4882a593Smuzhiyun 
1533*4882a593Smuzhiyun     wr_mem (dev, &tx_desc->rd_buf_type, rd_ptr);
1534*4882a593Smuzhiyun     wr_mem (dev, &tx_desc->wr_buf_type, wr_ptr);
1535*4882a593Smuzhiyun 
1536*4882a593Smuzhiyun     // Write the Cell Header
1537*4882a593Smuzhiyun     // Payload Type, CLP and GFC would go here if non-zero
1538*4882a593Smuzhiyun     wr_mem (dev, &tx_desc->cell_header, channel);
1539*4882a593Smuzhiyun 
1540*4882a593Smuzhiyun     spin_unlock_irqrestore (&dev->mem_lock, flags);
1541*4882a593Smuzhiyun   }
1542*4882a593Smuzhiyun 
1543*4882a593Smuzhiyun   return tx_channel;
1544*4882a593Smuzhiyun }
1545*4882a593Smuzhiyun 
1546*4882a593Smuzhiyun /********** send a frame **********/
1547*4882a593Smuzhiyun 
hrz_send(struct atm_vcc * atm_vcc,struct sk_buff * skb)1548*4882a593Smuzhiyun static int hrz_send (struct atm_vcc * atm_vcc, struct sk_buff * skb) {
1549*4882a593Smuzhiyun   unsigned int spin_count;
1550*4882a593Smuzhiyun   int free_buffers;
1551*4882a593Smuzhiyun   hrz_dev * dev = HRZ_DEV(atm_vcc->dev);
1552*4882a593Smuzhiyun   hrz_vcc * vcc = HRZ_VCC(atm_vcc);
1553*4882a593Smuzhiyun   u16 channel = vcc->channel;
1554*4882a593Smuzhiyun 
1555*4882a593Smuzhiyun   u32 buffers_required;
1556*4882a593Smuzhiyun 
1557*4882a593Smuzhiyun   /* signed for error return */
1558*4882a593Smuzhiyun   short tx_channel;
1559*4882a593Smuzhiyun 
1560*4882a593Smuzhiyun   PRINTD (DBG_FLOW|DBG_TX, "hrz_send vc %x data %p len %u",
1561*4882a593Smuzhiyun 	  channel, skb->data, skb->len);
1562*4882a593Smuzhiyun 
1563*4882a593Smuzhiyun   dump_skb (">>>", channel, skb);
1564*4882a593Smuzhiyun 
1565*4882a593Smuzhiyun   if (atm_vcc->qos.txtp.traffic_class == ATM_NONE) {
1566*4882a593Smuzhiyun     PRINTK (KERN_ERR, "attempt to send on RX-only VC %x", channel);
1567*4882a593Smuzhiyun     hrz_kfree_skb (skb);
1568*4882a593Smuzhiyun     return -EIO;
1569*4882a593Smuzhiyun   }
1570*4882a593Smuzhiyun 
1571*4882a593Smuzhiyun   // don't understand this
1572*4882a593Smuzhiyun   ATM_SKB(skb)->vcc = atm_vcc;
1573*4882a593Smuzhiyun 
1574*4882a593Smuzhiyun   if (skb->len > atm_vcc->qos.txtp.max_sdu) {
1575*4882a593Smuzhiyun     PRINTK (KERN_ERR, "sk_buff length greater than agreed max_sdu, dropping...");
1576*4882a593Smuzhiyun     hrz_kfree_skb (skb);
1577*4882a593Smuzhiyun     return -EIO;
1578*4882a593Smuzhiyun   }
1579*4882a593Smuzhiyun 
1580*4882a593Smuzhiyun   if (!channel) {
1581*4882a593Smuzhiyun     PRINTD (DBG_ERR|DBG_TX, "attempt to transmit on zero (rx_)channel");
1582*4882a593Smuzhiyun     hrz_kfree_skb (skb);
1583*4882a593Smuzhiyun     return -EIO;
1584*4882a593Smuzhiyun   }
1585*4882a593Smuzhiyun 
1586*4882a593Smuzhiyun #if 0
1587*4882a593Smuzhiyun   {
1588*4882a593Smuzhiyun     // where would be a better place for this? housekeeping?
1589*4882a593Smuzhiyun     u16 status;
1590*4882a593Smuzhiyun     pci_read_config_word (dev->pci_dev, PCI_STATUS, &status);
1591*4882a593Smuzhiyun     if (status & PCI_STATUS_REC_MASTER_ABORT) {
1592*4882a593Smuzhiyun       PRINTD (DBG_BUS|DBG_ERR, "Clearing PCI Master Abort (and cleaning up)");
1593*4882a593Smuzhiyun       status &= ~PCI_STATUS_REC_MASTER_ABORT;
1594*4882a593Smuzhiyun       pci_write_config_word (dev->pci_dev, PCI_STATUS, status);
1595*4882a593Smuzhiyun       if (test_bit (tx_busy, &dev->flags)) {
1596*4882a593Smuzhiyun 	hrz_kfree_skb (dev->tx_skb);
1597*4882a593Smuzhiyun 	tx_release (dev);
1598*4882a593Smuzhiyun       }
1599*4882a593Smuzhiyun     }
1600*4882a593Smuzhiyun   }
1601*4882a593Smuzhiyun #endif
1602*4882a593Smuzhiyun 
1603*4882a593Smuzhiyun #ifdef DEBUG_HORIZON
1604*4882a593Smuzhiyun   /* wey-hey! */
1605*4882a593Smuzhiyun   if (channel == 1023) {
1606*4882a593Smuzhiyun     unsigned int i;
1607*4882a593Smuzhiyun     unsigned short d = 0;
1608*4882a593Smuzhiyun     char * s = skb->data;
1609*4882a593Smuzhiyun     if (*s++ == 'D') {
1610*4882a593Smuzhiyun 	for (i = 0; i < 4; ++i)
1611*4882a593Smuzhiyun 		d = (d << 4) | hex_to_bin(*s++);
1612*4882a593Smuzhiyun       PRINTK (KERN_INFO, "debug bitmap is now %hx", debug = d);
1613*4882a593Smuzhiyun     }
1614*4882a593Smuzhiyun   }
1615*4882a593Smuzhiyun #endif
1616*4882a593Smuzhiyun 
1617*4882a593Smuzhiyun   // wait until TX is free and grab lock
1618*4882a593Smuzhiyun   if (tx_hold (dev)) {
1619*4882a593Smuzhiyun     hrz_kfree_skb (skb);
1620*4882a593Smuzhiyun     return -ERESTARTSYS;
1621*4882a593Smuzhiyun   }
1622*4882a593Smuzhiyun 
1623*4882a593Smuzhiyun   // Wait for enough space to be available in transmit buffer memory.
1624*4882a593Smuzhiyun 
1625*4882a593Smuzhiyun   // should be number of cells needed + 2 (according to hardware docs)
1626*4882a593Smuzhiyun   // = ((framelen+8)+47) / 48 + 2
1627*4882a593Smuzhiyun   // = (framelen+7) / 48 + 3, hmm... faster to put addition inside XXX
1628*4882a593Smuzhiyun   buffers_required = (skb->len+(ATM_AAL5_TRAILER-1)) / ATM_CELL_PAYLOAD + 3;
1629*4882a593Smuzhiyun 
1630*4882a593Smuzhiyun   // replace with timer and sleep, add dev->tx_buffers_queue (max 1 entry)
1631*4882a593Smuzhiyun   spin_count = 0;
1632*4882a593Smuzhiyun   while ((free_buffers = rd_regw (dev, TX_FREE_BUFFER_COUNT_OFF)) < buffers_required) {
1633*4882a593Smuzhiyun     PRINTD (DBG_TX, "waiting for free TX buffers, got %d of %d",
1634*4882a593Smuzhiyun 	    free_buffers, buffers_required);
1635*4882a593Smuzhiyun     // what is the appropriate delay? implement a timeout? (depending on line speed?)
1636*4882a593Smuzhiyun     // mdelay (1);
1637*4882a593Smuzhiyun     // what happens if we kill (current_pid, SIGKILL) ?
1638*4882a593Smuzhiyun     schedule();
1639*4882a593Smuzhiyun     if (++spin_count > 1000) {
1640*4882a593Smuzhiyun       PRINTD (DBG_TX|DBG_ERR, "spun out waiting for tx buffers, got %d of %d",
1641*4882a593Smuzhiyun 	      free_buffers, buffers_required);
1642*4882a593Smuzhiyun       tx_release (dev);
1643*4882a593Smuzhiyun       hrz_kfree_skb (skb);
1644*4882a593Smuzhiyun       return -ERESTARTSYS;
1645*4882a593Smuzhiyun     }
1646*4882a593Smuzhiyun   }
1647*4882a593Smuzhiyun 
1648*4882a593Smuzhiyun   // Select a channel to transmit the frame on.
1649*4882a593Smuzhiyun   if (channel == dev->last_vc) {
1650*4882a593Smuzhiyun     PRINTD (DBG_TX, "last vc hack: hit");
1651*4882a593Smuzhiyun     tx_channel = dev->tx_last;
1652*4882a593Smuzhiyun   } else {
1653*4882a593Smuzhiyun     PRINTD (DBG_TX, "last vc hack: miss");
1654*4882a593Smuzhiyun     // Are we currently transmitting this VC on one of the channels?
1655*4882a593Smuzhiyun     for (tx_channel = 0; tx_channel < TX_CHANS; ++tx_channel)
1656*4882a593Smuzhiyun       if (dev->tx_channel_record[tx_channel] == channel) {
1657*4882a593Smuzhiyun 	PRINTD (DBG_TX, "vc already on channel: hit");
1658*4882a593Smuzhiyun 	break;
1659*4882a593Smuzhiyun       }
1660*4882a593Smuzhiyun     if (tx_channel == TX_CHANS) {
1661*4882a593Smuzhiyun       PRINTD (DBG_TX, "vc already on channel: miss");
1662*4882a593Smuzhiyun       // Find and set up an idle channel.
1663*4882a593Smuzhiyun       tx_channel = setup_idle_tx_channel (dev, vcc);
1664*4882a593Smuzhiyun       if (tx_channel < 0) {
1665*4882a593Smuzhiyun 	PRINTD (DBG_TX|DBG_ERR, "failed to get channel");
1666*4882a593Smuzhiyun 	tx_release (dev);
1667*4882a593Smuzhiyun 	return tx_channel;
1668*4882a593Smuzhiyun       }
1669*4882a593Smuzhiyun     }
1670*4882a593Smuzhiyun 
1671*4882a593Smuzhiyun     PRINTD (DBG_TX, "got channel");
1672*4882a593Smuzhiyun     SELECT_TX_CHANNEL(dev, tx_channel);
1673*4882a593Smuzhiyun 
1674*4882a593Smuzhiyun     dev->last_vc = channel;
1675*4882a593Smuzhiyun     dev->tx_last = tx_channel;
1676*4882a593Smuzhiyun   }
1677*4882a593Smuzhiyun 
1678*4882a593Smuzhiyun   PRINTD (DBG_TX, "using channel %u", tx_channel);
1679*4882a593Smuzhiyun 
1680*4882a593Smuzhiyun   YELLOW_LED_OFF(dev);
1681*4882a593Smuzhiyun 
1682*4882a593Smuzhiyun   // TX start transfer
1683*4882a593Smuzhiyun 
1684*4882a593Smuzhiyun   {
1685*4882a593Smuzhiyun     unsigned int tx_len = skb->len;
1686*4882a593Smuzhiyun     unsigned int tx_iovcnt = skb_shinfo(skb)->nr_frags;
1687*4882a593Smuzhiyun     // remember this so we can free it later
1688*4882a593Smuzhiyun     dev->tx_skb = skb;
1689*4882a593Smuzhiyun 
1690*4882a593Smuzhiyun     if (tx_iovcnt) {
1691*4882a593Smuzhiyun       // scatter gather transfer
1692*4882a593Smuzhiyun       dev->tx_regions = tx_iovcnt;
1693*4882a593Smuzhiyun       dev->tx_iovec = NULL;		/* @@@ needs rewritten */
1694*4882a593Smuzhiyun       dev->tx_bytes = 0;
1695*4882a593Smuzhiyun       PRINTD (DBG_TX|DBG_BUS, "TX start scatter-gather transfer (iovec %p, len %d)",
1696*4882a593Smuzhiyun 	      skb->data, tx_len);
1697*4882a593Smuzhiyun       tx_release (dev);
1698*4882a593Smuzhiyun       hrz_kfree_skb (skb);
1699*4882a593Smuzhiyun       return -EIO;
1700*4882a593Smuzhiyun     } else {
1701*4882a593Smuzhiyun       // simple transfer
1702*4882a593Smuzhiyun       dev->tx_regions = 0;
1703*4882a593Smuzhiyun       dev->tx_iovec = NULL;
1704*4882a593Smuzhiyun       dev->tx_bytes = tx_len;
1705*4882a593Smuzhiyun       dev->tx_addr = skb->data;
1706*4882a593Smuzhiyun       PRINTD (DBG_TX|DBG_BUS, "TX start simple transfer (addr %p, len %d)",
1707*4882a593Smuzhiyun 	      skb->data, tx_len);
1708*4882a593Smuzhiyun     }
1709*4882a593Smuzhiyun 
1710*4882a593Smuzhiyun     // and do the business
1711*4882a593Smuzhiyun     tx_schedule (dev, 0);
1712*4882a593Smuzhiyun 
1713*4882a593Smuzhiyun   }
1714*4882a593Smuzhiyun 
1715*4882a593Smuzhiyun   return 0;
1716*4882a593Smuzhiyun }
1717*4882a593Smuzhiyun 
1718*4882a593Smuzhiyun /********** reset a card **********/
1719*4882a593Smuzhiyun 
hrz_reset(const hrz_dev * dev)1720*4882a593Smuzhiyun static void hrz_reset (const hrz_dev * dev) {
1721*4882a593Smuzhiyun   u32 control_0_reg = rd_regl (dev, CONTROL_0_REG);
1722*4882a593Smuzhiyun 
1723*4882a593Smuzhiyun   // why not set RESET_HORIZON to one and wait for the card to
1724*4882a593Smuzhiyun   // reassert that bit as zero? Like so:
1725*4882a593Smuzhiyun   control_0_reg = control_0_reg & RESET_HORIZON;
1726*4882a593Smuzhiyun   wr_regl (dev, CONTROL_0_REG, control_0_reg);
1727*4882a593Smuzhiyun   while (control_0_reg & RESET_HORIZON)
1728*4882a593Smuzhiyun     control_0_reg = rd_regl (dev, CONTROL_0_REG);
1729*4882a593Smuzhiyun 
1730*4882a593Smuzhiyun   // old reset code retained:
1731*4882a593Smuzhiyun   wr_regl (dev, CONTROL_0_REG, control_0_reg |
1732*4882a593Smuzhiyun 	   RESET_ATM | RESET_RX | RESET_TX | RESET_HOST);
1733*4882a593Smuzhiyun   // just guessing here
1734*4882a593Smuzhiyun   udelay (1000);
1735*4882a593Smuzhiyun 
1736*4882a593Smuzhiyun   wr_regl (dev, CONTROL_0_REG, control_0_reg);
1737*4882a593Smuzhiyun }
1738*4882a593Smuzhiyun 
1739*4882a593Smuzhiyun /********** read the burnt in address **********/
1740*4882a593Smuzhiyun 
WRITE_IT_WAIT(const hrz_dev * dev,u32 ctrl)1741*4882a593Smuzhiyun static void WRITE_IT_WAIT (const hrz_dev *dev, u32 ctrl)
1742*4882a593Smuzhiyun {
1743*4882a593Smuzhiyun 	wr_regl (dev, CONTROL_0_REG, ctrl);
1744*4882a593Smuzhiyun 	udelay (5);
1745*4882a593Smuzhiyun }
1746*4882a593Smuzhiyun 
CLOCK_IT(const hrz_dev * dev,u32 ctrl)1747*4882a593Smuzhiyun static void CLOCK_IT (const hrz_dev *dev, u32 ctrl)
1748*4882a593Smuzhiyun {
1749*4882a593Smuzhiyun 	// DI must be valid around rising SK edge
1750*4882a593Smuzhiyun 	WRITE_IT_WAIT(dev, ctrl & ~SEEPROM_SK);
1751*4882a593Smuzhiyun 	WRITE_IT_WAIT(dev, ctrl | SEEPROM_SK);
1752*4882a593Smuzhiyun }
1753*4882a593Smuzhiyun 
read_bia(const hrz_dev * dev,u16 addr)1754*4882a593Smuzhiyun static u16 read_bia(const hrz_dev *dev, u16 addr)
1755*4882a593Smuzhiyun {
1756*4882a593Smuzhiyun   u32 ctrl = rd_regl (dev, CONTROL_0_REG);
1757*4882a593Smuzhiyun 
1758*4882a593Smuzhiyun   const unsigned int addr_bits = 6;
1759*4882a593Smuzhiyun   const unsigned int data_bits = 16;
1760*4882a593Smuzhiyun 
1761*4882a593Smuzhiyun   unsigned int i;
1762*4882a593Smuzhiyun 
1763*4882a593Smuzhiyun   u16 res;
1764*4882a593Smuzhiyun 
1765*4882a593Smuzhiyun   ctrl &= ~(SEEPROM_CS | SEEPROM_SK | SEEPROM_DI);
1766*4882a593Smuzhiyun   WRITE_IT_WAIT(dev, ctrl);
1767*4882a593Smuzhiyun 
1768*4882a593Smuzhiyun   // wake Serial EEPROM and send 110 (READ) command
1769*4882a593Smuzhiyun   ctrl |=  (SEEPROM_CS | SEEPROM_DI);
1770*4882a593Smuzhiyun   CLOCK_IT(dev, ctrl);
1771*4882a593Smuzhiyun 
1772*4882a593Smuzhiyun   ctrl |= SEEPROM_DI;
1773*4882a593Smuzhiyun   CLOCK_IT(dev, ctrl);
1774*4882a593Smuzhiyun 
1775*4882a593Smuzhiyun   ctrl &= ~SEEPROM_DI;
1776*4882a593Smuzhiyun   CLOCK_IT(dev, ctrl);
1777*4882a593Smuzhiyun 
1778*4882a593Smuzhiyun   for (i=0; i<addr_bits; i++) {
1779*4882a593Smuzhiyun     if (addr & (1 << (addr_bits-1)))
1780*4882a593Smuzhiyun       ctrl |= SEEPROM_DI;
1781*4882a593Smuzhiyun     else
1782*4882a593Smuzhiyun       ctrl &= ~SEEPROM_DI;
1783*4882a593Smuzhiyun 
1784*4882a593Smuzhiyun     CLOCK_IT(dev, ctrl);
1785*4882a593Smuzhiyun 
1786*4882a593Smuzhiyun     addr = addr << 1;
1787*4882a593Smuzhiyun   }
1788*4882a593Smuzhiyun 
1789*4882a593Smuzhiyun   // we could check that we have DO = 0 here
1790*4882a593Smuzhiyun   ctrl &= ~SEEPROM_DI;
1791*4882a593Smuzhiyun 
1792*4882a593Smuzhiyun   res = 0;
1793*4882a593Smuzhiyun   for (i=0;i<data_bits;i++) {
1794*4882a593Smuzhiyun     res = res >> 1;
1795*4882a593Smuzhiyun 
1796*4882a593Smuzhiyun     CLOCK_IT(dev, ctrl);
1797*4882a593Smuzhiyun 
1798*4882a593Smuzhiyun     if (rd_regl (dev, CONTROL_0_REG) & SEEPROM_DO)
1799*4882a593Smuzhiyun       res |= (1 << (data_bits-1));
1800*4882a593Smuzhiyun   }
1801*4882a593Smuzhiyun 
1802*4882a593Smuzhiyun   ctrl &= ~(SEEPROM_SK | SEEPROM_CS);
1803*4882a593Smuzhiyun   WRITE_IT_WAIT(dev, ctrl);
1804*4882a593Smuzhiyun 
1805*4882a593Smuzhiyun   return res;
1806*4882a593Smuzhiyun }
1807*4882a593Smuzhiyun 
1808*4882a593Smuzhiyun /********** initialise a card **********/
1809*4882a593Smuzhiyun 
hrz_init(hrz_dev * dev)1810*4882a593Smuzhiyun static int hrz_init(hrz_dev *dev)
1811*4882a593Smuzhiyun {
1812*4882a593Smuzhiyun   int onefivefive;
1813*4882a593Smuzhiyun 
1814*4882a593Smuzhiyun   u16 chan;
1815*4882a593Smuzhiyun 
1816*4882a593Smuzhiyun   int buff_count;
1817*4882a593Smuzhiyun 
1818*4882a593Smuzhiyun   HDW * mem;
1819*4882a593Smuzhiyun 
1820*4882a593Smuzhiyun   cell_buf * tx_desc;
1821*4882a593Smuzhiyun   cell_buf * rx_desc;
1822*4882a593Smuzhiyun 
1823*4882a593Smuzhiyun   u32 ctrl;
1824*4882a593Smuzhiyun 
1825*4882a593Smuzhiyun   ctrl = rd_regl (dev, CONTROL_0_REG);
1826*4882a593Smuzhiyun   PRINTD (DBG_INFO, "ctrl0reg is %#x", ctrl);
1827*4882a593Smuzhiyun   onefivefive = ctrl & ATM_LAYER_STATUS;
1828*4882a593Smuzhiyun 
1829*4882a593Smuzhiyun   if (onefivefive)
1830*4882a593Smuzhiyun     printk (DEV_LABEL ": Horizon Ultra (at 155.52 MBps)");
1831*4882a593Smuzhiyun   else
1832*4882a593Smuzhiyun     printk (DEV_LABEL ": Horizon (at 25 MBps)");
1833*4882a593Smuzhiyun 
1834*4882a593Smuzhiyun   printk (":");
1835*4882a593Smuzhiyun   // Reset the card to get everything in a known state
1836*4882a593Smuzhiyun 
1837*4882a593Smuzhiyun   printk (" reset");
1838*4882a593Smuzhiyun   hrz_reset (dev);
1839*4882a593Smuzhiyun 
1840*4882a593Smuzhiyun   // Clear all the buffer memory
1841*4882a593Smuzhiyun 
1842*4882a593Smuzhiyun   printk (" clearing memory");
1843*4882a593Smuzhiyun 
1844*4882a593Smuzhiyun   for (mem = (HDW *) memmap; mem < (HDW *) (memmap + 1); ++mem)
1845*4882a593Smuzhiyun     wr_mem (dev, mem, 0);
1846*4882a593Smuzhiyun 
1847*4882a593Smuzhiyun   printk (" tx channels");
1848*4882a593Smuzhiyun 
1849*4882a593Smuzhiyun   // All transmit eight channels are set up as AAL5 ABR channels with
1850*4882a593Smuzhiyun   // a 16us cell spacing. Why?
1851*4882a593Smuzhiyun 
1852*4882a593Smuzhiyun   // Channel 0 gets the free buffer at 100h, channel 1 gets the free
1853*4882a593Smuzhiyun   // buffer at 110h etc.
1854*4882a593Smuzhiyun 
1855*4882a593Smuzhiyun   for (chan = 0; chan < TX_CHANS; ++chan) {
1856*4882a593Smuzhiyun     tx_ch_desc * tx_desc = &memmap->tx_descs[chan];
1857*4882a593Smuzhiyun     cell_buf * buf = &memmap->inittxbufs[chan];
1858*4882a593Smuzhiyun 
1859*4882a593Smuzhiyun     // initialise the read and write buffer pointers
1860*4882a593Smuzhiyun     wr_mem (dev, &tx_desc->rd_buf_type, BUF_PTR(buf));
1861*4882a593Smuzhiyun     wr_mem (dev, &tx_desc->wr_buf_type, BUF_PTR(buf));
1862*4882a593Smuzhiyun 
1863*4882a593Smuzhiyun     // set the status of the initial buffers to empty
1864*4882a593Smuzhiyun     wr_mem (dev, &buf->next, BUFF_STATUS_EMPTY);
1865*4882a593Smuzhiyun   }
1866*4882a593Smuzhiyun 
1867*4882a593Smuzhiyun   // Use space bufn3 at the moment for tx buffers
1868*4882a593Smuzhiyun 
1869*4882a593Smuzhiyun   printk (" tx buffers");
1870*4882a593Smuzhiyun 
1871*4882a593Smuzhiyun   tx_desc = memmap->bufn3;
1872*4882a593Smuzhiyun 
1873*4882a593Smuzhiyun   wr_mem (dev, &memmap->txfreebufstart.next, BUF_PTR(tx_desc) | BUFF_STATUS_EMPTY);
1874*4882a593Smuzhiyun 
1875*4882a593Smuzhiyun   for (buff_count = 0; buff_count < BUFN3_SIZE-1; buff_count++) {
1876*4882a593Smuzhiyun     wr_mem (dev, &tx_desc->next, BUF_PTR(tx_desc+1) | BUFF_STATUS_EMPTY);
1877*4882a593Smuzhiyun     tx_desc++;
1878*4882a593Smuzhiyun   }
1879*4882a593Smuzhiyun 
1880*4882a593Smuzhiyun   wr_mem (dev, &tx_desc->next, BUF_PTR(&memmap->txfreebufend) | BUFF_STATUS_EMPTY);
1881*4882a593Smuzhiyun 
1882*4882a593Smuzhiyun   // Initialise the transmit free buffer count
1883*4882a593Smuzhiyun   wr_regw (dev, TX_FREE_BUFFER_COUNT_OFF, BUFN3_SIZE);
1884*4882a593Smuzhiyun 
1885*4882a593Smuzhiyun   printk (" rx channels");
1886*4882a593Smuzhiyun 
1887*4882a593Smuzhiyun   // Initialise all of the receive channels to be AAL5 disabled with
1888*4882a593Smuzhiyun   // an interrupt threshold of 0
1889*4882a593Smuzhiyun 
1890*4882a593Smuzhiyun   for (chan = 0; chan < RX_CHANS; ++chan) {
1891*4882a593Smuzhiyun     rx_ch_desc * rx_desc = &memmap->rx_descs[chan];
1892*4882a593Smuzhiyun 
1893*4882a593Smuzhiyun     wr_mem (dev, &rx_desc->wr_buf_type, CHANNEL_TYPE_AAL5 | RX_CHANNEL_DISABLED);
1894*4882a593Smuzhiyun   }
1895*4882a593Smuzhiyun 
1896*4882a593Smuzhiyun   printk (" rx buffers");
1897*4882a593Smuzhiyun 
1898*4882a593Smuzhiyun   // Use space bufn4 at the moment for rx buffers
1899*4882a593Smuzhiyun 
1900*4882a593Smuzhiyun   rx_desc = memmap->bufn4;
1901*4882a593Smuzhiyun 
1902*4882a593Smuzhiyun   wr_mem (dev, &memmap->rxfreebufstart.next, BUF_PTR(rx_desc) | BUFF_STATUS_EMPTY);
1903*4882a593Smuzhiyun 
1904*4882a593Smuzhiyun   for (buff_count = 0; buff_count < BUFN4_SIZE-1; buff_count++) {
1905*4882a593Smuzhiyun     wr_mem (dev, &rx_desc->next, BUF_PTR(rx_desc+1) | BUFF_STATUS_EMPTY);
1906*4882a593Smuzhiyun 
1907*4882a593Smuzhiyun     rx_desc++;
1908*4882a593Smuzhiyun   }
1909*4882a593Smuzhiyun 
1910*4882a593Smuzhiyun   wr_mem (dev, &rx_desc->next, BUF_PTR(&memmap->rxfreebufend) | BUFF_STATUS_EMPTY);
1911*4882a593Smuzhiyun 
1912*4882a593Smuzhiyun   // Initialise the receive free buffer count
1913*4882a593Smuzhiyun   wr_regw (dev, RX_FREE_BUFFER_COUNT_OFF, BUFN4_SIZE);
1914*4882a593Smuzhiyun 
1915*4882a593Smuzhiyun   // Initialize Horizons registers
1916*4882a593Smuzhiyun 
1917*4882a593Smuzhiyun   // TX config
1918*4882a593Smuzhiyun   wr_regw (dev, TX_CONFIG_OFF,
1919*4882a593Smuzhiyun 	   ABR_ROUND_ROBIN | TX_NORMAL_OPERATION | DRVR_DRVRBAR_ENABLE);
1920*4882a593Smuzhiyun 
1921*4882a593Smuzhiyun   // RX config. Use 10-x VC bits, x VP bits, non user cells in channel 0.
1922*4882a593Smuzhiyun   wr_regw (dev, RX_CONFIG_OFF,
1923*4882a593Smuzhiyun 	   DISCARD_UNUSED_VPI_VCI_BITS_SET | NON_USER_CELLS_IN_ONE_CHANNEL | vpi_bits);
1924*4882a593Smuzhiyun 
1925*4882a593Smuzhiyun   // RX line config
1926*4882a593Smuzhiyun   wr_regw (dev, RX_LINE_CONFIG_OFF,
1927*4882a593Smuzhiyun 	   LOCK_DETECT_ENABLE | FREQUENCY_DETECT_ENABLE | GXTALOUT_SELECT_DIV4);
1928*4882a593Smuzhiyun 
1929*4882a593Smuzhiyun   // Set the max AAL5 cell count to be just enough to contain the
1930*4882a593Smuzhiyun   // largest AAL5 frame that the user wants to receive
1931*4882a593Smuzhiyun   wr_regw (dev, MAX_AAL5_CELL_COUNT_OFF,
1932*4882a593Smuzhiyun 	   DIV_ROUND_UP(max_rx_size + ATM_AAL5_TRAILER, ATM_CELL_PAYLOAD));
1933*4882a593Smuzhiyun 
1934*4882a593Smuzhiyun   // Enable receive
1935*4882a593Smuzhiyun   wr_regw (dev, RX_CONFIG_OFF, rd_regw (dev, RX_CONFIG_OFF) | RX_ENABLE);
1936*4882a593Smuzhiyun 
1937*4882a593Smuzhiyun   printk (" control");
1938*4882a593Smuzhiyun 
1939*4882a593Smuzhiyun   // Drive the OE of the LEDs then turn the green LED on
1940*4882a593Smuzhiyun   ctrl |= GREEN_LED_OE | YELLOW_LED_OE | GREEN_LED | YELLOW_LED;
1941*4882a593Smuzhiyun   wr_regl (dev, CONTROL_0_REG, ctrl);
1942*4882a593Smuzhiyun 
1943*4882a593Smuzhiyun   // Test for a 155-capable card
1944*4882a593Smuzhiyun 
1945*4882a593Smuzhiyun   if (onefivefive) {
1946*4882a593Smuzhiyun     // Select 155 mode... make this a choice (or: how do we detect
1947*4882a593Smuzhiyun     // external line speed and switch?)
1948*4882a593Smuzhiyun     ctrl |= ATM_LAYER_SELECT;
1949*4882a593Smuzhiyun     wr_regl (dev, CONTROL_0_REG, ctrl);
1950*4882a593Smuzhiyun 
1951*4882a593Smuzhiyun     // test SUNI-lite vs SAMBA
1952*4882a593Smuzhiyun 
1953*4882a593Smuzhiyun     // Register 0x00 in the SUNI will have some of bits 3-7 set, and
1954*4882a593Smuzhiyun     // they will always be zero for the SAMBA.  Ha!  Bloody hardware
1955*4882a593Smuzhiyun     // engineers.  It'll never work.
1956*4882a593Smuzhiyun 
1957*4882a593Smuzhiyun     if (rd_framer (dev, 0) & 0x00f0) {
1958*4882a593Smuzhiyun       // SUNI
1959*4882a593Smuzhiyun       printk (" SUNI");
1960*4882a593Smuzhiyun 
1961*4882a593Smuzhiyun       // Reset, just in case
1962*4882a593Smuzhiyun       wr_framer (dev, 0x00, 0x0080);
1963*4882a593Smuzhiyun       wr_framer (dev, 0x00, 0x0000);
1964*4882a593Smuzhiyun 
1965*4882a593Smuzhiyun       // Configure transmit FIFO
1966*4882a593Smuzhiyun       wr_framer (dev, 0x63, rd_framer (dev, 0x63) | 0x0002);
1967*4882a593Smuzhiyun 
1968*4882a593Smuzhiyun       // Set line timed mode
1969*4882a593Smuzhiyun       wr_framer (dev, 0x05, rd_framer (dev, 0x05) | 0x0001);
1970*4882a593Smuzhiyun     } else {
1971*4882a593Smuzhiyun       // SAMBA
1972*4882a593Smuzhiyun       printk (" SAMBA");
1973*4882a593Smuzhiyun 
1974*4882a593Smuzhiyun       // Reset, just in case
1975*4882a593Smuzhiyun       wr_framer (dev, 0, rd_framer (dev, 0) | 0x0001);
1976*4882a593Smuzhiyun       wr_framer (dev, 0, rd_framer (dev, 0) &~ 0x0001);
1977*4882a593Smuzhiyun 
1978*4882a593Smuzhiyun       // Turn off diagnostic loopback and enable line-timed mode
1979*4882a593Smuzhiyun       wr_framer (dev, 0, 0x0002);
1980*4882a593Smuzhiyun 
1981*4882a593Smuzhiyun       // Turn on transmit outputs
1982*4882a593Smuzhiyun       wr_framer (dev, 2, 0x0B80);
1983*4882a593Smuzhiyun     }
1984*4882a593Smuzhiyun   } else {
1985*4882a593Smuzhiyun     // Select 25 mode
1986*4882a593Smuzhiyun     ctrl &= ~ATM_LAYER_SELECT;
1987*4882a593Smuzhiyun 
1988*4882a593Smuzhiyun     // Madge B154 setup
1989*4882a593Smuzhiyun     // none required?
1990*4882a593Smuzhiyun   }
1991*4882a593Smuzhiyun 
1992*4882a593Smuzhiyun   printk (" LEDs");
1993*4882a593Smuzhiyun 
1994*4882a593Smuzhiyun   GREEN_LED_ON(dev);
1995*4882a593Smuzhiyun   YELLOW_LED_ON(dev);
1996*4882a593Smuzhiyun 
1997*4882a593Smuzhiyun   printk (" ESI=");
1998*4882a593Smuzhiyun 
1999*4882a593Smuzhiyun   {
2000*4882a593Smuzhiyun     u16 b = 0;
2001*4882a593Smuzhiyun     int i;
2002*4882a593Smuzhiyun     u8 * esi = dev->atm_dev->esi;
2003*4882a593Smuzhiyun 
2004*4882a593Smuzhiyun     // in the card I have, EEPROM
2005*4882a593Smuzhiyun     // addresses 0, 1, 2 contain 0
2006*4882a593Smuzhiyun     // addresess 5, 6 etc. contain ffff
2007*4882a593Smuzhiyun     // NB: Madge prefix is 00 00 f6 (which is 00 00 6f in Ethernet bit order)
2008*4882a593Smuzhiyun     // the read_bia routine gets the BIA in Ethernet bit order
2009*4882a593Smuzhiyun 
2010*4882a593Smuzhiyun     for (i=0; i < ESI_LEN; ++i) {
2011*4882a593Smuzhiyun       if (i % 2 == 0)
2012*4882a593Smuzhiyun 	b = read_bia (dev, i/2 + 2);
2013*4882a593Smuzhiyun       else
2014*4882a593Smuzhiyun 	b = b >> 8;
2015*4882a593Smuzhiyun       esi[i] = b & 0xFF;
2016*4882a593Smuzhiyun       printk ("%02x", esi[i]);
2017*4882a593Smuzhiyun     }
2018*4882a593Smuzhiyun   }
2019*4882a593Smuzhiyun 
2020*4882a593Smuzhiyun   // Enable RX_Q and ?X_COMPLETE interrupts only
2021*4882a593Smuzhiyun   wr_regl (dev, INT_ENABLE_REG_OFF, INTERESTING_INTERRUPTS);
2022*4882a593Smuzhiyun   printk (" IRQ on");
2023*4882a593Smuzhiyun 
2024*4882a593Smuzhiyun   printk (".\n");
2025*4882a593Smuzhiyun 
2026*4882a593Smuzhiyun   return onefivefive;
2027*4882a593Smuzhiyun }
2028*4882a593Smuzhiyun 
2029*4882a593Smuzhiyun /********** check max_sdu **********/
2030*4882a593Smuzhiyun 
check_max_sdu(hrz_aal aal,struct atm_trafprm * tp,unsigned int max_frame_size)2031*4882a593Smuzhiyun static int check_max_sdu (hrz_aal aal, struct atm_trafprm * tp, unsigned int max_frame_size) {
2032*4882a593Smuzhiyun   PRINTD (DBG_FLOW|DBG_QOS, "check_max_sdu");
2033*4882a593Smuzhiyun 
2034*4882a593Smuzhiyun   switch (aal) {
2035*4882a593Smuzhiyun     case aal0:
2036*4882a593Smuzhiyun       if (!(tp->max_sdu)) {
2037*4882a593Smuzhiyun 	PRINTD (DBG_QOS, "defaulting max_sdu");
2038*4882a593Smuzhiyun 	tp->max_sdu = ATM_AAL0_SDU;
2039*4882a593Smuzhiyun       } else if (tp->max_sdu != ATM_AAL0_SDU) {
2040*4882a593Smuzhiyun 	PRINTD (DBG_QOS|DBG_ERR, "rejecting max_sdu");
2041*4882a593Smuzhiyun 	return -EINVAL;
2042*4882a593Smuzhiyun       }
2043*4882a593Smuzhiyun       break;
2044*4882a593Smuzhiyun     case aal34:
2045*4882a593Smuzhiyun       if (tp->max_sdu == 0 || tp->max_sdu > ATM_MAX_AAL34_PDU) {
2046*4882a593Smuzhiyun 	PRINTD (DBG_QOS, "%sing max_sdu", tp->max_sdu ? "capp" : "default");
2047*4882a593Smuzhiyun 	tp->max_sdu = ATM_MAX_AAL34_PDU;
2048*4882a593Smuzhiyun       }
2049*4882a593Smuzhiyun       break;
2050*4882a593Smuzhiyun     case aal5:
2051*4882a593Smuzhiyun       if (tp->max_sdu == 0 || tp->max_sdu > max_frame_size) {
2052*4882a593Smuzhiyun 	PRINTD (DBG_QOS, "%sing max_sdu", tp->max_sdu ? "capp" : "default");
2053*4882a593Smuzhiyun 	tp->max_sdu = max_frame_size;
2054*4882a593Smuzhiyun       }
2055*4882a593Smuzhiyun       break;
2056*4882a593Smuzhiyun   }
2057*4882a593Smuzhiyun   return 0;
2058*4882a593Smuzhiyun }
2059*4882a593Smuzhiyun 
2060*4882a593Smuzhiyun /********** check pcr **********/
2061*4882a593Smuzhiyun 
2062*4882a593Smuzhiyun // something like this should be part of ATM Linux
atm_pcr_check(struct atm_trafprm * tp,unsigned int pcr)2063*4882a593Smuzhiyun static int atm_pcr_check (struct atm_trafprm * tp, unsigned int pcr) {
2064*4882a593Smuzhiyun   // we are assuming non-UBR, and non-special values of pcr
2065*4882a593Smuzhiyun   if (tp->min_pcr == ATM_MAX_PCR)
2066*4882a593Smuzhiyun     PRINTD (DBG_QOS, "luser gave min_pcr = ATM_MAX_PCR");
2067*4882a593Smuzhiyun   else if (tp->min_pcr < 0)
2068*4882a593Smuzhiyun     PRINTD (DBG_QOS, "luser gave negative min_pcr");
2069*4882a593Smuzhiyun   else if (tp->min_pcr && tp->min_pcr > pcr)
2070*4882a593Smuzhiyun     PRINTD (DBG_QOS, "pcr less than min_pcr");
2071*4882a593Smuzhiyun   else
2072*4882a593Smuzhiyun     // !! max_pcr = UNSPEC (0) is equivalent to max_pcr = MAX (-1)
2073*4882a593Smuzhiyun     // easier to #define ATM_MAX_PCR 0 and have all rates unsigned?
2074*4882a593Smuzhiyun     // [this would get rid of next two conditionals]
2075*4882a593Smuzhiyun     if ((0) && tp->max_pcr == ATM_MAX_PCR)
2076*4882a593Smuzhiyun       PRINTD (DBG_QOS, "luser gave max_pcr = ATM_MAX_PCR");
2077*4882a593Smuzhiyun     else if ((tp->max_pcr != ATM_MAX_PCR) && tp->max_pcr < 0)
2078*4882a593Smuzhiyun       PRINTD (DBG_QOS, "luser gave negative max_pcr");
2079*4882a593Smuzhiyun     else if (tp->max_pcr && tp->max_pcr != ATM_MAX_PCR && tp->max_pcr < pcr)
2080*4882a593Smuzhiyun       PRINTD (DBG_QOS, "pcr greater than max_pcr");
2081*4882a593Smuzhiyun     else {
2082*4882a593Smuzhiyun       // each limit unspecified or not violated
2083*4882a593Smuzhiyun       PRINTD (DBG_QOS, "xBR(pcr) OK");
2084*4882a593Smuzhiyun       return 0;
2085*4882a593Smuzhiyun     }
2086*4882a593Smuzhiyun   PRINTD (DBG_QOS, "pcr=%u, tp: min_pcr=%d, pcr=%d, max_pcr=%d",
2087*4882a593Smuzhiyun 	  pcr, tp->min_pcr, tp->pcr, tp->max_pcr);
2088*4882a593Smuzhiyun   return -EINVAL;
2089*4882a593Smuzhiyun }
2090*4882a593Smuzhiyun 
2091*4882a593Smuzhiyun /********** open VC **********/
2092*4882a593Smuzhiyun 
hrz_open(struct atm_vcc * atm_vcc)2093*4882a593Smuzhiyun static int hrz_open (struct atm_vcc *atm_vcc)
2094*4882a593Smuzhiyun {
2095*4882a593Smuzhiyun   int error;
2096*4882a593Smuzhiyun   u16 channel;
2097*4882a593Smuzhiyun 
2098*4882a593Smuzhiyun   struct atm_qos * qos;
2099*4882a593Smuzhiyun   struct atm_trafprm * txtp;
2100*4882a593Smuzhiyun   struct atm_trafprm * rxtp;
2101*4882a593Smuzhiyun 
2102*4882a593Smuzhiyun   hrz_dev * dev = HRZ_DEV(atm_vcc->dev);
2103*4882a593Smuzhiyun   hrz_vcc vcc;
2104*4882a593Smuzhiyun   hrz_vcc * vccp; // allocated late
2105*4882a593Smuzhiyun   short vpi = atm_vcc->vpi;
2106*4882a593Smuzhiyun   int vci = atm_vcc->vci;
2107*4882a593Smuzhiyun   PRINTD (DBG_FLOW|DBG_VCC, "hrz_open %x %x", vpi, vci);
2108*4882a593Smuzhiyun 
2109*4882a593Smuzhiyun #ifdef ATM_VPI_UNSPEC
2110*4882a593Smuzhiyun   // UNSPEC is deprecated, remove this code eventually
2111*4882a593Smuzhiyun   if (vpi == ATM_VPI_UNSPEC || vci == ATM_VCI_UNSPEC) {
2112*4882a593Smuzhiyun     PRINTK (KERN_WARNING, "rejecting open with unspecified VPI/VCI (deprecated)");
2113*4882a593Smuzhiyun     return -EINVAL;
2114*4882a593Smuzhiyun   }
2115*4882a593Smuzhiyun #endif
2116*4882a593Smuzhiyun 
2117*4882a593Smuzhiyun   error = vpivci_to_channel (&channel, vpi, vci);
2118*4882a593Smuzhiyun   if (error) {
2119*4882a593Smuzhiyun     PRINTD (DBG_WARN|DBG_VCC, "VPI/VCI out of range: %hd/%d", vpi, vci);
2120*4882a593Smuzhiyun     return error;
2121*4882a593Smuzhiyun   }
2122*4882a593Smuzhiyun 
2123*4882a593Smuzhiyun   vcc.channel = channel;
2124*4882a593Smuzhiyun   // max speed for the moment
2125*4882a593Smuzhiyun   vcc.tx_rate = 0x0;
2126*4882a593Smuzhiyun 
2127*4882a593Smuzhiyun   qos = &atm_vcc->qos;
2128*4882a593Smuzhiyun 
2129*4882a593Smuzhiyun   // check AAL and remember it
2130*4882a593Smuzhiyun   switch (qos->aal) {
2131*4882a593Smuzhiyun     case ATM_AAL0:
2132*4882a593Smuzhiyun       // we would if it were 48 bytes and not 52!
2133*4882a593Smuzhiyun       PRINTD (DBG_QOS|DBG_VCC, "AAL0");
2134*4882a593Smuzhiyun       vcc.aal = aal0;
2135*4882a593Smuzhiyun       break;
2136*4882a593Smuzhiyun     case ATM_AAL34:
2137*4882a593Smuzhiyun       // we would if I knew how do the SAR!
2138*4882a593Smuzhiyun       PRINTD (DBG_QOS|DBG_VCC, "AAL3/4");
2139*4882a593Smuzhiyun       vcc.aal = aal34;
2140*4882a593Smuzhiyun       break;
2141*4882a593Smuzhiyun     case ATM_AAL5:
2142*4882a593Smuzhiyun       PRINTD (DBG_QOS|DBG_VCC, "AAL5");
2143*4882a593Smuzhiyun       vcc.aal = aal5;
2144*4882a593Smuzhiyun       break;
2145*4882a593Smuzhiyun     default:
2146*4882a593Smuzhiyun       PRINTD (DBG_QOS|DBG_VCC, "Bad AAL!");
2147*4882a593Smuzhiyun       return -EINVAL;
2148*4882a593Smuzhiyun   }
2149*4882a593Smuzhiyun 
2150*4882a593Smuzhiyun   // TX traffic parameters
2151*4882a593Smuzhiyun 
2152*4882a593Smuzhiyun   // there are two, interrelated problems here: 1. the reservation of
2153*4882a593Smuzhiyun   // PCR is not a binary choice, we are given bounds and/or a
2154*4882a593Smuzhiyun   // desirable value; 2. the device is only capable of certain values,
2155*4882a593Smuzhiyun   // most of which are not integers. It is almost certainly acceptable
2156*4882a593Smuzhiyun   // to be off by a maximum of 1 to 10 cps.
2157*4882a593Smuzhiyun 
2158*4882a593Smuzhiyun   // Pragmatic choice: always store an integral PCR as that which has
2159*4882a593Smuzhiyun   // been allocated, even if we allocate a little (or a lot) less,
2160*4882a593Smuzhiyun   // after rounding. The actual allocation depends on what we can
2161*4882a593Smuzhiyun   // manage with our rate selection algorithm. The rate selection
2162*4882a593Smuzhiyun   // algorithm is given an integral PCR and a tolerance and told
2163*4882a593Smuzhiyun   // whether it should round the value up or down if the tolerance is
2164*4882a593Smuzhiyun   // exceeded; it returns: a) the actual rate selected (rounded up to
2165*4882a593Smuzhiyun   // the nearest integer), b) a bit pattern to feed to the timer
2166*4882a593Smuzhiyun   // register, and c) a failure value if no applicable rate exists.
2167*4882a593Smuzhiyun 
2168*4882a593Smuzhiyun   // Part of the job is done by atm_pcr_goal which gives us a PCR
2169*4882a593Smuzhiyun   // specification which says: EITHER grab the maximum available PCR
2170*4882a593Smuzhiyun   // (and perhaps a lower bound which we musn't pass), OR grab this
2171*4882a593Smuzhiyun   // amount, rounding down if you have to (and perhaps a lower bound
2172*4882a593Smuzhiyun   // which we musn't pass) OR grab this amount, rounding up if you
2173*4882a593Smuzhiyun   // have to (and perhaps an upper bound which we musn't pass). If any
2174*4882a593Smuzhiyun   // bounds ARE passed we fail. Note that rounding is only rounding to
2175*4882a593Smuzhiyun   // match device limitations, we do not round down to satisfy
2176*4882a593Smuzhiyun   // bandwidth availability even if this would not violate any given
2177*4882a593Smuzhiyun   // lower bound.
2178*4882a593Smuzhiyun 
2179*4882a593Smuzhiyun   // Note: telephony = 64kb/s = 48 byte cell payload @ 500/3 cells/s
2180*4882a593Smuzhiyun   // (say) so this is not even a binary fixpoint cell rate (but this
2181*4882a593Smuzhiyun   // device can do it). To avoid this sort of hassle we use a
2182*4882a593Smuzhiyun   // tolerance parameter (currently fixed at 10 cps).
2183*4882a593Smuzhiyun 
2184*4882a593Smuzhiyun   PRINTD (DBG_QOS, "TX:");
2185*4882a593Smuzhiyun 
2186*4882a593Smuzhiyun   txtp = &qos->txtp;
2187*4882a593Smuzhiyun 
2188*4882a593Smuzhiyun   // set up defaults for no traffic
2189*4882a593Smuzhiyun   vcc.tx_rate = 0;
2190*4882a593Smuzhiyun   // who knows what would actually happen if you try and send on this?
2191*4882a593Smuzhiyun   vcc.tx_xbr_bits = IDLE_RATE_TYPE;
2192*4882a593Smuzhiyun   vcc.tx_pcr_bits = CLOCK_DISABLE;
2193*4882a593Smuzhiyun #if 0
2194*4882a593Smuzhiyun   vcc.tx_scr_bits = CLOCK_DISABLE;
2195*4882a593Smuzhiyun   vcc.tx_bucket_bits = 0;
2196*4882a593Smuzhiyun #endif
2197*4882a593Smuzhiyun 
2198*4882a593Smuzhiyun   if (txtp->traffic_class != ATM_NONE) {
2199*4882a593Smuzhiyun     error = check_max_sdu (vcc.aal, txtp, max_tx_size);
2200*4882a593Smuzhiyun     if (error) {
2201*4882a593Smuzhiyun       PRINTD (DBG_QOS, "TX max_sdu check failed");
2202*4882a593Smuzhiyun       return error;
2203*4882a593Smuzhiyun     }
2204*4882a593Smuzhiyun 
2205*4882a593Smuzhiyun     switch (txtp->traffic_class) {
2206*4882a593Smuzhiyun       case ATM_UBR: {
2207*4882a593Smuzhiyun 	// we take "the PCR" as a rate-cap
2208*4882a593Smuzhiyun 	// not reserved
2209*4882a593Smuzhiyun 	vcc.tx_rate = 0;
2210*4882a593Smuzhiyun 	make_rate (dev, 1<<30, round_nearest, &vcc.tx_pcr_bits, NULL);
2211*4882a593Smuzhiyun 	vcc.tx_xbr_bits = ABR_RATE_TYPE;
2212*4882a593Smuzhiyun 	break;
2213*4882a593Smuzhiyun       }
2214*4882a593Smuzhiyun #if 0
2215*4882a593Smuzhiyun       case ATM_ABR: {
2216*4882a593Smuzhiyun 	// reserve min, allow up to max
2217*4882a593Smuzhiyun 	vcc.tx_rate = 0; // ?
2218*4882a593Smuzhiyun 	make_rate (dev, 1<<30, round_nearest, &vcc.tx_pcr_bits, 0);
2219*4882a593Smuzhiyun 	vcc.tx_xbr_bits = ABR_RATE_TYPE;
2220*4882a593Smuzhiyun 	break;
2221*4882a593Smuzhiyun       }
2222*4882a593Smuzhiyun #endif
2223*4882a593Smuzhiyun       case ATM_CBR: {
2224*4882a593Smuzhiyun 	int pcr = atm_pcr_goal (txtp);
2225*4882a593Smuzhiyun 	rounding r;
2226*4882a593Smuzhiyun 	if (!pcr) {
2227*4882a593Smuzhiyun 	  // down vs. up, remaining bandwidth vs. unlimited bandwidth!!
2228*4882a593Smuzhiyun 	  // should really have: once someone gets unlimited bandwidth
2229*4882a593Smuzhiyun 	  // that no more non-UBR channels can be opened until the
2230*4882a593Smuzhiyun 	  // unlimited one closes?? For the moment, round_down means
2231*4882a593Smuzhiyun 	  // greedy people actually get something and not nothing
2232*4882a593Smuzhiyun 	  r = round_down;
2233*4882a593Smuzhiyun 	  // slight race (no locking) here so we may get -EAGAIN
2234*4882a593Smuzhiyun 	  // later; the greedy bastards would deserve it :)
2235*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "snatching all remaining TX bandwidth");
2236*4882a593Smuzhiyun 	  pcr = dev->tx_avail;
2237*4882a593Smuzhiyun 	} else if (pcr < 0) {
2238*4882a593Smuzhiyun 	  r = round_down;
2239*4882a593Smuzhiyun 	  pcr = -pcr;
2240*4882a593Smuzhiyun 	} else {
2241*4882a593Smuzhiyun 	  r = round_up;
2242*4882a593Smuzhiyun 	}
2243*4882a593Smuzhiyun 	error = make_rate_with_tolerance (dev, pcr, r, 10,
2244*4882a593Smuzhiyun 					  &vcc.tx_pcr_bits, &vcc.tx_rate);
2245*4882a593Smuzhiyun 	if (error) {
2246*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "could not make rate from TX PCR");
2247*4882a593Smuzhiyun 	  return error;
2248*4882a593Smuzhiyun 	}
2249*4882a593Smuzhiyun 	// not really clear what further checking is needed
2250*4882a593Smuzhiyun 	error = atm_pcr_check (txtp, vcc.tx_rate);
2251*4882a593Smuzhiyun 	if (error) {
2252*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "TX PCR failed consistency check");
2253*4882a593Smuzhiyun 	  return error;
2254*4882a593Smuzhiyun 	}
2255*4882a593Smuzhiyun 	vcc.tx_xbr_bits = CBR_RATE_TYPE;
2256*4882a593Smuzhiyun 	break;
2257*4882a593Smuzhiyun       }
2258*4882a593Smuzhiyun #if 0
2259*4882a593Smuzhiyun       case ATM_VBR: {
2260*4882a593Smuzhiyun 	int pcr = atm_pcr_goal (txtp);
2261*4882a593Smuzhiyun 	// int scr = atm_scr_goal (txtp);
2262*4882a593Smuzhiyun 	int scr = pcr/2; // just for fun
2263*4882a593Smuzhiyun 	unsigned int mbs = 60; // just for fun
2264*4882a593Smuzhiyun 	rounding pr;
2265*4882a593Smuzhiyun 	rounding sr;
2266*4882a593Smuzhiyun 	unsigned int bucket;
2267*4882a593Smuzhiyun 	if (!pcr) {
2268*4882a593Smuzhiyun 	  pr = round_nearest;
2269*4882a593Smuzhiyun 	  pcr = 1<<30;
2270*4882a593Smuzhiyun 	} else if (pcr < 0) {
2271*4882a593Smuzhiyun 	  pr = round_down;
2272*4882a593Smuzhiyun 	  pcr = -pcr;
2273*4882a593Smuzhiyun 	} else {
2274*4882a593Smuzhiyun 	  pr = round_up;
2275*4882a593Smuzhiyun 	}
2276*4882a593Smuzhiyun 	error = make_rate_with_tolerance (dev, pcr, pr, 10,
2277*4882a593Smuzhiyun 					  &vcc.tx_pcr_bits, 0);
2278*4882a593Smuzhiyun 	if (!scr) {
2279*4882a593Smuzhiyun 	  // see comments for PCR with CBR above
2280*4882a593Smuzhiyun 	  sr = round_down;
2281*4882a593Smuzhiyun 	  // slight race (no locking) here so we may get -EAGAIN
2282*4882a593Smuzhiyun 	  // later; the greedy bastards would deserve it :)
2283*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "snatching all remaining TX bandwidth");
2284*4882a593Smuzhiyun 	  scr = dev->tx_avail;
2285*4882a593Smuzhiyun 	} else if (scr < 0) {
2286*4882a593Smuzhiyun 	  sr = round_down;
2287*4882a593Smuzhiyun 	  scr = -scr;
2288*4882a593Smuzhiyun 	} else {
2289*4882a593Smuzhiyun 	  sr = round_up;
2290*4882a593Smuzhiyun 	}
2291*4882a593Smuzhiyun 	error = make_rate_with_tolerance (dev, scr, sr, 10,
2292*4882a593Smuzhiyun 					  &vcc.tx_scr_bits, &vcc.tx_rate);
2293*4882a593Smuzhiyun 	if (error) {
2294*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "could not make rate from TX SCR");
2295*4882a593Smuzhiyun 	  return error;
2296*4882a593Smuzhiyun 	}
2297*4882a593Smuzhiyun 	// not really clear what further checking is needed
2298*4882a593Smuzhiyun 	// error = atm_scr_check (txtp, vcc.tx_rate);
2299*4882a593Smuzhiyun 	if (error) {
2300*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "TX SCR failed consistency check");
2301*4882a593Smuzhiyun 	  return error;
2302*4882a593Smuzhiyun 	}
2303*4882a593Smuzhiyun 	// bucket calculations (from a piece of paper...) cell bucket
2304*4882a593Smuzhiyun 	// capacity must be largest integer smaller than m(p-s)/p + 1
2305*4882a593Smuzhiyun 	// where m = max burst size, p = pcr, s = scr
2306*4882a593Smuzhiyun 	bucket = mbs*(pcr-scr)/pcr;
2307*4882a593Smuzhiyun 	if (bucket*pcr != mbs*(pcr-scr))
2308*4882a593Smuzhiyun 	  bucket += 1;
2309*4882a593Smuzhiyun 	if (bucket > BUCKET_MAX_SIZE) {
2310*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "shrinking bucket from %u to %u",
2311*4882a593Smuzhiyun 		  bucket, BUCKET_MAX_SIZE);
2312*4882a593Smuzhiyun 	  bucket = BUCKET_MAX_SIZE;
2313*4882a593Smuzhiyun 	}
2314*4882a593Smuzhiyun 	vcc.tx_xbr_bits = VBR_RATE_TYPE;
2315*4882a593Smuzhiyun 	vcc.tx_bucket_bits = bucket;
2316*4882a593Smuzhiyun 	break;
2317*4882a593Smuzhiyun       }
2318*4882a593Smuzhiyun #endif
2319*4882a593Smuzhiyun       default: {
2320*4882a593Smuzhiyun 	PRINTD (DBG_QOS, "unsupported TX traffic class");
2321*4882a593Smuzhiyun 	return -EINVAL;
2322*4882a593Smuzhiyun       }
2323*4882a593Smuzhiyun     }
2324*4882a593Smuzhiyun   }
2325*4882a593Smuzhiyun 
2326*4882a593Smuzhiyun   // RX traffic parameters
2327*4882a593Smuzhiyun 
2328*4882a593Smuzhiyun   PRINTD (DBG_QOS, "RX:");
2329*4882a593Smuzhiyun 
2330*4882a593Smuzhiyun   rxtp = &qos->rxtp;
2331*4882a593Smuzhiyun 
2332*4882a593Smuzhiyun   // set up defaults for no traffic
2333*4882a593Smuzhiyun   vcc.rx_rate = 0;
2334*4882a593Smuzhiyun 
2335*4882a593Smuzhiyun   if (rxtp->traffic_class != ATM_NONE) {
2336*4882a593Smuzhiyun     error = check_max_sdu (vcc.aal, rxtp, max_rx_size);
2337*4882a593Smuzhiyun     if (error) {
2338*4882a593Smuzhiyun       PRINTD (DBG_QOS, "RX max_sdu check failed");
2339*4882a593Smuzhiyun       return error;
2340*4882a593Smuzhiyun     }
2341*4882a593Smuzhiyun     switch (rxtp->traffic_class) {
2342*4882a593Smuzhiyun       case ATM_UBR: {
2343*4882a593Smuzhiyun 	// not reserved
2344*4882a593Smuzhiyun 	break;
2345*4882a593Smuzhiyun       }
2346*4882a593Smuzhiyun #if 0
2347*4882a593Smuzhiyun       case ATM_ABR: {
2348*4882a593Smuzhiyun 	// reserve min
2349*4882a593Smuzhiyun 	vcc.rx_rate = 0; // ?
2350*4882a593Smuzhiyun 	break;
2351*4882a593Smuzhiyun       }
2352*4882a593Smuzhiyun #endif
2353*4882a593Smuzhiyun       case ATM_CBR: {
2354*4882a593Smuzhiyun 	int pcr = atm_pcr_goal (rxtp);
2355*4882a593Smuzhiyun 	if (!pcr) {
2356*4882a593Smuzhiyun 	  // slight race (no locking) here so we may get -EAGAIN
2357*4882a593Smuzhiyun 	  // later; the greedy bastards would deserve it :)
2358*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "snatching all remaining RX bandwidth");
2359*4882a593Smuzhiyun 	  pcr = dev->rx_avail;
2360*4882a593Smuzhiyun 	} else if (pcr < 0) {
2361*4882a593Smuzhiyun 	  pcr = -pcr;
2362*4882a593Smuzhiyun 	}
2363*4882a593Smuzhiyun 	vcc.rx_rate = pcr;
2364*4882a593Smuzhiyun 	// not really clear what further checking is needed
2365*4882a593Smuzhiyun 	error = atm_pcr_check (rxtp, vcc.rx_rate);
2366*4882a593Smuzhiyun 	if (error) {
2367*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "RX PCR failed consistency check");
2368*4882a593Smuzhiyun 	  return error;
2369*4882a593Smuzhiyun 	}
2370*4882a593Smuzhiyun 	break;
2371*4882a593Smuzhiyun       }
2372*4882a593Smuzhiyun #if 0
2373*4882a593Smuzhiyun       case ATM_VBR: {
2374*4882a593Smuzhiyun 	// int scr = atm_scr_goal (rxtp);
2375*4882a593Smuzhiyun 	int scr = 1<<16; // just for fun
2376*4882a593Smuzhiyun 	if (!scr) {
2377*4882a593Smuzhiyun 	  // slight race (no locking) here so we may get -EAGAIN
2378*4882a593Smuzhiyun 	  // later; the greedy bastards would deserve it :)
2379*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "snatching all remaining RX bandwidth");
2380*4882a593Smuzhiyun 	  scr = dev->rx_avail;
2381*4882a593Smuzhiyun 	} else if (scr < 0) {
2382*4882a593Smuzhiyun 	  scr = -scr;
2383*4882a593Smuzhiyun 	}
2384*4882a593Smuzhiyun 	vcc.rx_rate = scr;
2385*4882a593Smuzhiyun 	// not really clear what further checking is needed
2386*4882a593Smuzhiyun 	// error = atm_scr_check (rxtp, vcc.rx_rate);
2387*4882a593Smuzhiyun 	if (error) {
2388*4882a593Smuzhiyun 	  PRINTD (DBG_QOS, "RX SCR failed consistency check");
2389*4882a593Smuzhiyun 	  return error;
2390*4882a593Smuzhiyun 	}
2391*4882a593Smuzhiyun 	break;
2392*4882a593Smuzhiyun       }
2393*4882a593Smuzhiyun #endif
2394*4882a593Smuzhiyun       default: {
2395*4882a593Smuzhiyun 	PRINTD (DBG_QOS, "unsupported RX traffic class");
2396*4882a593Smuzhiyun 	return -EINVAL;
2397*4882a593Smuzhiyun       }
2398*4882a593Smuzhiyun     }
2399*4882a593Smuzhiyun   }
2400*4882a593Smuzhiyun 
2401*4882a593Smuzhiyun 
2402*4882a593Smuzhiyun   // late abort useful for diagnostics
2403*4882a593Smuzhiyun   if (vcc.aal != aal5) {
2404*4882a593Smuzhiyun     PRINTD (DBG_QOS, "AAL not supported");
2405*4882a593Smuzhiyun     return -EINVAL;
2406*4882a593Smuzhiyun   }
2407*4882a593Smuzhiyun 
2408*4882a593Smuzhiyun   // get space for our vcc stuff and copy parameters into it
2409*4882a593Smuzhiyun   vccp = kmalloc (sizeof(hrz_vcc), GFP_KERNEL);
2410*4882a593Smuzhiyun   if (!vccp) {
2411*4882a593Smuzhiyun     PRINTK (KERN_ERR, "out of memory!");
2412*4882a593Smuzhiyun     return -ENOMEM;
2413*4882a593Smuzhiyun   }
2414*4882a593Smuzhiyun   *vccp = vcc;
2415*4882a593Smuzhiyun 
2416*4882a593Smuzhiyun   // clear error and grab cell rate resource lock
2417*4882a593Smuzhiyun   error = 0;
2418*4882a593Smuzhiyun   spin_lock (&dev->rate_lock);
2419*4882a593Smuzhiyun 
2420*4882a593Smuzhiyun   if (vcc.tx_rate > dev->tx_avail) {
2421*4882a593Smuzhiyun     PRINTD (DBG_QOS, "not enough TX PCR left");
2422*4882a593Smuzhiyun     error = -EAGAIN;
2423*4882a593Smuzhiyun   }
2424*4882a593Smuzhiyun 
2425*4882a593Smuzhiyun   if (vcc.rx_rate > dev->rx_avail) {
2426*4882a593Smuzhiyun     PRINTD (DBG_QOS, "not enough RX PCR left");
2427*4882a593Smuzhiyun     error = -EAGAIN;
2428*4882a593Smuzhiyun   }
2429*4882a593Smuzhiyun 
2430*4882a593Smuzhiyun   if (!error) {
2431*4882a593Smuzhiyun     // really consume cell rates
2432*4882a593Smuzhiyun     dev->tx_avail -= vcc.tx_rate;
2433*4882a593Smuzhiyun     dev->rx_avail -= vcc.rx_rate;
2434*4882a593Smuzhiyun     PRINTD (DBG_QOS|DBG_VCC, "reserving %u TX PCR and %u RX PCR",
2435*4882a593Smuzhiyun 	    vcc.tx_rate, vcc.rx_rate);
2436*4882a593Smuzhiyun   }
2437*4882a593Smuzhiyun 
2438*4882a593Smuzhiyun   // release lock and exit on error
2439*4882a593Smuzhiyun   spin_unlock (&dev->rate_lock);
2440*4882a593Smuzhiyun   if (error) {
2441*4882a593Smuzhiyun     PRINTD (DBG_QOS|DBG_VCC, "insufficient cell rate resources");
2442*4882a593Smuzhiyun     kfree (vccp);
2443*4882a593Smuzhiyun     return error;
2444*4882a593Smuzhiyun   }
2445*4882a593Smuzhiyun 
2446*4882a593Smuzhiyun   // this is "immediately before allocating the connection identifier
2447*4882a593Smuzhiyun   // in hardware" - so long as the next call does not fail :)
2448*4882a593Smuzhiyun   set_bit(ATM_VF_ADDR,&atm_vcc->flags);
2449*4882a593Smuzhiyun 
2450*4882a593Smuzhiyun   // any errors here are very serious and should never occur
2451*4882a593Smuzhiyun 
2452*4882a593Smuzhiyun   if (rxtp->traffic_class != ATM_NONE) {
2453*4882a593Smuzhiyun     if (dev->rxer[channel]) {
2454*4882a593Smuzhiyun       PRINTD (DBG_ERR|DBG_VCC, "VC already open for RX");
2455*4882a593Smuzhiyun       error = -EBUSY;
2456*4882a593Smuzhiyun     }
2457*4882a593Smuzhiyun     if (!error)
2458*4882a593Smuzhiyun       error = hrz_open_rx (dev, channel);
2459*4882a593Smuzhiyun     if (error) {
2460*4882a593Smuzhiyun       kfree (vccp);
2461*4882a593Smuzhiyun       return error;
2462*4882a593Smuzhiyun     }
2463*4882a593Smuzhiyun     // this link allows RX frames through
2464*4882a593Smuzhiyun     dev->rxer[channel] = atm_vcc;
2465*4882a593Smuzhiyun   }
2466*4882a593Smuzhiyun 
2467*4882a593Smuzhiyun   // success, set elements of atm_vcc
2468*4882a593Smuzhiyun   atm_vcc->dev_data = (void *) vccp;
2469*4882a593Smuzhiyun 
2470*4882a593Smuzhiyun   // indicate readiness
2471*4882a593Smuzhiyun   set_bit(ATM_VF_READY,&atm_vcc->flags);
2472*4882a593Smuzhiyun 
2473*4882a593Smuzhiyun   return 0;
2474*4882a593Smuzhiyun }
2475*4882a593Smuzhiyun 
2476*4882a593Smuzhiyun /********** close VC **********/
2477*4882a593Smuzhiyun 
hrz_close(struct atm_vcc * atm_vcc)2478*4882a593Smuzhiyun static void hrz_close (struct atm_vcc * atm_vcc) {
2479*4882a593Smuzhiyun   hrz_dev * dev = HRZ_DEV(atm_vcc->dev);
2480*4882a593Smuzhiyun   hrz_vcc * vcc = HRZ_VCC(atm_vcc);
2481*4882a593Smuzhiyun   u16 channel = vcc->channel;
2482*4882a593Smuzhiyun   PRINTD (DBG_VCC|DBG_FLOW, "hrz_close");
2483*4882a593Smuzhiyun 
2484*4882a593Smuzhiyun   // indicate unreadiness
2485*4882a593Smuzhiyun   clear_bit(ATM_VF_READY,&atm_vcc->flags);
2486*4882a593Smuzhiyun 
2487*4882a593Smuzhiyun   if (atm_vcc->qos.txtp.traffic_class != ATM_NONE) {
2488*4882a593Smuzhiyun     unsigned int i;
2489*4882a593Smuzhiyun 
2490*4882a593Smuzhiyun     // let any TX on this channel that has started complete
2491*4882a593Smuzhiyun     // no restart, just keep trying
2492*4882a593Smuzhiyun     while (tx_hold (dev))
2493*4882a593Smuzhiyun       ;
2494*4882a593Smuzhiyun     // remove record of any tx_channel having been setup for this channel
2495*4882a593Smuzhiyun     for (i = 0; i < TX_CHANS; ++i)
2496*4882a593Smuzhiyun       if (dev->tx_channel_record[i] == channel) {
2497*4882a593Smuzhiyun 	dev->tx_channel_record[i] = -1;
2498*4882a593Smuzhiyun 	break;
2499*4882a593Smuzhiyun       }
2500*4882a593Smuzhiyun     if (dev->last_vc == channel)
2501*4882a593Smuzhiyun       dev->tx_last = -1;
2502*4882a593Smuzhiyun     tx_release (dev);
2503*4882a593Smuzhiyun   }
2504*4882a593Smuzhiyun 
2505*4882a593Smuzhiyun   if (atm_vcc->qos.rxtp.traffic_class != ATM_NONE) {
2506*4882a593Smuzhiyun     // disable RXing - it tries quite hard
2507*4882a593Smuzhiyun     hrz_close_rx (dev, channel);
2508*4882a593Smuzhiyun     // forget the vcc - no more skbs will be pushed
2509*4882a593Smuzhiyun     if (atm_vcc != dev->rxer[channel])
2510*4882a593Smuzhiyun       PRINTK (KERN_ERR, "%s atm_vcc=%p rxer[channel]=%p",
2511*4882a593Smuzhiyun 	      "arghhh! we're going to die!",
2512*4882a593Smuzhiyun 	      atm_vcc, dev->rxer[channel]);
2513*4882a593Smuzhiyun     dev->rxer[channel] = NULL;
2514*4882a593Smuzhiyun   }
2515*4882a593Smuzhiyun 
2516*4882a593Smuzhiyun   // atomically release our rate reservation
2517*4882a593Smuzhiyun   spin_lock (&dev->rate_lock);
2518*4882a593Smuzhiyun   PRINTD (DBG_QOS|DBG_VCC, "releasing %u TX PCR and %u RX PCR",
2519*4882a593Smuzhiyun 	  vcc->tx_rate, vcc->rx_rate);
2520*4882a593Smuzhiyun   dev->tx_avail += vcc->tx_rate;
2521*4882a593Smuzhiyun   dev->rx_avail += vcc->rx_rate;
2522*4882a593Smuzhiyun   spin_unlock (&dev->rate_lock);
2523*4882a593Smuzhiyun 
2524*4882a593Smuzhiyun   // free our structure
2525*4882a593Smuzhiyun   kfree (vcc);
2526*4882a593Smuzhiyun   // say the VPI/VCI is free again
2527*4882a593Smuzhiyun   clear_bit(ATM_VF_ADDR,&atm_vcc->flags);
2528*4882a593Smuzhiyun }
2529*4882a593Smuzhiyun 
2530*4882a593Smuzhiyun #if 0
2531*4882a593Smuzhiyun static int hrz_ioctl (struct atm_dev * atm_dev, unsigned int cmd, void *arg) {
2532*4882a593Smuzhiyun   hrz_dev * dev = HRZ_DEV(atm_dev);
2533*4882a593Smuzhiyun   PRINTD (DBG_FLOW, "hrz_ioctl");
2534*4882a593Smuzhiyun   return -1;
2535*4882a593Smuzhiyun }
2536*4882a593Smuzhiyun 
2537*4882a593Smuzhiyun unsigned char hrz_phy_get (struct atm_dev * atm_dev, unsigned long addr) {
2538*4882a593Smuzhiyun   hrz_dev * dev = HRZ_DEV(atm_dev);
2539*4882a593Smuzhiyun   PRINTD (DBG_FLOW, "hrz_phy_get");
2540*4882a593Smuzhiyun   return 0;
2541*4882a593Smuzhiyun }
2542*4882a593Smuzhiyun 
2543*4882a593Smuzhiyun static void hrz_phy_put (struct atm_dev * atm_dev, unsigned char value,
2544*4882a593Smuzhiyun 			 unsigned long addr) {
2545*4882a593Smuzhiyun   hrz_dev * dev = HRZ_DEV(atm_dev);
2546*4882a593Smuzhiyun   PRINTD (DBG_FLOW, "hrz_phy_put");
2547*4882a593Smuzhiyun }
2548*4882a593Smuzhiyun 
2549*4882a593Smuzhiyun static int hrz_change_qos (struct atm_vcc * atm_vcc, struct atm_qos *qos, int flgs) {
2550*4882a593Smuzhiyun   hrz_dev * dev = HRZ_DEV(vcc->dev);
2551*4882a593Smuzhiyun   PRINTD (DBG_FLOW, "hrz_change_qos");
2552*4882a593Smuzhiyun   return -1;
2553*4882a593Smuzhiyun }
2554*4882a593Smuzhiyun #endif
2555*4882a593Smuzhiyun 
2556*4882a593Smuzhiyun /********** proc file contents **********/
2557*4882a593Smuzhiyun 
hrz_proc_read(struct atm_dev * atm_dev,loff_t * pos,char * page)2558*4882a593Smuzhiyun static int hrz_proc_read (struct atm_dev * atm_dev, loff_t * pos, char * page) {
2559*4882a593Smuzhiyun   hrz_dev * dev = HRZ_DEV(atm_dev);
2560*4882a593Smuzhiyun   int left = *pos;
2561*4882a593Smuzhiyun   PRINTD (DBG_FLOW, "hrz_proc_read");
2562*4882a593Smuzhiyun 
2563*4882a593Smuzhiyun   /* more diagnostics here? */
2564*4882a593Smuzhiyun 
2565*4882a593Smuzhiyun #if 0
2566*4882a593Smuzhiyun   if (!left--) {
2567*4882a593Smuzhiyun     unsigned int count = sprintf (page, "vbr buckets:");
2568*4882a593Smuzhiyun     unsigned int i;
2569*4882a593Smuzhiyun     for (i = 0; i < TX_CHANS; ++i)
2570*4882a593Smuzhiyun       count += sprintf (page, " %u/%u",
2571*4882a593Smuzhiyun 			query_tx_channel_config (dev, i, BUCKET_FULLNESS_ACCESS),
2572*4882a593Smuzhiyun 			query_tx_channel_config (dev, i, BUCKET_CAPACITY_ACCESS));
2573*4882a593Smuzhiyun     count += sprintf (page+count, ".\n");
2574*4882a593Smuzhiyun     return count;
2575*4882a593Smuzhiyun   }
2576*4882a593Smuzhiyun #endif
2577*4882a593Smuzhiyun 
2578*4882a593Smuzhiyun   if (!left--)
2579*4882a593Smuzhiyun     return sprintf (page,
2580*4882a593Smuzhiyun 		    "cells: TX %lu, RX %lu, HEC errors %lu, unassigned %lu.\n",
2581*4882a593Smuzhiyun 		    dev->tx_cell_count, dev->rx_cell_count,
2582*4882a593Smuzhiyun 		    dev->hec_error_count, dev->unassigned_cell_count);
2583*4882a593Smuzhiyun 
2584*4882a593Smuzhiyun   if (!left--)
2585*4882a593Smuzhiyun     return sprintf (page,
2586*4882a593Smuzhiyun 		    "free cell buffers: TX %hu, RX %hu+%hu.\n",
2587*4882a593Smuzhiyun 		    rd_regw (dev, TX_FREE_BUFFER_COUNT_OFF),
2588*4882a593Smuzhiyun 		    rd_regw (dev, RX_FREE_BUFFER_COUNT_OFF),
2589*4882a593Smuzhiyun 		    dev->noof_spare_buffers);
2590*4882a593Smuzhiyun 
2591*4882a593Smuzhiyun   if (!left--)
2592*4882a593Smuzhiyun     return sprintf (page,
2593*4882a593Smuzhiyun 		    "cps remaining: TX %u, RX %u\n",
2594*4882a593Smuzhiyun 		    dev->tx_avail, dev->rx_avail);
2595*4882a593Smuzhiyun 
2596*4882a593Smuzhiyun   return 0;
2597*4882a593Smuzhiyun }
2598*4882a593Smuzhiyun 
2599*4882a593Smuzhiyun static const struct atmdev_ops hrz_ops = {
2600*4882a593Smuzhiyun   .open	= hrz_open,
2601*4882a593Smuzhiyun   .close	= hrz_close,
2602*4882a593Smuzhiyun   .send	= hrz_send,
2603*4882a593Smuzhiyun   .proc_read	= hrz_proc_read,
2604*4882a593Smuzhiyun   .owner	= THIS_MODULE,
2605*4882a593Smuzhiyun };
2606*4882a593Smuzhiyun 
hrz_probe(struct pci_dev * pci_dev,const struct pci_device_id * pci_ent)2607*4882a593Smuzhiyun static int hrz_probe(struct pci_dev *pci_dev,
2608*4882a593Smuzhiyun 		     const struct pci_device_id *pci_ent)
2609*4882a593Smuzhiyun {
2610*4882a593Smuzhiyun 	hrz_dev * dev;
2611*4882a593Smuzhiyun 	int err = 0;
2612*4882a593Smuzhiyun 
2613*4882a593Smuzhiyun 	// adapter slot free, read resources from PCI configuration space
2614*4882a593Smuzhiyun 	u32 iobase = pci_resource_start (pci_dev, 0);
2615*4882a593Smuzhiyun 	u32 * membase = bus_to_virt (pci_resource_start (pci_dev, 1));
2616*4882a593Smuzhiyun 	unsigned int irq;
2617*4882a593Smuzhiyun 	unsigned char lat;
2618*4882a593Smuzhiyun 
2619*4882a593Smuzhiyun 	PRINTD (DBG_FLOW, "hrz_probe");
2620*4882a593Smuzhiyun 
2621*4882a593Smuzhiyun 	if (pci_enable_device(pci_dev))
2622*4882a593Smuzhiyun 		return -EINVAL;
2623*4882a593Smuzhiyun 
2624*4882a593Smuzhiyun 	/* XXX DEV_LABEL is a guess */
2625*4882a593Smuzhiyun 	if (!request_region(iobase, HRZ_IO_EXTENT, DEV_LABEL)) {
2626*4882a593Smuzhiyun 		err = -EINVAL;
2627*4882a593Smuzhiyun 		goto out_disable;
2628*4882a593Smuzhiyun 	}
2629*4882a593Smuzhiyun 
2630*4882a593Smuzhiyun 	dev = kzalloc(sizeof(hrz_dev), GFP_KERNEL);
2631*4882a593Smuzhiyun 	if (!dev) {
2632*4882a593Smuzhiyun 		// perhaps we should be nice: deregister all adapters and abort?
2633*4882a593Smuzhiyun 		PRINTD(DBG_ERR, "out of memory");
2634*4882a593Smuzhiyun 		err = -ENOMEM;
2635*4882a593Smuzhiyun 		goto out_release;
2636*4882a593Smuzhiyun 	}
2637*4882a593Smuzhiyun 
2638*4882a593Smuzhiyun 	pci_set_drvdata(pci_dev, dev);
2639*4882a593Smuzhiyun 
2640*4882a593Smuzhiyun 	// grab IRQ and install handler - move this someplace more sensible
2641*4882a593Smuzhiyun 	irq = pci_dev->irq;
2642*4882a593Smuzhiyun 	if (request_irq(irq,
2643*4882a593Smuzhiyun 			interrupt_handler,
2644*4882a593Smuzhiyun 			IRQF_SHARED, /* irqflags guess */
2645*4882a593Smuzhiyun 			DEV_LABEL, /* name guess */
2646*4882a593Smuzhiyun 			dev)) {
2647*4882a593Smuzhiyun 		PRINTD(DBG_WARN, "request IRQ failed!");
2648*4882a593Smuzhiyun 		err = -EINVAL;
2649*4882a593Smuzhiyun 		goto out_free;
2650*4882a593Smuzhiyun 	}
2651*4882a593Smuzhiyun 
2652*4882a593Smuzhiyun 	PRINTD(DBG_INFO, "found Madge ATM adapter (hrz) at: IO %x, IRQ %u, MEM %p",
2653*4882a593Smuzhiyun 	       iobase, irq, membase);
2654*4882a593Smuzhiyun 
2655*4882a593Smuzhiyun 	dev->atm_dev = atm_dev_register(DEV_LABEL, &pci_dev->dev, &hrz_ops, -1,
2656*4882a593Smuzhiyun 					NULL);
2657*4882a593Smuzhiyun 	if (!(dev->atm_dev)) {
2658*4882a593Smuzhiyun 		PRINTD(DBG_ERR, "failed to register Madge ATM adapter");
2659*4882a593Smuzhiyun 		err = -EINVAL;
2660*4882a593Smuzhiyun 		goto out_free_irq;
2661*4882a593Smuzhiyun 	}
2662*4882a593Smuzhiyun 
2663*4882a593Smuzhiyun 	PRINTD(DBG_INFO, "registered Madge ATM adapter (no. %d) (%p) at %p",
2664*4882a593Smuzhiyun 	       dev->atm_dev->number, dev, dev->atm_dev);
2665*4882a593Smuzhiyun 	dev->atm_dev->dev_data = (void *) dev;
2666*4882a593Smuzhiyun 	dev->pci_dev = pci_dev;
2667*4882a593Smuzhiyun 
2668*4882a593Smuzhiyun 	// enable bus master accesses
2669*4882a593Smuzhiyun 	pci_set_master(pci_dev);
2670*4882a593Smuzhiyun 
2671*4882a593Smuzhiyun 	// frobnicate latency (upwards, usually)
2672*4882a593Smuzhiyun 	pci_read_config_byte(pci_dev, PCI_LATENCY_TIMER, &lat);
2673*4882a593Smuzhiyun 	if (pci_lat) {
2674*4882a593Smuzhiyun 		PRINTD(DBG_INFO, "%s PCI latency timer from %hu to %hu",
2675*4882a593Smuzhiyun 		       "changing", lat, pci_lat);
2676*4882a593Smuzhiyun 		pci_write_config_byte(pci_dev, PCI_LATENCY_TIMER, pci_lat);
2677*4882a593Smuzhiyun 	} else if (lat < MIN_PCI_LATENCY) {
2678*4882a593Smuzhiyun 		PRINTK(KERN_INFO, "%s PCI latency timer from %hu to %hu",
2679*4882a593Smuzhiyun 		       "increasing", lat, MIN_PCI_LATENCY);
2680*4882a593Smuzhiyun 		pci_write_config_byte(pci_dev, PCI_LATENCY_TIMER, MIN_PCI_LATENCY);
2681*4882a593Smuzhiyun 	}
2682*4882a593Smuzhiyun 
2683*4882a593Smuzhiyun 	dev->iobase = iobase;
2684*4882a593Smuzhiyun 	dev->irq = irq;
2685*4882a593Smuzhiyun 	dev->membase = membase;
2686*4882a593Smuzhiyun 
2687*4882a593Smuzhiyun 	dev->rx_q_entry = dev->rx_q_reset = &memmap->rx_q_entries[0];
2688*4882a593Smuzhiyun 	dev->rx_q_wrap  = &memmap->rx_q_entries[RX_CHANS-1];
2689*4882a593Smuzhiyun 
2690*4882a593Smuzhiyun 	// these next three are performance hacks
2691*4882a593Smuzhiyun 	dev->last_vc = -1;
2692*4882a593Smuzhiyun 	dev->tx_last = -1;
2693*4882a593Smuzhiyun 	dev->tx_idle = 0;
2694*4882a593Smuzhiyun 
2695*4882a593Smuzhiyun 	dev->tx_regions = 0;
2696*4882a593Smuzhiyun 	dev->tx_bytes = 0;
2697*4882a593Smuzhiyun 	dev->tx_skb = NULL;
2698*4882a593Smuzhiyun 	dev->tx_iovec = NULL;
2699*4882a593Smuzhiyun 
2700*4882a593Smuzhiyun 	dev->tx_cell_count = 0;
2701*4882a593Smuzhiyun 	dev->rx_cell_count = 0;
2702*4882a593Smuzhiyun 	dev->hec_error_count = 0;
2703*4882a593Smuzhiyun 	dev->unassigned_cell_count = 0;
2704*4882a593Smuzhiyun 
2705*4882a593Smuzhiyun 	dev->noof_spare_buffers = 0;
2706*4882a593Smuzhiyun 
2707*4882a593Smuzhiyun 	{
2708*4882a593Smuzhiyun 		unsigned int i;
2709*4882a593Smuzhiyun 		for (i = 0; i < TX_CHANS; ++i)
2710*4882a593Smuzhiyun 			dev->tx_channel_record[i] = -1;
2711*4882a593Smuzhiyun 	}
2712*4882a593Smuzhiyun 
2713*4882a593Smuzhiyun 	dev->flags = 0;
2714*4882a593Smuzhiyun 
2715*4882a593Smuzhiyun 	// Allocate cell rates and remember ASIC version
2716*4882a593Smuzhiyun 	// Fibre: ATM_OC3_PCR = 1555200000/8/270*260/53 - 29/53
2717*4882a593Smuzhiyun 	// Copper: (WRONG) we want 6 into the above, close to 25Mb/s
2718*4882a593Smuzhiyun 	// Copper: (plagarise!) 25600000/8/270*260/53 - n/53
2719*4882a593Smuzhiyun 
2720*4882a593Smuzhiyun 	if (hrz_init(dev)) {
2721*4882a593Smuzhiyun 		// to be really pedantic, this should be ATM_OC3c_PCR
2722*4882a593Smuzhiyun 		dev->tx_avail = ATM_OC3_PCR;
2723*4882a593Smuzhiyun 		dev->rx_avail = ATM_OC3_PCR;
2724*4882a593Smuzhiyun 		set_bit(ultra, &dev->flags); // NOT "|= ultra" !
2725*4882a593Smuzhiyun 	} else {
2726*4882a593Smuzhiyun 		dev->tx_avail = ((25600000/8)*26)/(27*53);
2727*4882a593Smuzhiyun 		dev->rx_avail = ((25600000/8)*26)/(27*53);
2728*4882a593Smuzhiyun 		PRINTD(DBG_WARN, "Buggy ASIC: no TX bus-mastering.");
2729*4882a593Smuzhiyun 	}
2730*4882a593Smuzhiyun 
2731*4882a593Smuzhiyun 	// rate changes spinlock
2732*4882a593Smuzhiyun 	spin_lock_init(&dev->rate_lock);
2733*4882a593Smuzhiyun 
2734*4882a593Smuzhiyun 	// on-board memory access spinlock; we want atomic reads and
2735*4882a593Smuzhiyun 	// writes to adapter memory (handles IRQ and SMP)
2736*4882a593Smuzhiyun 	spin_lock_init(&dev->mem_lock);
2737*4882a593Smuzhiyun 
2738*4882a593Smuzhiyun 	init_waitqueue_head(&dev->tx_queue);
2739*4882a593Smuzhiyun 
2740*4882a593Smuzhiyun 	// vpi in 0..4, vci in 6..10
2741*4882a593Smuzhiyun 	dev->atm_dev->ci_range.vpi_bits = vpi_bits;
2742*4882a593Smuzhiyun 	dev->atm_dev->ci_range.vci_bits = 10-vpi_bits;
2743*4882a593Smuzhiyun 
2744*4882a593Smuzhiyun 	timer_setup(&dev->housekeeping, do_housekeeping, 0);
2745*4882a593Smuzhiyun 	mod_timer(&dev->housekeeping, jiffies);
2746*4882a593Smuzhiyun 
2747*4882a593Smuzhiyun out:
2748*4882a593Smuzhiyun 	return err;
2749*4882a593Smuzhiyun 
2750*4882a593Smuzhiyun out_free_irq:
2751*4882a593Smuzhiyun 	free_irq(irq, dev);
2752*4882a593Smuzhiyun out_free:
2753*4882a593Smuzhiyun 	kfree(dev);
2754*4882a593Smuzhiyun out_release:
2755*4882a593Smuzhiyun 	release_region(iobase, HRZ_IO_EXTENT);
2756*4882a593Smuzhiyun out_disable:
2757*4882a593Smuzhiyun 	pci_disable_device(pci_dev);
2758*4882a593Smuzhiyun 	goto out;
2759*4882a593Smuzhiyun }
2760*4882a593Smuzhiyun 
hrz_remove_one(struct pci_dev * pci_dev)2761*4882a593Smuzhiyun static void hrz_remove_one(struct pci_dev *pci_dev)
2762*4882a593Smuzhiyun {
2763*4882a593Smuzhiyun 	hrz_dev *dev;
2764*4882a593Smuzhiyun 
2765*4882a593Smuzhiyun 	dev = pci_get_drvdata(pci_dev);
2766*4882a593Smuzhiyun 
2767*4882a593Smuzhiyun 	PRINTD(DBG_INFO, "closing %p (atm_dev = %p)", dev, dev->atm_dev);
2768*4882a593Smuzhiyun 	del_timer_sync(&dev->housekeeping);
2769*4882a593Smuzhiyun 	hrz_reset(dev);
2770*4882a593Smuzhiyun 	atm_dev_deregister(dev->atm_dev);
2771*4882a593Smuzhiyun 	free_irq(dev->irq, dev);
2772*4882a593Smuzhiyun 	release_region(dev->iobase, HRZ_IO_EXTENT);
2773*4882a593Smuzhiyun 	kfree(dev);
2774*4882a593Smuzhiyun 
2775*4882a593Smuzhiyun 	pci_disable_device(pci_dev);
2776*4882a593Smuzhiyun }
2777*4882a593Smuzhiyun 
hrz_check_args(void)2778*4882a593Smuzhiyun static void __init hrz_check_args (void) {
2779*4882a593Smuzhiyun #ifdef DEBUG_HORIZON
2780*4882a593Smuzhiyun   PRINTK (KERN_NOTICE, "debug bitmap is %hx", debug &= DBG_MASK);
2781*4882a593Smuzhiyun #else
2782*4882a593Smuzhiyun   if (debug)
2783*4882a593Smuzhiyun     PRINTK (KERN_NOTICE, "no debug support in this image");
2784*4882a593Smuzhiyun #endif
2785*4882a593Smuzhiyun 
2786*4882a593Smuzhiyun   if (vpi_bits > HRZ_MAX_VPI)
2787*4882a593Smuzhiyun     PRINTK (KERN_ERR, "vpi_bits has been limited to %hu",
2788*4882a593Smuzhiyun 	    vpi_bits = HRZ_MAX_VPI);
2789*4882a593Smuzhiyun 
2790*4882a593Smuzhiyun   if (max_tx_size < 0 || max_tx_size > TX_AAL5_LIMIT)
2791*4882a593Smuzhiyun     PRINTK (KERN_NOTICE, "max_tx_size has been limited to %hu",
2792*4882a593Smuzhiyun 	    max_tx_size = TX_AAL5_LIMIT);
2793*4882a593Smuzhiyun 
2794*4882a593Smuzhiyun   if (max_rx_size < 0 || max_rx_size > RX_AAL5_LIMIT)
2795*4882a593Smuzhiyun     PRINTK (KERN_NOTICE, "max_rx_size has been limited to %hu",
2796*4882a593Smuzhiyun 	    max_rx_size = RX_AAL5_LIMIT);
2797*4882a593Smuzhiyun 
2798*4882a593Smuzhiyun   return;
2799*4882a593Smuzhiyun }
2800*4882a593Smuzhiyun 
2801*4882a593Smuzhiyun MODULE_AUTHOR(maintainer_string);
2802*4882a593Smuzhiyun MODULE_DESCRIPTION(description_string);
2803*4882a593Smuzhiyun MODULE_LICENSE("GPL");
2804*4882a593Smuzhiyun module_param(debug, ushort, 0644);
2805*4882a593Smuzhiyun module_param(vpi_bits, ushort, 0);
2806*4882a593Smuzhiyun module_param(max_tx_size, int, 0);
2807*4882a593Smuzhiyun module_param(max_rx_size, int, 0);
2808*4882a593Smuzhiyun module_param(pci_lat, byte, 0);
2809*4882a593Smuzhiyun MODULE_PARM_DESC(debug, "debug bitmap, see .h file");
2810*4882a593Smuzhiyun MODULE_PARM_DESC(vpi_bits, "number of bits (0..4) to allocate to VPIs");
2811*4882a593Smuzhiyun MODULE_PARM_DESC(max_tx_size, "maximum size of TX AAL5 frames");
2812*4882a593Smuzhiyun MODULE_PARM_DESC(max_rx_size, "maximum size of RX AAL5 frames");
2813*4882a593Smuzhiyun MODULE_PARM_DESC(pci_lat, "PCI latency in bus cycles");
2814*4882a593Smuzhiyun 
2815*4882a593Smuzhiyun static const struct pci_device_id hrz_pci_tbl[] = {
2816*4882a593Smuzhiyun 	{ PCI_VENDOR_ID_MADGE, PCI_DEVICE_ID_MADGE_HORIZON, PCI_ANY_ID, PCI_ANY_ID,
2817*4882a593Smuzhiyun 	  0, 0, 0 },
2818*4882a593Smuzhiyun 	{ 0, }
2819*4882a593Smuzhiyun };
2820*4882a593Smuzhiyun 
2821*4882a593Smuzhiyun MODULE_DEVICE_TABLE(pci, hrz_pci_tbl);
2822*4882a593Smuzhiyun 
2823*4882a593Smuzhiyun static struct pci_driver hrz_driver = {
2824*4882a593Smuzhiyun 	.name =		"horizon",
2825*4882a593Smuzhiyun 	.probe =	hrz_probe,
2826*4882a593Smuzhiyun 	.remove =	hrz_remove_one,
2827*4882a593Smuzhiyun 	.id_table =	hrz_pci_tbl,
2828*4882a593Smuzhiyun };
2829*4882a593Smuzhiyun 
2830*4882a593Smuzhiyun /********** module entry **********/
2831*4882a593Smuzhiyun 
hrz_module_init(void)2832*4882a593Smuzhiyun static int __init hrz_module_init (void) {
2833*4882a593Smuzhiyun   BUILD_BUG_ON(sizeof(struct MEMMAP) != 128*1024/4);
2834*4882a593Smuzhiyun 
2835*4882a593Smuzhiyun   show_version();
2836*4882a593Smuzhiyun 
2837*4882a593Smuzhiyun   // check arguments
2838*4882a593Smuzhiyun   hrz_check_args();
2839*4882a593Smuzhiyun 
2840*4882a593Smuzhiyun   // get the juice
2841*4882a593Smuzhiyun   return pci_register_driver(&hrz_driver);
2842*4882a593Smuzhiyun }
2843*4882a593Smuzhiyun 
2844*4882a593Smuzhiyun /********** module exit **********/
2845*4882a593Smuzhiyun 
hrz_module_exit(void)2846*4882a593Smuzhiyun static void __exit hrz_module_exit (void) {
2847*4882a593Smuzhiyun   PRINTD (DBG_FLOW, "cleanup_module");
2848*4882a593Smuzhiyun 
2849*4882a593Smuzhiyun   pci_unregister_driver(&hrz_driver);
2850*4882a593Smuzhiyun }
2851*4882a593Smuzhiyun 
2852*4882a593Smuzhiyun module_init(hrz_module_init);
2853*4882a593Smuzhiyun module_exit(hrz_module_exit);
2854