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