qlge: bugfix: Fix endian issue when reading flash.
[linux-2.6] / drivers / net / hamradio / scc.c
1 #define RCS_ID "$Id: scc.c,v 1.75 1998/11/04 15:15:01 jreuter Exp jreuter $"
2
3 #define VERSION "3.0"
4
5 /*
6  * Please use z8530drv-utils-3.0 with this version.
7  *            ------------------
8  *
9  * You can find a subset of the documentation in 
10  * Documentation/networking/z8530drv.txt.
11  */
12
13 /*
14    ********************************************************************
15    *   SCC.C - Linux driver for Z8530 based HDLC cards for AX.25      *
16    ********************************************************************
17
18
19    ********************************************************************
20
21         Copyright (c) 1993, 2000 Joerg Reuter DL1BKE
22
23         portions (c) 1993 Guido ten Dolle PE1NNZ
24
25    ********************************************************************
26    
27    The driver and the programs in the archive are UNDER CONSTRUCTION.
28    The code is likely to fail, and so your kernel could --- even 
29    a whole network. 
30
31    This driver is intended for Amateur Radio use. If you are running it
32    for commercial purposes, please drop me a note. I am nosy...
33
34    ...BUT:
35  
36    ! You  m u s t  recognize the appropriate legislations of your country !
37    ! before you connect a radio to the SCC board and start to transmit or !
38    ! receive. The GPL allows you to use the  d r i v e r,  NOT the RADIO! !
39
40    For non-Amateur-Radio use please note that you might need a special
41    allowance/licence from the designer of the SCC Board and/or the
42    MODEM. 
43
44    This program is free software; you can redistribute it and/or modify 
45    it under the terms of the (modified) GNU General Public License 
46    delivered with the Linux kernel source.
47    
48    This program is distributed in the hope that it will be useful,
49    but WITHOUT ANY WARRANTY; without even the implied warranty of
50    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
51    GNU General Public License for more details.
52
53    You should find a copy of the GNU General Public License in 
54    /usr/src/linux/COPYING; 
55    
56    ******************************************************************** 
57
58                 
59    Incomplete history of z8530drv:
60    -------------------------------
61
62    1994-09-13   started to write the driver, rescued most of my own
63                 code (and Hans Alblas' memory buffer pool concept) from 
64                 an earlier project "sccdrv" which was initiated by 
65                 Guido ten Dolle. Not much of the old driver survived, 
66                 though. The first version I put my hands on was sccdrv1.3
67                 from August 1993. The memory buffer pool concept
68                 appeared in an unauthorized sccdrv version (1.5) from
69                 August 1994.
70
71    1995-01-31   changed copyright notice to GPL without limitations.
72    
73      .
74      .  <SNIP>
75      .
76                   
77    1996-10-05   New semester, new driver... 
78
79                   * KISS TNC emulator removed (TTY driver)
80                   * Source moved to drivers/net/
81                   * Includes Z8530 defines from drivers/net/z8530.h
82                   * Uses sk_buffer memory management
83                   * Reduced overhead of /proc/net/z8530drv output
84                   * Streamlined quite a lot things
85                   * Invents brand new bugs... ;-)
86
87                   The move to version number 3.0 reflects theses changes.
88                   You can use 'kissbridge' if you need a KISS TNC emulator.
89
90    1996-12-13   Fixed for Linux networking changes. (G4KLX)
91    1997-01-08   Fixed the remaining problems.
92    1997-04-02   Hopefully fixed the problems with the new *_timer()
93                 routines, added calibration code.
94    1997-10-12   Made SCC_DELAY a CONFIG option, added CONFIG_SCC_TRXECHO
95    1998-01-29   Small fix to avoid lock-up on initialization
96    1998-09-29   Fixed the "grouping" bugs, tx_inhibit works again,
97                 using dev->tx_queue_len now instead of MAXQUEUE now.
98    1998-10-21   Postponed the spinlock changes, would need a lot of
99                 testing I currently don't have the time to. Softdcd doesn't
100                 work.
101    1998-11-04   Softdcd does not work correctly in DPLL mode, in fact it 
102                 never did. The DPLL locks on noise, the SYNC unit sees
103                 flags that aren't... Restarting the DPLL does not help
104                 either, it resynchronizes too slow and the first received
105                 frame gets lost.
106    2000-02-13   Fixed for new network driver interface changes, still
107                 does TX timeouts itself since it uses its own queue
108                 scheme.
109
110    Thanks to all who contributed to this driver with ideas and bug
111    reports!
112    
113    NB -- if you find errors, change something, please let me know
114          first before you distribute it... And please don't touch
115          the version number. Just replace my callsign in
116          "v3.0.dl1bke" with your own. Just to avoid confusion...
117
118    If you want to add your modification to the linux distribution
119    please (!) contact me first.
120    
121    New versions of the driver will be announced on the linux-hams
122    mailing list on vger.kernel.org. To subscribe send an e-mail
123    to majordomo@vger.kernel.org with the following line in
124    the body of the mail:
125    
126            subscribe linux-hams
127            
128    The content of the "Subject" field will be ignored.
129
130    vy 73,
131    Joerg Reuter ampr-net: dl1bke@db0pra.ampr.org
132                 AX-25   : DL1BKE @ DB0ABH.#BAY.DEU.EU
133                 Internet: jreuter@yaina.de
134                 www     : http://yaina.de/jreuter
135 */
136
137 /* ----------------------------------------------------------------------- */
138
139 #undef  SCC_LDELAY              /* slow it even a bit more down */
140 #undef  SCC_DONT_CHECK          /* don't look if the SCCs you specified are available */
141
142 #define SCC_MAXCHIPS    4       /* number of max. supported chips */
143 #define SCC_BUFSIZE     384     /* must not exceed 4096 */
144 #undef  SCC_DEBUG
145
146 #define SCC_DEFAULT_CLOCK       4915200 
147                                 /* default pclock if nothing is specified */
148
149 /* ----------------------------------------------------------------------- */
150
151 #include <linux/module.h>
152 #include <linux/errno.h>
153 #include <linux/signal.h>
154 #include <linux/timer.h>
155 #include <linux/interrupt.h>
156 #include <linux/ioport.h>
157 #include <linux/string.h>
158 #include <linux/in.h>
159 #include <linux/fcntl.h>
160 #include <linux/ptrace.h>
161 #include <linux/slab.h>
162 #include <linux/delay.h>
163 #include <linux/skbuff.h>
164 #include <linux/netdevice.h>
165 #include <linux/rtnetlink.h>
166 #include <linux/if_ether.h>
167 #include <linux/if_arp.h>
168 #include <linux/socket.h>
169 #include <linux/init.h>
170 #include <linux/scc.h>
171 #include <linux/ctype.h>
172 #include <linux/kernel.h>
173 #include <linux/proc_fs.h>
174 #include <linux/seq_file.h>
175 #include <linux/bitops.h>
176
177 #include <net/net_namespace.h>
178 #include <net/ax25.h>
179
180 #include <asm/irq.h>
181 #include <asm/system.h>
182 #include <asm/io.h>
183 #include <asm/uaccess.h>
184
185 #include "z8530.h"
186
187 static char banner[] __initdata = KERN_INFO "AX.25: Z8530 SCC driver version "VERSION".dl1bke\n";
188
189 static void t_dwait(unsigned long);
190 static void t_txdelay(unsigned long);
191 static void t_tail(unsigned long);
192 static void t_busy(unsigned long);
193 static void t_maxkeyup(unsigned long);
194 static void t_idle(unsigned long);
195 static void scc_tx_done(struct scc_channel *);
196 static void scc_start_tx_timer(struct scc_channel *, void (*)(unsigned long), unsigned long);
197 static void scc_start_maxkeyup(struct scc_channel *);
198 static void scc_start_defer(struct scc_channel *);
199
200 static void z8530_init(void);
201
202 static void init_channel(struct scc_channel *scc);
203 static void scc_key_trx (struct scc_channel *scc, char tx);
204 static void scc_init_timer(struct scc_channel *scc);
205
206 static int scc_net_alloc(const char *name, struct scc_channel *scc);
207 static void scc_net_setup(struct net_device *dev);
208 static int scc_net_open(struct net_device *dev);
209 static int scc_net_close(struct net_device *dev);
210 static void scc_net_rx(struct scc_channel *scc, struct sk_buff *skb);
211 static int scc_net_tx(struct sk_buff *skb, struct net_device *dev);
212 static int scc_net_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd);
213 static int scc_net_set_mac_address(struct net_device *dev, void *addr);
214 static struct net_device_stats * scc_net_get_stats(struct net_device *dev);
215
216 static unsigned char SCC_DriverName[] = "scc";
217
218 static struct irqflags { unsigned char used : 1; } Ivec[NR_IRQS];
219         
220 static struct scc_channel SCC_Info[2 * SCC_MAXCHIPS];   /* information per channel */
221
222 static struct scc_ctrl {
223         io_port chan_A;
224         io_port chan_B;
225         int irq;
226 } SCC_ctrl[SCC_MAXCHIPS+1];
227
228 static unsigned char Driver_Initialized;
229 static int Nchips;
230 static io_port Vector_Latch;
231
232
233 /* ******************************************************************** */
234 /* *                    Port Access Functions                         * */
235 /* ******************************************************************** */
236
237 /* These provide interrupt save 2-step access to the Z8530 registers */
238
239 static DEFINE_SPINLOCK(iolock); /* Guards paired accesses */
240
241 static inline unsigned char InReg(io_port port, unsigned char reg)
242 {
243         unsigned long flags;
244         unsigned char r;
245
246         spin_lock_irqsave(&iolock, flags);      
247 #ifdef SCC_LDELAY
248         Outb(port, reg);
249         udelay(SCC_LDELAY);
250         r=Inb(port);
251         udelay(SCC_LDELAY);
252 #else
253         Outb(port, reg);
254         r=Inb(port);
255 #endif
256         spin_unlock_irqrestore(&iolock, flags);
257         return r;
258 }
259
260 static inline void OutReg(io_port port, unsigned char reg, unsigned char val)
261 {
262         unsigned long flags;
263
264         spin_lock_irqsave(&iolock, flags);
265 #ifdef SCC_LDELAY
266         Outb(port, reg); udelay(SCC_LDELAY);
267         Outb(port, val); udelay(SCC_LDELAY);
268 #else
269         Outb(port, reg);
270         Outb(port, val);
271 #endif
272         spin_unlock_irqrestore(&iolock, flags);
273 }
274
275 static inline void wr(struct scc_channel *scc, unsigned char reg,
276         unsigned char val)
277 {
278         OutReg(scc->ctrl, reg, (scc->wreg[reg] = val));
279 }
280
281 static inline void or(struct scc_channel *scc, unsigned char reg, unsigned char val)
282 {
283         OutReg(scc->ctrl, reg, (scc->wreg[reg] |= val));
284 }
285
286 static inline void cl(struct scc_channel *scc, unsigned char reg, unsigned char val)
287 {
288         OutReg(scc->ctrl, reg, (scc->wreg[reg] &= ~val));
289 }
290
291 /* ******************************************************************** */
292 /* *                    Some useful macros                            * */
293 /* ******************************************************************** */
294
295 static inline void scc_discard_buffers(struct scc_channel *scc)
296 {
297         unsigned long flags;
298         
299         spin_lock_irqsave(&scc->lock, flags);   
300         if (scc->tx_buff != NULL)
301         {
302                 dev_kfree_skb(scc->tx_buff);
303                 scc->tx_buff = NULL;
304         }
305         
306         while (!skb_queue_empty(&scc->tx_queue))
307                 dev_kfree_skb(skb_dequeue(&scc->tx_queue));
308
309         spin_unlock_irqrestore(&scc->lock, flags);
310 }
311
312
313
314 /* ******************************************************************** */
315 /* *                    Interrupt Service Routines                    * */
316 /* ******************************************************************** */
317
318
319 /* ----> subroutines for the interrupt handlers <---- */
320
321 static inline void scc_notify(struct scc_channel *scc, int event)
322 {
323         struct sk_buff *skb;
324         char *bp;
325         
326         if (scc->kiss.fulldup != KISS_DUPLEX_OPTIMA)
327                 return;
328
329         skb = dev_alloc_skb(2);
330         if (skb != NULL)
331         {
332                 bp = skb_put(skb, 2);
333                 *bp++ = PARAM_HWEVENT;
334                 *bp++ = event;
335                 scc_net_rx(scc, skb);
336         } else
337                 scc->stat.nospace++;
338 }
339
340 static inline void flush_rx_FIFO(struct scc_channel *scc)
341 {
342         int k;
343         
344         for (k=0; k<3; k++)
345                 Inb(scc->data);
346                 
347         if(scc->rx_buff != NULL)                /* did we receive something? */
348         {
349                 scc->stat.rxerrs++;  /* then count it as an error */
350                 dev_kfree_skb_irq(scc->rx_buff);
351                 scc->rx_buff = NULL;
352         }
353 }
354
355 static void start_hunt(struct scc_channel *scc)
356 {
357         if ((scc->modem.clocksrc != CLK_EXTERNAL))
358                 OutReg(scc->ctrl,R14,SEARCH|scc->wreg[R14]); /* DPLL: enter search mode */
359         or(scc,R3,ENT_HM|RxENABLE);  /* enable the receiver, hunt mode */
360 }
361
362 /* ----> four different interrupt handlers for Tx, Rx, changing of      */
363 /*       DCD/CTS and Rx/Tx errors                                       */
364
365 /* Transmitter interrupt handler */
366 static inline void scc_txint(struct scc_channel *scc)
367 {
368         struct sk_buff *skb;
369
370         scc->stat.txints++;
371         skb = scc->tx_buff;
372         
373         /* send first octet */
374         
375         if (skb == NULL)
376         {
377                 skb = skb_dequeue(&scc->tx_queue);
378                 scc->tx_buff = skb;
379                 netif_wake_queue(scc->dev);
380
381                 if (skb == NULL)
382                 {
383                         scc_tx_done(scc);
384                         Outb(scc->ctrl, RES_Tx_P);
385                         return;
386                 }
387                 
388                 if (skb->len == 0)              /* Paranoia... */
389                 {
390                         dev_kfree_skb_irq(skb);
391                         scc->tx_buff = NULL;
392                         scc_tx_done(scc);
393                         Outb(scc->ctrl, RES_Tx_P);
394                         return;
395                 }
396
397                 scc->stat.tx_state = TXS_ACTIVE;
398
399                 OutReg(scc->ctrl, R0, RES_Tx_CRC);
400                                                 /* reset CRC generator */
401                 or(scc,R10,ABUNDER);            /* re-install underrun protection */
402                 Outb(scc->data,*skb->data);     /* send byte */
403                 skb_pull(skb, 1);
404
405                 if (!scc->enhanced)             /* reset EOM latch */
406                         Outb(scc->ctrl,RES_EOM_L);
407                 return;
408         }
409         
410         /* End Of Frame... */
411         
412         if (skb->len == 0)
413         {
414                 Outb(scc->ctrl, RES_Tx_P);      /* reset pending int */
415                 cl(scc, R10, ABUNDER);          /* send CRC */
416                 dev_kfree_skb_irq(skb);
417                 scc->tx_buff = NULL;
418                 scc->stat.tx_state = TXS_NEWFRAME; /* next frame... */
419                 return;
420         } 
421         
422         /* send octet */
423         
424         Outb(scc->data,*skb->data);             
425         skb_pull(skb, 1);
426 }
427
428
429 /* External/Status interrupt handler */
430 static inline void scc_exint(struct scc_channel *scc)
431 {
432         unsigned char status,changes,chg_and_stat;
433
434         scc->stat.exints++;
435
436         status = InReg(scc->ctrl,R0);
437         changes = status ^ scc->status;
438         chg_and_stat = changes & status;
439         
440         /* ABORT: generated whenever DCD drops while receiving */
441
442         if (chg_and_stat & BRK_ABRT)            /* Received an ABORT */
443                 flush_rx_FIFO(scc);
444
445         /* HUNT: software DCD; on = waiting for SYNC, off = receiving frame */
446
447         if ((changes & SYNC_HUNT) && scc->kiss.softdcd)
448         {
449                 if (status & SYNC_HUNT)
450                 {
451                         scc->dcd = 0;
452                         flush_rx_FIFO(scc);
453                         if ((scc->modem.clocksrc != CLK_EXTERNAL))
454                                 OutReg(scc->ctrl,R14,SEARCH|scc->wreg[R14]); /* DPLL: enter search mode */
455                 } else {
456                         scc->dcd = 1;
457                 }
458
459                 scc_notify(scc, scc->dcd? HWEV_DCD_OFF:HWEV_DCD_ON);
460         }
461
462         /* DCD: on = start to receive packet, off = ABORT condition */
463         /* (a successfully received packet generates a special condition int) */
464         
465         if((changes & DCD) && !scc->kiss.softdcd) /* DCD input changed state */
466         {
467                 if(status & DCD)                /* DCD is now ON */
468                 {
469                         start_hunt(scc);
470                         scc->dcd = 1;
471                 } else {                        /* DCD is now OFF */
472                         cl(scc,R3,ENT_HM|RxENABLE); /* disable the receiver */
473                         flush_rx_FIFO(scc);
474                         scc->dcd = 0;
475                 }
476                 
477                 scc_notify(scc, scc->dcd? HWEV_DCD_ON:HWEV_DCD_OFF);
478         }
479
480 #ifdef notdef
481         /* CTS: use external TxDelay (what's that good for?!)
482          * Anyway: If we _could_ use it (BayCom USCC uses CTS for
483          * own purposes) we _should_ use the "autoenable" feature
484          * of the Z8530 and not this interrupt...
485          */
486          
487         if (chg_and_stat & CTS)                 /* CTS is now ON */
488         {
489                 if (scc->kiss.txdelay == 0)     /* zero TXDELAY = wait for CTS */
490                         scc_start_tx_timer(scc, t_txdelay, 0);
491         }
492 #endif
493         
494         if (scc->stat.tx_state == TXS_ACTIVE && (status & TxEOM))
495         {
496                 scc->stat.tx_under++;     /* oops, an underrun! count 'em */
497                 Outb(scc->ctrl, RES_EXT_INT);   /* reset ext/status interrupts */
498
499                 if (scc->tx_buff != NULL)
500                 {
501                         dev_kfree_skb_irq(scc->tx_buff);
502                         scc->tx_buff = NULL;
503                 }
504                 
505                 or(scc,R10,ABUNDER);
506                 scc_start_tx_timer(scc, t_txdelay, 0);  /* restart transmission */
507         }
508                 
509         scc->status = status;
510         Outb(scc->ctrl,RES_EXT_INT);
511 }
512
513
514 /* Receiver interrupt handler */
515 static inline void scc_rxint(struct scc_channel *scc)
516 {
517         struct sk_buff *skb;
518
519         scc->stat.rxints++;
520
521         if((scc->wreg[5] & RTS) && scc->kiss.fulldup == KISS_DUPLEX_HALF)
522         {
523                 Inb(scc->data);         /* discard char */
524                 or(scc,R3,ENT_HM);      /* enter hunt mode for next flag */
525                 return;
526         }
527
528         skb = scc->rx_buff;
529         
530         if (skb == NULL)
531         {
532                 skb = dev_alloc_skb(scc->stat.bufsize);
533                 if (skb == NULL)
534                 {
535                         scc->dev_stat.rx_dropped++;
536                         scc->stat.nospace++;
537                         Inb(scc->data);
538                         or(scc, R3, ENT_HM);
539                         return;
540                 }
541                 
542                 scc->rx_buff = skb;
543                 *(skb_put(skb, 1)) = 0; /* KISS data */
544         }
545         
546         if (skb->len >= scc->stat.bufsize)
547         {
548 #ifdef notdef
549                 printk(KERN_DEBUG "z8530drv: oops, scc_rxint() received huge frame...\n");
550 #endif
551                 dev_kfree_skb_irq(skb);
552                 scc->rx_buff = NULL;
553                 Inb(scc->data);
554                 or(scc, R3, ENT_HM);
555                 return;
556         }
557
558         *(skb_put(skb, 1)) = Inb(scc->data);
559 }
560
561
562 /* Receive Special Condition interrupt handler */
563 static inline void scc_spint(struct scc_channel *scc)
564 {
565         unsigned char status;
566         struct sk_buff *skb;
567
568         scc->stat.spints++;
569
570         status = InReg(scc->ctrl,R1);           /* read receiver status */
571         
572         Inb(scc->data);                         /* throw away Rx byte */
573         skb = scc->rx_buff;
574
575         if(status & Rx_OVR)                     /* receiver overrun */
576         {
577                 scc->stat.rx_over++;             /* count them */
578                 or(scc,R3,ENT_HM);               /* enter hunt mode for next flag */
579                 
580                 if (skb != NULL) 
581                         dev_kfree_skb_irq(skb);
582                 scc->rx_buff = skb = NULL;
583         }
584
585         if(status & END_FR && skb != NULL)      /* end of frame */
586         {
587                 /* CRC okay, frame ends on 8 bit boundary and received something ? */
588                 
589                 if (!(status & CRC_ERR) && (status & 0xe) == RES8 && skb->len > 0)
590                 {
591                         /* ignore last received byte (first of the CRC bytes) */
592                         skb_trim(skb, skb->len-1);
593                         scc_net_rx(scc, skb);
594                         scc->rx_buff = NULL;
595                         scc->stat.rxframes++;
596                 } else {                                /* a bad frame */
597                         dev_kfree_skb_irq(skb);
598                         scc->rx_buff = NULL;
599                         scc->stat.rxerrs++;
600                 }
601         } 
602
603         Outb(scc->ctrl,ERR_RES);
604 }
605
606
607 /* ----> interrupt service routine for the Z8530 <---- */
608
609 static void scc_isr_dispatch(struct scc_channel *scc, int vector)
610 {
611         spin_lock(&scc->lock);
612         switch (vector & VECTOR_MASK)
613         {
614                 case TXINT: scc_txint(scc); break;
615                 case EXINT: scc_exint(scc); break;
616                 case RXINT: scc_rxint(scc); break;
617                 case SPINT: scc_spint(scc); break;
618         }
619         spin_unlock(&scc->lock);
620 }
621
622 /* If the card has a latch for the interrupt vector (like the PA0HZP card)
623    use it to get the number of the chip that generated the int.
624    If not: poll all defined chips.
625  */
626
627 #define SCC_IRQTIMEOUT 30000
628
629 static irqreturn_t scc_isr(int irq, void *dev_id)
630 {
631         int chip_irq = (long) dev_id;
632         unsigned char vector;   
633         struct scc_channel *scc;
634         struct scc_ctrl *ctrl;
635         int k;
636         
637         if (Vector_Latch)
638         {
639                 for(k=0; k < SCC_IRQTIMEOUT; k++)
640                 {
641                         Outb(Vector_Latch, 0);      /* Generate INTACK */
642         
643                         /* Read the vector */
644                         if((vector=Inb(Vector_Latch)) >= 16 * Nchips) break; 
645                         if (vector & 0x01) break;
646                  
647                         scc=&SCC_Info[vector >> 3 ^ 0x01];
648                         if (!scc->dev) break;
649
650                         scc_isr_dispatch(scc, vector);
651
652                         OutReg(scc->ctrl,R0,RES_H_IUS);              /* Reset Highest IUS */
653                 }  
654
655                 if (k == SCC_IRQTIMEOUT)
656                         printk(KERN_WARNING "z8530drv: endless loop in scc_isr()?\n");
657
658                 return IRQ_HANDLED;
659         }
660
661         /* Find the SCC generating the interrupt by polling all attached SCCs
662          * reading RR3A (the interrupt pending register)
663          */
664
665         ctrl = SCC_ctrl;
666         while (ctrl->chan_A)
667         {
668                 if (ctrl->irq != chip_irq)
669                 {
670                         ctrl++;
671                         continue;
672                 }
673
674                 scc = NULL;
675                 for (k = 0; InReg(ctrl->chan_A,R3) && k < SCC_IRQTIMEOUT; k++)
676                 {
677                         vector=InReg(ctrl->chan_B,R2);  /* Read the vector */
678                         if (vector & 0x01) break; 
679
680                         scc = &SCC_Info[vector >> 3 ^ 0x01];
681                         if (!scc->dev) break;
682
683                         scc_isr_dispatch(scc, vector);
684                 }
685
686                 if (k == SCC_IRQTIMEOUT)
687                 {
688                         printk(KERN_WARNING "z8530drv: endless loop in scc_isr()?!\n");
689                         break;
690                 }
691
692                 /* This looks weird and it is. At least the BayCom USCC doesn't
693                  * use the Interrupt Daisy Chain, thus we'll have to start
694                  * all over again to be sure not to miss an interrupt from 
695                  * (any of) the other chip(s)...
696                  * Honestly, the situation *is* braindamaged...
697                  */
698
699                 if (scc != NULL)
700                 {
701                         OutReg(scc->ctrl,R0,RES_H_IUS);
702                         ctrl = SCC_ctrl; 
703                 } else
704                         ctrl++;
705         }
706         return IRQ_HANDLED;
707 }
708
709
710
711 /* ******************************************************************** */
712 /* *                    Init Channel                                    */
713 /* ******************************************************************** */
714
715
716 /* ----> set SCC channel speed <---- */
717
718 static inline void set_brg(struct scc_channel *scc, unsigned int tc)
719 {
720         cl(scc,R14,BRENABL);            /* disable baudrate generator */
721         wr(scc,R12,tc & 255);           /* brg rate LOW */
722         wr(scc,R13,tc >> 8);            /* brg rate HIGH */
723         or(scc,R14,BRENABL);            /* enable baudrate generator */
724 }
725
726 static inline void set_speed(struct scc_channel *scc)
727 {
728         unsigned long flags;
729         spin_lock_irqsave(&scc->lock, flags);
730
731         if (scc->modem.speed > 0)       /* paranoia... */
732                 set_brg(scc, (unsigned) (scc->clock / (scc->modem.speed * 64)) - 2);
733                 
734         spin_unlock_irqrestore(&scc->lock, flags);
735 }
736
737
738 /* ----> initialize a SCC channel <---- */
739
740 static inline void init_brg(struct scc_channel *scc)
741 {
742         wr(scc, R14, BRSRC);                            /* BRG source = PCLK */
743         OutReg(scc->ctrl, R14, SSBR|scc->wreg[R14]);    /* DPLL source = BRG */
744         OutReg(scc->ctrl, R14, SNRZI|scc->wreg[R14]);   /* DPLL NRZI mode */
745 }
746
747 /*
748  * Initialization according to the Z8530 manual (SGS-Thomson's version):
749  *
750  * 1. Modes and constants
751  *
752  * WR9  11000000        chip reset
753  * WR4  XXXXXXXX        Tx/Rx control, async or sync mode
754  * WR1  0XX00X00        select W/REQ (optional)
755  * WR2  XXXXXXXX        program interrupt vector
756  * WR3  XXXXXXX0        select Rx control
757  * WR5  XXXX0XXX        select Tx control
758  * WR6  XXXXXXXX        sync character
759  * WR7  XXXXXXXX        sync character
760  * WR9  000X0XXX        select interrupt control
761  * WR10 XXXXXXXX        miscellaneous control (optional)
762  * WR11 XXXXXXXX        clock control
763  * WR12 XXXXXXXX        time constant lower byte (optional)
764  * WR13 XXXXXXXX        time constant upper byte (optional)
765  * WR14 XXXXXXX0        miscellaneous control
766  * WR14 XXXSSSSS        commands (optional)
767  *
768  * 2. Enables
769  *
770  * WR14 000SSSS1        baud rate enable
771  * WR3  SSSSSSS1        Rx enable
772  * WR5  SSSS1SSS        Tx enable
773  * WR0  10000000        reset Tx CRG (optional)
774  * WR1  XSS00S00        DMA enable (optional)
775  *
776  * 3. Interrupt status
777  *
778  * WR15 XXXXXXXX        enable external/status
779  * WR0  00010000        reset external status
780  * WR0  00010000        reset external status twice
781  * WR1  SSSXXSXX        enable Rx, Tx and Ext/status
782  * WR9  000SXSSS        enable master interrupt enable
783  *
784  * 1 = set to one, 0 = reset to zero
785  * X = user defined, S = same as previous init
786  *
787  *
788  * Note that the implementation differs in some points from above scheme.
789  *
790  */
791  
792 static void init_channel(struct scc_channel *scc)
793 {
794         del_timer(&scc->tx_t);
795         del_timer(&scc->tx_wdog);
796
797         disable_irq(scc->irq);
798
799         wr(scc,R4,X1CLK|SDLC);          /* *1 clock, SDLC mode */
800         wr(scc,R1,0);                   /* no W/REQ operation */
801         wr(scc,R3,Rx8|RxCRC_ENAB);      /* RX 8 bits/char, CRC, disabled */     
802         wr(scc,R5,Tx8|DTR|TxCRC_ENAB);  /* TX 8 bits/char, disabled, DTR */
803         wr(scc,R6,0);                   /* SDLC address zero (not used) */
804         wr(scc,R7,FLAG);                /* SDLC flag value */
805         wr(scc,R9,VIS);                 /* vector includes status */
806         wr(scc,R10,(scc->modem.nrz? NRZ : NRZI)|CRCPS|ABUNDER); /* abort on underrun, preset CRC generator, NRZ(I) */
807         wr(scc,R14, 0);
808
809
810 /* set clock sources:
811
812    CLK_DPLL: normal halfduplex operation
813    
814                 RxClk: use DPLL
815                 TxClk: use DPLL
816                 TRxC mode DPLL output
817                 
818    CLK_EXTERNAL: external clocking (G3RUH or DF9IC modem)
819    
820                 BayCom:                 others:
821                 
822                 TxClk = pin RTxC        TxClk = pin TRxC
823                 RxClk = pin TRxC        RxClk = pin RTxC
824              
825
826    CLK_DIVIDER:
827                 RxClk = use DPLL
828                 TxClk = pin RTxC
829                 
830                 BayCom:                 others:
831                 pin TRxC = DPLL         pin TRxC = BRG
832                 (RxClk * 1)             (RxClk * 32)
833 */  
834
835                 
836         switch(scc->modem.clocksrc)
837         {
838                 case CLK_DPLL:
839                         wr(scc, R11, RCDPLL|TCDPLL|TRxCOI|TRxCDP);
840                         init_brg(scc);
841                         break;
842
843                 case CLK_DIVIDER:
844                         wr(scc, R11, ((scc->brand & BAYCOM)? TRxCDP : TRxCBR) | RCDPLL|TCRTxCP|TRxCOI);
845                         init_brg(scc);
846                         break;
847
848                 case CLK_EXTERNAL:
849                         wr(scc, R11, (scc->brand & BAYCOM)? RCTRxCP|TCRTxCP : RCRTxCP|TCTRxCP);
850                         OutReg(scc->ctrl, R14, DISDPLL);
851                         break;
852
853         }
854         
855         set_speed(scc);                 /* set baudrate */
856         
857         if(scc->enhanced)
858         {
859                 or(scc,R15,SHDLCE|FIFOE);       /* enable FIFO, SDLC/HDLC Enhancements (From now R7 is R7') */
860                 wr(scc,R7,AUTOEOM);
861         }
862
863         if(scc->kiss.softdcd || (InReg(scc->ctrl,R0) & DCD))
864                                                 /* DCD is now ON */
865         {
866                 start_hunt(scc);
867         }
868         
869         /* enable ABORT, DCD & SYNC/HUNT interrupts */
870
871         wr(scc,R15, BRKIE|TxUIE|(scc->kiss.softdcd? SYNCIE:DCDIE));
872
873         Outb(scc->ctrl,RES_EXT_INT);    /* reset ext/status interrupts */
874         Outb(scc->ctrl,RES_EXT_INT);    /* must be done twice */
875
876         or(scc,R1,INT_ALL_Rx|TxINT_ENAB|EXT_INT_ENAB); /* enable interrupts */
877         
878         scc->status = InReg(scc->ctrl,R0);      /* read initial status */
879         
880         or(scc,R9,MIE);                 /* master interrupt enable */
881         
882         scc_init_timer(scc);
883                         
884         enable_irq(scc->irq);
885 }
886
887
888
889
890 /* ******************************************************************** */
891 /* *                    SCC timer functions                           * */
892 /* ******************************************************************** */
893
894
895 /* ----> scc_key_trx sets the time constant for the baudrate 
896          generator and keys the transmitter                  <---- */
897
898 static void scc_key_trx(struct scc_channel *scc, char tx)
899 {
900         unsigned int time_const;
901                 
902         if (scc->brand & PRIMUS)
903                 Outb(scc->ctrl + 4, scc->option | (tx? 0x80 : 0));
904
905         if (scc->modem.speed < 300) 
906                 scc->modem.speed = 1200;
907
908         time_const = (unsigned) (scc->clock / (scc->modem.speed * (tx? 2:64))) - 2;
909
910         disable_irq(scc->irq);
911
912         if (tx)
913         {
914                 or(scc, R1, TxINT_ENAB);        /* t_maxkeyup may have reset these */
915                 or(scc, R15, TxUIE);
916         }
917
918         if (scc->modem.clocksrc == CLK_DPLL)
919         {                               /* force simplex operation */
920                 if (tx)
921                 {
922 #ifdef CONFIG_SCC_TRXECHO
923                         cl(scc, R3, RxENABLE|ENT_HM);   /* switch off receiver */
924                         cl(scc, R15, DCDIE|SYNCIE);     /* No DCD changes, please */
925 #endif
926                         set_brg(scc, time_const);       /* reprogram baudrate generator */
927
928                         /* DPLL -> Rx clk, BRG -> Tx CLK, TRxC mode output, TRxC = BRG */
929                         wr(scc, R11, RCDPLL|TCBR|TRxCOI|TRxCBR);
930                         
931                         /* By popular demand: tx_inhibit */
932                         if (scc->kiss.tx_inhibit)
933                         {
934                                 or(scc,R5, TxENAB);
935                                 scc->wreg[R5] |= RTS;
936                         } else {
937                                 or(scc,R5,RTS|TxENAB);  /* set the RTS line and enable TX */
938                         }
939                 } else {
940                         cl(scc,R5,RTS|TxENAB);
941                         
942                         set_brg(scc, time_const);       /* reprogram baudrate generator */
943                         
944                         /* DPLL -> Rx clk, DPLL -> Tx CLK, TRxC mode output, TRxC = DPLL */
945                         wr(scc, R11, RCDPLL|TCDPLL|TRxCOI|TRxCDP);
946
947 #ifndef CONFIG_SCC_TRXECHO
948                         if (scc->kiss.softdcd)
949 #endif
950                         {
951                                 or(scc,R15, scc->kiss.softdcd? SYNCIE:DCDIE);
952                                 start_hunt(scc);
953                         }
954                 }
955         } else {
956                 if (tx)
957                 {
958 #ifdef CONFIG_SCC_TRXECHO
959                         if (scc->kiss.fulldup == KISS_DUPLEX_HALF)
960                         {
961                                 cl(scc, R3, RxENABLE);
962                                 cl(scc, R15, DCDIE|SYNCIE);
963                         }
964 #endif
965                                 
966                         if (scc->kiss.tx_inhibit)
967                         {
968                                 or(scc,R5, TxENAB);
969                                 scc->wreg[R5] |= RTS;
970                         } else {        
971                                 or(scc,R5,RTS|TxENAB);  /* enable tx */
972                         }
973                 } else {
974                         cl(scc,R5,RTS|TxENAB);          /* disable tx */
975
976                         if ((scc->kiss.fulldup == KISS_DUPLEX_HALF) &&
977 #ifndef CONFIG_SCC_TRXECHO
978                             scc->kiss.softdcd)
979 #else
980                             1)
981 #endif
982                         {
983                                 or(scc, R15, scc->kiss.softdcd? SYNCIE:DCDIE);
984                                 start_hunt(scc);
985                         }
986                 }
987         }
988
989         enable_irq(scc->irq);
990 }
991
992
993 /* ----> SCC timer interrupt handler and friends. <---- */
994
995 static void __scc_start_tx_timer(struct scc_channel *scc, void (*handler)(unsigned long), unsigned long when)
996 {
997         del_timer(&scc->tx_t);
998
999         if (when == 0)
1000         {
1001                 handler((unsigned long) scc);
1002         } else 
1003         if (when != TIMER_OFF)
1004         {
1005                 scc->tx_t.data = (unsigned long) scc;
1006                 scc->tx_t.function = handler;
1007                 scc->tx_t.expires = jiffies + (when*HZ)/100;
1008                 add_timer(&scc->tx_t);
1009         }
1010 }
1011
1012 static void scc_start_tx_timer(struct scc_channel *scc, void (*handler)(unsigned long), unsigned long when)
1013 {
1014         unsigned long flags;
1015         
1016         spin_lock_irqsave(&scc->lock, flags);
1017         __scc_start_tx_timer(scc, handler, when);
1018         spin_unlock_irqrestore(&scc->lock, flags);
1019 }
1020
1021 static void scc_start_defer(struct scc_channel *scc)
1022 {
1023         unsigned long flags;
1024         
1025         spin_lock_irqsave(&scc->lock, flags);
1026         del_timer(&scc->tx_wdog);
1027         
1028         if (scc->kiss.maxdefer != 0 && scc->kiss.maxdefer != TIMER_OFF)
1029         {
1030                 scc->tx_wdog.data = (unsigned long) scc;
1031                 scc->tx_wdog.function = t_busy;
1032                 scc->tx_wdog.expires = jiffies + HZ*scc->kiss.maxdefer;
1033                 add_timer(&scc->tx_wdog);
1034         }
1035         spin_unlock_irqrestore(&scc->lock, flags);
1036 }
1037
1038 static void scc_start_maxkeyup(struct scc_channel *scc)
1039 {
1040         unsigned long flags;
1041         
1042         spin_lock_irqsave(&scc->lock, flags);
1043         del_timer(&scc->tx_wdog);
1044         
1045         if (scc->kiss.maxkeyup != 0 && scc->kiss.maxkeyup != TIMER_OFF)
1046         {
1047                 scc->tx_wdog.data = (unsigned long) scc;
1048                 scc->tx_wdog.function = t_maxkeyup;
1049                 scc->tx_wdog.expires = jiffies + HZ*scc->kiss.maxkeyup;
1050                 add_timer(&scc->tx_wdog);
1051         }
1052         spin_unlock_irqrestore(&scc->lock, flags);
1053 }
1054
1055 /* 
1056  * This is called from scc_txint() when there are no more frames to send.
1057  * Not exactly a timer function, but it is a close friend of the family...
1058  */
1059
1060 static void scc_tx_done(struct scc_channel *scc)
1061 {
1062         /* 
1063          * trx remains keyed in fulldup mode 2 until t_idle expires.
1064          */
1065                                  
1066         switch (scc->kiss.fulldup)
1067         {
1068                 case KISS_DUPLEX_LINK:
1069                         scc->stat.tx_state = TXS_IDLE2;
1070                         if (scc->kiss.idletime != TIMER_OFF)
1071                         scc_start_tx_timer(scc, t_idle, scc->kiss.idletime*100);
1072                         break;
1073                 case KISS_DUPLEX_OPTIMA:
1074                         scc_notify(scc, HWEV_ALL_SENT);
1075                         break;
1076                 default:
1077                         scc->stat.tx_state = TXS_BUSY;
1078                         scc_start_tx_timer(scc, t_tail, scc->kiss.tailtime);
1079         }
1080
1081         netif_wake_queue(scc->dev);
1082 }
1083
1084
1085 static unsigned char Rand = 17;
1086
1087 static inline int is_grouped(struct scc_channel *scc)
1088 {
1089         int k;
1090         struct scc_channel *scc2;
1091         unsigned char grp1, grp2;
1092
1093         grp1 = scc->kiss.group;
1094         
1095         for (k = 0; k < (Nchips * 2); k++)
1096         {
1097                 scc2 = &SCC_Info[k];
1098                 grp2 = scc2->kiss.group;
1099                 
1100                 if (scc2 == scc || !(scc2->dev && grp2))
1101                         continue;
1102                 
1103                 if ((grp1 & 0x3f) == (grp2 & 0x3f))
1104                 {
1105                         if ( (grp1 & TXGROUP) && (scc2->wreg[R5] & RTS) )
1106                                 return 1;
1107                         
1108                         if ( (grp1 & RXGROUP) && scc2->dcd )
1109                                 return 1;
1110                 }
1111         }
1112         return 0;
1113 }
1114
1115 /* DWAIT and SLOTTIME expired
1116  *
1117  * fulldup == 0:  DCD is active or Rand > P-persistence: start t_busy timer
1118  *                else key trx and start txdelay
1119  * fulldup == 1:  key trx and start txdelay
1120  * fulldup == 2:  mintime expired, reset status or key trx and start txdelay
1121  */
1122
1123 static void t_dwait(unsigned long channel)
1124 {
1125         struct scc_channel *scc = (struct scc_channel *) channel;
1126         
1127         if (scc->stat.tx_state == TXS_WAIT)     /* maxkeyup or idle timeout */
1128         {
1129                 if (skb_queue_empty(&scc->tx_queue)) {  /* nothing to send */
1130                         scc->stat.tx_state = TXS_IDLE;
1131                         netif_wake_queue(scc->dev);     /* t_maxkeyup locked it. */
1132                         return;
1133                 }
1134
1135                 scc->stat.tx_state = TXS_BUSY;
1136         }
1137
1138         if (scc->kiss.fulldup == KISS_DUPLEX_HALF)
1139         {
1140                 Rand = Rand * 17 + 31;
1141                 
1142                 if (scc->dcd || (scc->kiss.persist) < Rand || (scc->kiss.group && is_grouped(scc)) )
1143                 {
1144                         scc_start_defer(scc);
1145                         scc_start_tx_timer(scc, t_dwait, scc->kiss.slottime);
1146                         return ;
1147                 }
1148         }
1149
1150         if ( !(scc->wreg[R5] & RTS) )
1151         {
1152                 scc_key_trx(scc, TX_ON);
1153                 scc_start_tx_timer(scc, t_txdelay, scc->kiss.txdelay);
1154         } else {
1155                 scc_start_tx_timer(scc, t_txdelay, 0);
1156         }
1157 }
1158
1159
1160 /* TXDELAY expired
1161  *
1162  * kick transmission by a fake scc_txint(scc), start 'maxkeyup' watchdog.
1163  */
1164
1165 static void t_txdelay(unsigned long channel)
1166 {
1167         struct scc_channel *scc = (struct scc_channel *) channel;
1168
1169         scc_start_maxkeyup(scc);
1170
1171         if (scc->tx_buff == NULL)
1172         {
1173                 disable_irq(scc->irq);
1174                 scc_txint(scc); 
1175                 enable_irq(scc->irq);
1176         }
1177 }
1178         
1179
1180 /* TAILTIME expired
1181  *
1182  * switch off transmitter. If we were stopped by Maxkeyup restart
1183  * transmission after 'mintime' seconds
1184  */
1185
1186 static void t_tail(unsigned long channel)
1187 {
1188         struct scc_channel *scc = (struct scc_channel *) channel;
1189         unsigned long flags;
1190         
1191         spin_lock_irqsave(&scc->lock, flags); 
1192         del_timer(&scc->tx_wdog);       
1193         scc_key_trx(scc, TX_OFF);
1194         spin_unlock_irqrestore(&scc->lock, flags);
1195
1196         if (scc->stat.tx_state == TXS_TIMEOUT)          /* we had a timeout? */
1197         {
1198                 scc->stat.tx_state = TXS_WAIT;
1199                 scc_start_tx_timer(scc, t_dwait, scc->kiss.mintime*100);
1200                 return;
1201         }
1202         
1203         scc->stat.tx_state = TXS_IDLE;
1204         netif_wake_queue(scc->dev);
1205 }
1206
1207
1208 /* BUSY timeout
1209  *
1210  * throw away send buffers if DCD remains active too long.
1211  */
1212
1213 static void t_busy(unsigned long channel)
1214 {
1215         struct scc_channel *scc = (struct scc_channel *) channel;
1216
1217         del_timer(&scc->tx_t);
1218         netif_stop_queue(scc->dev);     /* don't pile on the wabbit! */
1219
1220         scc_discard_buffers(scc);
1221         scc->stat.txerrs++;
1222         scc->stat.tx_state = TXS_IDLE;
1223
1224         netif_wake_queue(scc->dev);     
1225 }
1226
1227 /* MAXKEYUP timeout
1228  *
1229  * this is our watchdog.
1230  */
1231
1232 static void t_maxkeyup(unsigned long channel)
1233 {
1234         struct scc_channel *scc = (struct scc_channel *) channel;
1235         unsigned long flags;
1236
1237         spin_lock_irqsave(&scc->lock, flags);
1238         /* 
1239          * let things settle down before we start to
1240          * accept new data.
1241          */
1242
1243         netif_stop_queue(scc->dev);
1244         scc_discard_buffers(scc);
1245
1246         del_timer(&scc->tx_t);
1247
1248         cl(scc, R1, TxINT_ENAB);        /* force an ABORT, but don't */
1249         cl(scc, R15, TxUIE);            /* count it. */
1250         OutReg(scc->ctrl, R0, RES_Tx_P);
1251
1252         spin_unlock_irqrestore(&scc->lock, flags);
1253
1254         scc->stat.txerrs++;
1255         scc->stat.tx_state = TXS_TIMEOUT;
1256         scc_start_tx_timer(scc, t_tail, scc->kiss.tailtime);
1257 }
1258
1259 /* IDLE timeout
1260  *
1261  * in fulldup mode 2 it keys down the transmitter after 'idle' seconds
1262  * of inactivity. We will not restart transmission before 'mintime'
1263  * expires.
1264  */
1265
1266 static void t_idle(unsigned long channel)
1267 {
1268         struct scc_channel *scc = (struct scc_channel *) channel;
1269         
1270         del_timer(&scc->tx_wdog);
1271
1272         scc_key_trx(scc, TX_OFF);
1273         if(scc->kiss.mintime)
1274                 scc_start_tx_timer(scc, t_dwait, scc->kiss.mintime*100);
1275         scc->stat.tx_state = TXS_WAIT;
1276 }
1277
1278 static void scc_init_timer(struct scc_channel *scc)
1279 {
1280         unsigned long flags;
1281
1282         spin_lock_irqsave(&scc->lock, flags);   
1283         scc->stat.tx_state = TXS_IDLE;
1284         spin_unlock_irqrestore(&scc->lock, flags);
1285 }
1286
1287
1288 /* ******************************************************************** */
1289 /* *                    Set/get L1 parameters                         * */
1290 /* ******************************************************************** */
1291
1292
1293 /*
1294  * this will set the "hardware" parameters through KISS commands or ioctl()
1295  */
1296
1297 #define CAST(x) (unsigned long)(x)
1298
1299 static unsigned int scc_set_param(struct scc_channel *scc, unsigned int cmd, unsigned int arg)
1300 {
1301         switch (cmd)
1302         {
1303                 case PARAM_TXDELAY:     scc->kiss.txdelay=arg;          break;
1304                 case PARAM_PERSIST:     scc->kiss.persist=arg;          break;
1305                 case PARAM_SLOTTIME:    scc->kiss.slottime=arg;         break;
1306                 case PARAM_TXTAIL:      scc->kiss.tailtime=arg;         break;
1307                 case PARAM_FULLDUP:     scc->kiss.fulldup=arg;          break;
1308                 case PARAM_DTR:         break; /* does someone need this? */
1309                 case PARAM_GROUP:       scc->kiss.group=arg;            break;
1310                 case PARAM_IDLE:        scc->kiss.idletime=arg;         break;
1311                 case PARAM_MIN:         scc->kiss.mintime=arg;          break;
1312                 case PARAM_MAXKEY:      scc->kiss.maxkeyup=arg;         break;
1313                 case PARAM_WAIT:        scc->kiss.waittime=arg;         break;
1314                 case PARAM_MAXDEFER:    scc->kiss.maxdefer=arg;         break;
1315                 case PARAM_TX:          scc->kiss.tx_inhibit=arg;       break;
1316
1317                 case PARAM_SOFTDCD:     
1318                         scc->kiss.softdcd=arg;
1319                         if (arg)
1320                         {
1321                                 or(scc, R15, SYNCIE);
1322                                 cl(scc, R15, DCDIE);
1323                                 start_hunt(scc);
1324                         } else {
1325                                 or(scc, R15, DCDIE);
1326                                 cl(scc, R15, SYNCIE);
1327                         }
1328                         break;
1329                                 
1330                 case PARAM_SPEED:
1331                         if (arg < 256)
1332                                 scc->modem.speed=arg*100;
1333                         else
1334                                 scc->modem.speed=arg;
1335
1336                         if (scc->stat.tx_state == 0)    /* only switch baudrate on rx... ;-) */
1337                                 set_speed(scc);
1338                         break;
1339                         
1340                 case PARAM_RTS: 
1341                         if ( !(scc->wreg[R5] & RTS) )
1342                         {
1343                                 if (arg != TX_OFF) {
1344                                         scc_key_trx(scc, TX_ON);
1345                                         scc_start_tx_timer(scc, t_txdelay, scc->kiss.txdelay);
1346                                 }
1347                         } else {
1348                                 if (arg == TX_OFF)
1349                                 {
1350                                         scc->stat.tx_state = TXS_BUSY;
1351                                         scc_start_tx_timer(scc, t_tail, scc->kiss.tailtime);
1352                                 }
1353                         }
1354                         break;
1355                         
1356                 case PARAM_HWEVENT:
1357                         scc_notify(scc, scc->dcd? HWEV_DCD_ON:HWEV_DCD_OFF);
1358                         break;
1359
1360                 default:                return -EINVAL;
1361         }
1362         
1363         return 0;
1364 }
1365
1366
1367  
1368 static unsigned long scc_get_param(struct scc_channel *scc, unsigned int cmd)
1369 {
1370         switch (cmd)
1371         {
1372                 case PARAM_TXDELAY:     return CAST(scc->kiss.txdelay);
1373                 case PARAM_PERSIST:     return CAST(scc->kiss.persist);
1374                 case PARAM_SLOTTIME:    return CAST(scc->kiss.slottime);
1375                 case PARAM_TXTAIL:      return CAST(scc->kiss.tailtime);
1376                 case PARAM_FULLDUP:     return CAST(scc->kiss.fulldup);
1377                 case PARAM_SOFTDCD:     return CAST(scc->kiss.softdcd);
1378                 case PARAM_DTR:         return CAST((scc->wreg[R5] & DTR)? 1:0);
1379                 case PARAM_RTS:         return CAST((scc->wreg[R5] & RTS)? 1:0);
1380                 case PARAM_SPEED:       return CAST(scc->modem.speed);
1381                 case PARAM_GROUP:       return CAST(scc->kiss.group);
1382                 case PARAM_IDLE:        return CAST(scc->kiss.idletime);
1383                 case PARAM_MIN:         return CAST(scc->kiss.mintime);
1384                 case PARAM_MAXKEY:      return CAST(scc->kiss.maxkeyup);
1385                 case PARAM_WAIT:        return CAST(scc->kiss.waittime);
1386                 case PARAM_MAXDEFER:    return CAST(scc->kiss.maxdefer);
1387                 case PARAM_TX:          return CAST(scc->kiss.tx_inhibit);
1388                 default:                return NO_SUCH_PARAM;
1389         }
1390
1391 }
1392
1393 #undef CAST
1394
1395 /* ******************************************************************* */
1396 /* *                    Send calibration pattern                     * */
1397 /* ******************************************************************* */
1398
1399 static void scc_stop_calibrate(unsigned long channel)
1400 {
1401         struct scc_channel *scc = (struct scc_channel *) channel;
1402         unsigned long flags;
1403         
1404         spin_lock_irqsave(&scc->lock, flags);
1405         del_timer(&scc->tx_wdog);
1406         scc_key_trx(scc, TX_OFF);
1407         wr(scc, R6, 0);
1408         wr(scc, R7, FLAG);
1409         Outb(scc->ctrl,RES_EXT_INT);    /* reset ext/status interrupts */
1410         Outb(scc->ctrl,RES_EXT_INT);
1411
1412         netif_wake_queue(scc->dev);
1413         spin_unlock_irqrestore(&scc->lock, flags);
1414 }
1415
1416
1417 static void
1418 scc_start_calibrate(struct scc_channel *scc, int duration, unsigned char pattern)
1419 {
1420         unsigned long flags;
1421         
1422         spin_lock_irqsave(&scc->lock, flags);
1423         netif_stop_queue(scc->dev);
1424         scc_discard_buffers(scc);
1425
1426         del_timer(&scc->tx_wdog);
1427
1428         scc->tx_wdog.data = (unsigned long) scc;
1429         scc->tx_wdog.function = scc_stop_calibrate;
1430         scc->tx_wdog.expires = jiffies + HZ*duration;
1431         add_timer(&scc->tx_wdog);
1432
1433         /* This doesn't seem to work. Why not? */       
1434         wr(scc, R6, 0);
1435         wr(scc, R7, pattern);
1436
1437         /* 
1438          * Don't know if this works. 
1439          * Damn, where is my Z8530 programming manual...? 
1440          */
1441
1442         Outb(scc->ctrl,RES_EXT_INT);    /* reset ext/status interrupts */
1443         Outb(scc->ctrl,RES_EXT_INT);
1444
1445         scc_key_trx(scc, TX_ON);
1446         spin_unlock_irqrestore(&scc->lock, flags);
1447 }
1448
1449 /* ******************************************************************* */
1450 /* *            Init channel structures, special HW, etc...          * */
1451 /* ******************************************************************* */
1452
1453 /*
1454  * Reset the Z8530s and setup special hardware
1455  */
1456
1457 static void z8530_init(void)
1458 {
1459         struct scc_channel *scc;
1460         int chip, k;
1461         unsigned long flags;
1462         char *flag;
1463
1464
1465         printk(KERN_INFO "Init Z8530 driver: %u channels, IRQ", Nchips*2);
1466         
1467         flag=" ";
1468         for (k = 0; k < nr_irqs; k++)
1469                 if (Ivec[k].used) 
1470                 {
1471                         printk("%s%d", flag, k);
1472                         flag=",";
1473                 }
1474         printk("\n");
1475
1476
1477         /* reset and pre-init all chips in the system */
1478         for (chip = 0; chip < Nchips; chip++)
1479         {
1480                 scc=&SCC_Info[2*chip];
1481                 if (!scc->ctrl) continue;
1482
1483                 /* Special SCC cards */
1484
1485                 if(scc->brand & EAGLE)                  /* this is an EAGLE card */
1486                         Outb(scc->special,0x08);        /* enable interrupt on the board */
1487                         
1488                 if(scc->brand & (PC100 | PRIMUS))       /* this is a PC100/PRIMUS card */
1489                         Outb(scc->special,scc->option); /* set the MODEM mode (0x22) */
1490
1491                         
1492                 /* Reset and pre-init Z8530 */
1493
1494                 spin_lock_irqsave(&scc->lock, flags);
1495                                 
1496                 Outb(scc->ctrl, 0);
1497                 OutReg(scc->ctrl,R9,FHWRES);            /* force hardware reset */
1498                 udelay(100);                            /* give it 'a bit' more time than required */
1499                 wr(scc, R2, chip*16);                   /* interrupt vector */
1500                 wr(scc, R9, VIS);                       /* vector includes status */
1501                 spin_unlock_irqrestore(&scc->lock, flags);              
1502         }
1503
1504  
1505         Driver_Initialized = 1;
1506 }
1507
1508 /*
1509  * Allocate device structure, err, instance, and register driver
1510  */
1511
1512 static int scc_net_alloc(const char *name, struct scc_channel *scc)
1513 {
1514         int err;
1515         struct net_device *dev;
1516
1517         dev = alloc_netdev(0, name, scc_net_setup);
1518         if (!dev) 
1519                 return -ENOMEM;
1520
1521         dev->ml_priv = scc;
1522         scc->dev = dev;
1523         spin_lock_init(&scc->lock);
1524         init_timer(&scc->tx_t);
1525         init_timer(&scc->tx_wdog);
1526
1527         err = register_netdevice(dev);
1528         if (err) {
1529                 printk(KERN_ERR "%s: can't register network device (%d)\n", 
1530                        name, err);
1531                 free_netdev(dev);
1532                 scc->dev = NULL;
1533                 return err;
1534         }
1535
1536         return 0;
1537 }
1538
1539
1540
1541 /* ******************************************************************** */
1542 /* *                        Network driver methods                    * */
1543 /* ******************************************************************** */
1544
1545 /* ----> Initialize device <----- */
1546
1547 static void scc_net_setup(struct net_device *dev)
1548 {
1549         dev->tx_queue_len    = 16;      /* should be enough... */
1550
1551         dev->open            = scc_net_open;
1552         dev->stop            = scc_net_close;
1553
1554         dev->hard_start_xmit = scc_net_tx;
1555         dev->header_ops      = &ax25_header_ops;
1556
1557         dev->set_mac_address = scc_net_set_mac_address;
1558         dev->get_stats       = scc_net_get_stats;
1559         dev->do_ioctl        = scc_net_ioctl;
1560         dev->tx_timeout      = NULL;
1561
1562         memcpy(dev->broadcast, &ax25_bcast,  AX25_ADDR_LEN);
1563         memcpy(dev->dev_addr,  &ax25_defaddr, AX25_ADDR_LEN);
1564  
1565         dev->flags      = 0;
1566
1567         dev->type = ARPHRD_AX25;
1568         dev->hard_header_len = AX25_MAX_HEADER_LEN + AX25_BPQ_HEADER_LEN;
1569         dev->mtu = AX25_DEF_PACLEN;
1570         dev->addr_len = AX25_ADDR_LEN;
1571
1572 }
1573
1574 /* ----> open network device <---- */
1575
1576 static int scc_net_open(struct net_device *dev)
1577 {
1578         struct scc_channel *scc = (struct scc_channel *) dev->ml_priv;
1579
1580         if (!scc->init)
1581                 return -EINVAL;
1582
1583         scc->tx_buff = NULL;
1584         skb_queue_head_init(&scc->tx_queue);
1585  
1586         init_channel(scc);
1587
1588         netif_start_queue(dev);
1589         return 0;
1590 }
1591
1592 /* ----> close network device <---- */
1593
1594 static int scc_net_close(struct net_device *dev)
1595 {
1596         struct scc_channel *scc = (struct scc_channel *) dev->ml_priv;
1597         unsigned long flags;
1598
1599         netif_stop_queue(dev);
1600
1601         spin_lock_irqsave(&scc->lock, flags);   
1602         Outb(scc->ctrl,0);              /* Make sure pointer is written */
1603         wr(scc,R1,0);                   /* disable interrupts */
1604         wr(scc,R3,0);
1605         spin_unlock_irqrestore(&scc->lock, flags);
1606
1607         del_timer_sync(&scc->tx_t);
1608         del_timer_sync(&scc->tx_wdog);
1609         
1610         scc_discard_buffers(scc);
1611
1612         return 0;
1613 }
1614
1615 /* ----> receive frame, called from scc_rxint() <---- */
1616
1617 static void scc_net_rx(struct scc_channel *scc, struct sk_buff *skb)
1618 {
1619         if (skb->len == 0) {
1620                 dev_kfree_skb_irq(skb);
1621                 return;
1622         }
1623                 
1624         scc->dev_stat.rx_packets++;
1625         scc->dev_stat.rx_bytes += skb->len;
1626
1627         skb->protocol = ax25_type_trans(skb, scc->dev);
1628         
1629         netif_rx(skb);
1630         return;
1631 }
1632
1633 /* ----> transmit frame <---- */
1634
1635 static int scc_net_tx(struct sk_buff *skb, struct net_device *dev)
1636 {
1637         struct scc_channel *scc = (struct scc_channel *) dev->ml_priv;
1638         unsigned long flags;
1639         char kisscmd;
1640
1641         if (skb->len > scc->stat.bufsize || skb->len < 2) {
1642                 scc->dev_stat.tx_dropped++;     /* bogus frame */
1643                 dev_kfree_skb(skb);
1644                 return 0;
1645         }
1646         
1647         scc->dev_stat.tx_packets++;
1648         scc->dev_stat.tx_bytes += skb->len;
1649         scc->stat.txframes++;
1650         
1651         kisscmd = *skb->data & 0x1f;
1652         skb_pull(skb, 1);
1653
1654         if (kisscmd) {
1655                 scc_set_param(scc, kisscmd, *skb->data);
1656                 dev_kfree_skb(skb);
1657                 return 0;
1658         }
1659
1660         spin_lock_irqsave(&scc->lock, flags);
1661                 
1662         if (skb_queue_len(&scc->tx_queue) > scc->dev->tx_queue_len) {
1663                 struct sk_buff *skb_del;
1664                 skb_del = skb_dequeue(&scc->tx_queue);
1665                 dev_kfree_skb(skb_del);
1666         }
1667         skb_queue_tail(&scc->tx_queue, skb);
1668         dev->trans_start = jiffies;
1669         
1670
1671         /*
1672          * Start transmission if the trx state is idle or
1673          * t_idle hasn't expired yet. Use dwait/persistence/slottime
1674          * algorithm for normal halfduplex operation.
1675          */
1676
1677         if(scc->stat.tx_state == TXS_IDLE || scc->stat.tx_state == TXS_IDLE2) {
1678                 scc->stat.tx_state = TXS_BUSY;
1679                 if (scc->kiss.fulldup == KISS_DUPLEX_HALF)
1680                         __scc_start_tx_timer(scc, t_dwait, scc->kiss.waittime);
1681                 else
1682                         __scc_start_tx_timer(scc, t_dwait, 0);
1683         }
1684         spin_unlock_irqrestore(&scc->lock, flags);
1685         return 0;
1686 }
1687
1688 /* ----> ioctl functions <---- */
1689
1690 /*
1691  * SIOCSCCCFG           - configure driver      arg: (struct scc_hw_config *) arg
1692  * SIOCSCCINI           - initialize driver     arg: ---
1693  * SIOCSCCCHANINI       - initialize channel    arg: (struct scc_modem *) arg
1694  * SIOCSCCSMEM          - set memory            arg: (struct scc_mem_config *) arg
1695  * SIOCSCCGKISS         - get level 1 parameter arg: (struct scc_kiss_cmd *) arg
1696  * SIOCSCCSKISS         - set level 1 parameter arg: (struct scc_kiss_cmd *) arg
1697  * SIOCSCCGSTAT         - get driver status     arg: (struct scc_stat *) arg
1698  * SIOCSCCCAL           - send calib. pattern   arg: (struct scc_calibrate *) arg
1699  */
1700
1701 static int scc_net_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
1702 {
1703         struct scc_kiss_cmd kiss_cmd;
1704         struct scc_mem_config memcfg;
1705         struct scc_hw_config hwcfg;
1706         struct scc_calibrate cal;
1707         struct scc_channel *scc = (struct scc_channel *) dev->ml_priv;
1708         int chan;
1709         unsigned char device_name[IFNAMSIZ];
1710         void __user *arg = ifr->ifr_data;
1711         
1712         
1713         if (!Driver_Initialized)
1714         {
1715                 if (cmd == SIOCSCCCFG)
1716                 {
1717                         int found = 1;
1718
1719                         if (!capable(CAP_SYS_RAWIO)) return -EPERM;
1720                         if (!arg) return -EFAULT;
1721
1722                         if (Nchips >= SCC_MAXCHIPS) 
1723                                 return -EINVAL;
1724
1725                         if (copy_from_user(&hwcfg, arg, sizeof(hwcfg)))
1726                                 return -EFAULT;
1727
1728                         if (hwcfg.irq == 2) hwcfg.irq = 9;
1729
1730                         if (hwcfg.irq < 0 || hwcfg.irq >= nr_irqs)
1731                                 return -EINVAL;
1732                                 
1733                         if (!Ivec[hwcfg.irq].used && hwcfg.irq)
1734                         {
1735                                 if (request_irq(hwcfg.irq, scc_isr,
1736                                                 IRQF_DISABLED, "AX.25 SCC",
1737                                                 (void *)(long) hwcfg.irq))
1738                                         printk(KERN_WARNING "z8530drv: warning, cannot get IRQ %d\n", hwcfg.irq);
1739                                 else
1740                                         Ivec[hwcfg.irq].used = 1;
1741                         }
1742
1743                         if (hwcfg.vector_latch && !Vector_Latch) {
1744                                 if (!request_region(hwcfg.vector_latch, 1, "scc vector latch"))
1745                                         printk(KERN_WARNING "z8530drv: warning, cannot reserve vector latch port 0x%lx\n, disabled.", hwcfg.vector_latch);
1746                                 else
1747                                         Vector_Latch = hwcfg.vector_latch;
1748                         }
1749
1750                         if (hwcfg.clock == 0)
1751                                 hwcfg.clock = SCC_DEFAULT_CLOCK;
1752
1753 #ifndef SCC_DONT_CHECK
1754
1755                         if(request_region(hwcfg.ctrl_a, 1, "scc-probe"))
1756                         {
1757                                 disable_irq(hwcfg.irq);
1758                                 Outb(hwcfg.ctrl_a, 0);
1759                                 OutReg(hwcfg.ctrl_a, R9, FHWRES);
1760                                 udelay(100);
1761                                 OutReg(hwcfg.ctrl_a,R13,0x55);          /* is this chip really there? */
1762                                 udelay(5);
1763
1764                                 if (InReg(hwcfg.ctrl_a,R13) != 0x55)
1765                                         found = 0;
1766                                 enable_irq(hwcfg.irq);
1767                                 release_region(hwcfg.ctrl_a, 1);
1768                         }
1769                         else
1770                                 found = 0;
1771 #endif
1772
1773                         if (found)
1774                         {
1775                                 SCC_Info[2*Nchips  ].ctrl = hwcfg.ctrl_a;
1776                                 SCC_Info[2*Nchips  ].data = hwcfg.data_a;
1777                                 SCC_Info[2*Nchips  ].irq  = hwcfg.irq;
1778                                 SCC_Info[2*Nchips+1].ctrl = hwcfg.ctrl_b;
1779                                 SCC_Info[2*Nchips+1].data = hwcfg.data_b;
1780                                 SCC_Info[2*Nchips+1].irq  = hwcfg.irq;
1781                         
1782                                 SCC_ctrl[Nchips].chan_A = hwcfg.ctrl_a;
1783                                 SCC_ctrl[Nchips].chan_B = hwcfg.ctrl_b;
1784                                 SCC_ctrl[Nchips].irq    = hwcfg.irq;
1785                         }
1786
1787
1788                         for (chan = 0; chan < 2; chan++)
1789                         {
1790                                 sprintf(device_name, "%s%i", SCC_DriverName, 2*Nchips+chan);
1791
1792                                 SCC_Info[2*Nchips+chan].special = hwcfg.special;
1793                                 SCC_Info[2*Nchips+chan].clock = hwcfg.clock;
1794                                 SCC_Info[2*Nchips+chan].brand = hwcfg.brand;
1795                                 SCC_Info[2*Nchips+chan].option = hwcfg.option;
1796                                 SCC_Info[2*Nchips+chan].enhanced = hwcfg.escc;
1797
1798 #ifdef SCC_DONT_CHECK
1799                                 printk(KERN_INFO "%s: data port = 0x%3.3x  control port = 0x%3.3x\n",
1800                                         device_name, 
1801                                         SCC_Info[2*Nchips+chan].data, 
1802                                         SCC_Info[2*Nchips+chan].ctrl);
1803
1804 #else
1805                                 printk(KERN_INFO "%s: data port = 0x%3.3lx  control port = 0x%3.3lx -- %s\n",
1806                                         device_name,
1807                                         chan? hwcfg.data_b : hwcfg.data_a, 
1808                                         chan? hwcfg.ctrl_b : hwcfg.ctrl_a,
1809                                         found? "found" : "missing");
1810 #endif
1811
1812                                 if (found)
1813                                 {
1814                                         request_region(SCC_Info[2*Nchips+chan].ctrl, 1, "scc ctrl");
1815                                         request_region(SCC_Info[2*Nchips+chan].data, 1, "scc data");
1816                                         if (Nchips+chan != 0 &&
1817                                             scc_net_alloc(device_name, 
1818                                                           &SCC_Info[2*Nchips+chan]))
1819                                             return -EINVAL;
1820                                 }
1821                         }
1822                         
1823                         if (found) Nchips++;
1824                         
1825                         return 0;
1826                 }
1827                 
1828                 if (cmd == SIOCSCCINI)
1829                 {
1830                         if (!capable(CAP_SYS_RAWIO))
1831                                 return -EPERM;
1832                                 
1833                         if (Nchips == 0)
1834                                 return -EINVAL;
1835
1836                         z8530_init();
1837                         return 0;
1838                 }
1839                 
1840                 return -EINVAL; /* confuse the user */
1841         }
1842         
1843         if (!scc->init)
1844         {
1845                 if (cmd == SIOCSCCCHANINI)
1846                 {
1847                         if (!capable(CAP_NET_ADMIN)) return -EPERM;
1848                         if (!arg) return -EINVAL;
1849                         
1850                         scc->stat.bufsize   = SCC_BUFSIZE;
1851
1852                         if (copy_from_user(&scc->modem, arg, sizeof(struct scc_modem)))
1853                                 return -EINVAL;
1854                         
1855                         /* default KISS Params */
1856                 
1857                         if (scc->modem.speed < 4800)
1858                         {
1859                                 scc->kiss.txdelay = 36;         /* 360 ms */
1860                                 scc->kiss.persist = 42;         /* 25% persistence */                   /* was 25 */
1861                                 scc->kiss.slottime = 16;        /* 160 ms */
1862                                 scc->kiss.tailtime = 4;         /* minimal reasonable value */
1863                                 scc->kiss.fulldup = 0;          /* CSMA */
1864                                 scc->kiss.waittime = 50;        /* 500 ms */
1865                                 scc->kiss.maxkeyup = 10;        /* 10 s */
1866                                 scc->kiss.mintime = 3;          /* 3 s */
1867                                 scc->kiss.idletime = 30;        /* 30 s */
1868                                 scc->kiss.maxdefer = 120;       /* 2 min */
1869                                 scc->kiss.softdcd = 0;          /* hardware dcd */
1870                         } else {
1871                                 scc->kiss.txdelay = 10;         /* 100 ms */
1872                                 scc->kiss.persist = 64;         /* 25% persistence */                   /* was 25 */
1873                                 scc->kiss.slottime = 8;         /* 160 ms */
1874                                 scc->kiss.tailtime = 1;         /* minimal reasonable value */
1875                                 scc->kiss.fulldup = 0;          /* CSMA */
1876                                 scc->kiss.waittime = 50;        /* 500 ms */
1877                                 scc->kiss.maxkeyup = 7;         /* 7 s */
1878                                 scc->kiss.mintime = 3;          /* 3 s */
1879                                 scc->kiss.idletime = 30;        /* 30 s */
1880                                 scc->kiss.maxdefer = 120;       /* 2 min */
1881                                 scc->kiss.softdcd = 0;          /* hardware dcd */
1882                         }
1883                         
1884                         scc->tx_buff = NULL;
1885                         skb_queue_head_init(&scc->tx_queue);
1886                         scc->init = 1;
1887                         
1888                         return 0;
1889                 }
1890                 
1891                 return -EINVAL;
1892         }
1893         
1894         switch(cmd)
1895         {
1896                 case SIOCSCCRESERVED:
1897                         return -ENOIOCTLCMD;
1898
1899                 case SIOCSCCSMEM:
1900                         if (!capable(CAP_SYS_RAWIO)) return -EPERM;
1901                         if (!arg || copy_from_user(&memcfg, arg, sizeof(memcfg)))
1902                                 return -EINVAL;
1903                         scc->stat.bufsize   = memcfg.bufsize;
1904                         return 0;
1905                 
1906                 case SIOCSCCGSTAT:
1907                         if (!arg || copy_to_user(arg, &scc->stat, sizeof(scc->stat)))
1908                                 return -EINVAL;
1909                         return 0;
1910                 
1911                 case SIOCSCCGKISS:
1912                         if (!arg || copy_from_user(&kiss_cmd, arg, sizeof(kiss_cmd)))
1913                                 return -EINVAL;
1914                         kiss_cmd.param = scc_get_param(scc, kiss_cmd.command);
1915                         if (copy_to_user(arg, &kiss_cmd, sizeof(kiss_cmd)))
1916                                 return -EINVAL;
1917                         return 0;
1918                 
1919                 case SIOCSCCSKISS:
1920                         if (!capable(CAP_NET_ADMIN)) return -EPERM;
1921                         if (!arg || copy_from_user(&kiss_cmd, arg, sizeof(kiss_cmd)))
1922                                 return -EINVAL;
1923                         return scc_set_param(scc, kiss_cmd.command, kiss_cmd.param);
1924                 
1925                 case SIOCSCCCAL:
1926                         if (!capable(CAP_SYS_RAWIO)) return -EPERM;
1927                         if (!arg || copy_from_user(&cal, arg, sizeof(cal)) || cal.time == 0)
1928                                 return -EINVAL;
1929
1930                         scc_start_calibrate(scc, cal.time, cal.pattern);
1931                         return 0;
1932
1933                 default:
1934                         return -ENOIOCTLCMD;
1935                 
1936         }
1937         
1938         return -EINVAL;
1939 }
1940
1941 /* ----> set interface callsign <---- */
1942
1943 static int scc_net_set_mac_address(struct net_device *dev, void *addr)
1944 {
1945         struct sockaddr *sa = (struct sockaddr *) addr;
1946         memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
1947         return 0;
1948 }
1949
1950 /* ----> get statistics <---- */
1951
1952 static struct net_device_stats *scc_net_get_stats(struct net_device *dev)
1953 {
1954         struct scc_channel *scc = (struct scc_channel *) dev->ml_priv;
1955         
1956         scc->dev_stat.rx_errors = scc->stat.rxerrs + scc->stat.rx_over;
1957         scc->dev_stat.tx_errors = scc->stat.txerrs + scc->stat.tx_under;
1958         scc->dev_stat.rx_fifo_errors = scc->stat.rx_over;
1959         scc->dev_stat.tx_fifo_errors = scc->stat.tx_under;
1960
1961         return &scc->dev_stat;
1962 }
1963
1964 /* ******************************************************************** */
1965 /* *            dump statistics to /proc/net/z8530drv                 * */
1966 /* ******************************************************************** */
1967
1968 #ifdef CONFIG_PROC_FS
1969
1970 static inline struct scc_channel *scc_net_seq_idx(loff_t pos)
1971 {
1972         int k;
1973
1974         for (k = 0; k < Nchips*2; ++k) {
1975                 if (!SCC_Info[k].init) 
1976                         continue;
1977                 if (pos-- == 0)
1978                         return &SCC_Info[k];
1979         }
1980         return NULL;
1981 }
1982
1983 static void *scc_net_seq_start(struct seq_file *seq, loff_t *pos)
1984 {
1985         return *pos ? scc_net_seq_idx(*pos - 1) : SEQ_START_TOKEN;
1986         
1987 }
1988
1989 static void *scc_net_seq_next(struct seq_file *seq, void *v, loff_t *pos)
1990 {
1991         unsigned k;
1992         struct scc_channel *scc = v;
1993         ++*pos;
1994         
1995         for (k = (v == SEQ_START_TOKEN) ? 0 : (scc - SCC_Info)+1;
1996              k < Nchips*2; ++k) {
1997                 if (SCC_Info[k].init) 
1998                         return &SCC_Info[k];
1999         }
2000         return NULL;
2001 }
2002
2003 static void scc_net_seq_stop(struct seq_file *seq, void *v)
2004 {
2005 }
2006
2007 static int scc_net_seq_show(struct seq_file *seq, void *v)
2008 {
2009         if (v == SEQ_START_TOKEN) {
2010                 seq_puts(seq, "z8530drv-"VERSION"\n");
2011         } else if (!Driver_Initialized) {
2012                 seq_puts(seq, "not initialized\n");
2013         } else if (!Nchips) {
2014                 seq_puts(seq, "chips missing\n");
2015         } else {
2016                 const struct scc_channel *scc = v;
2017                 const struct scc_stat *stat = &scc->stat;
2018                 const struct scc_kiss *kiss = &scc->kiss;
2019
2020
2021                 /* dev  data ctrl irq clock brand enh vector special option 
2022                  *      baud nrz clocksrc softdcd bufsize
2023                  *      rxints txints exints spints
2024                  *      rcvd rxerrs over / xmit txerrs under / nospace bufsize
2025                  *      txd pers slot tail ful wait min maxk idl defr txof grp
2026                  *      W ## ## ## ## ## ## ## ## ## ## ## ## ## ## ## ##
2027                  *      R ## ## XX ## ## ## ## ## XX ## ## ## ## ## ## ##
2028                  */
2029
2030                 seq_printf(seq, "%s\t%3.3lx %3.3lx %d %lu %2.2x %d %3.3lx %3.3lx %d\n",
2031                                 scc->dev->name,
2032                                 scc->data, scc->ctrl, scc->irq, scc->clock, scc->brand,
2033                                 scc->enhanced, Vector_Latch, scc->special,
2034                                 scc->option);
2035                 seq_printf(seq, "\t%lu %d %d %d %d\n",
2036                                 scc->modem.speed, scc->modem.nrz,
2037                                 scc->modem.clocksrc, kiss->softdcd,
2038                                 stat->bufsize);
2039                 seq_printf(seq, "\t%lu %lu %lu %lu\n",
2040                                 stat->rxints, stat->txints, stat->exints, stat->spints);
2041                 seq_printf(seq, "\t%lu %lu %d / %lu %lu %d / %d %d\n",
2042                                 stat->rxframes, stat->rxerrs, stat->rx_over,
2043                                 stat->txframes, stat->txerrs, stat->tx_under,
2044                                 stat->nospace,  stat->tx_state);
2045
2046 #define K(x) kiss->x
2047                 seq_printf(seq, "\t%d %d %d %d %d %d %d %d %d %d %d %d\n",
2048                                 K(txdelay), K(persist), K(slottime), K(tailtime),
2049                                 K(fulldup), K(waittime), K(mintime), K(maxkeyup),
2050                                 K(idletime), K(maxdefer), K(tx_inhibit), K(group));
2051 #undef K
2052 #ifdef SCC_DEBUG
2053                 {
2054                         int reg;
2055
2056                 seq_printf(seq, "\tW ");
2057                         for (reg = 0; reg < 16; reg++)
2058                                 seq_printf(seq, "%2.2x ", scc->wreg[reg]);
2059                         seq_printf(seq, "\n");
2060                         
2061                 seq_printf(seq, "\tR %2.2x %2.2x XX ", InReg(scc->ctrl,R0), InReg(scc->ctrl,R1));
2062                         for (reg = 3; reg < 8; reg++)
2063                                 seq_printf(seq, "%2.2x ", InReg(scc->ctrl, reg));
2064                         seq_printf(seq, "XX ");
2065                         for (reg = 9; reg < 16; reg++)
2066                                 seq_printf(seq, "%2.2x ", InReg(scc->ctrl, reg));
2067                         seq_printf(seq, "\n");
2068                 }
2069 #endif
2070                 seq_putc(seq, '\n');
2071         }
2072
2073         return 0;
2074 }
2075
2076 static struct seq_operations scc_net_seq_ops = {
2077         .start  = scc_net_seq_start,
2078         .next   = scc_net_seq_next,
2079         .stop   = scc_net_seq_stop,
2080         .show   = scc_net_seq_show,
2081 };
2082
2083
2084 static int scc_net_seq_open(struct inode *inode, struct file *file)
2085 {
2086         return seq_open(file, &scc_net_seq_ops);
2087 }
2088
2089 static const struct file_operations scc_net_seq_fops = {
2090         .owner   = THIS_MODULE,
2091         .open    = scc_net_seq_open,
2092         .read    = seq_read,
2093         .llseek  = seq_lseek,
2094         .release = seq_release_private,
2095 };
2096
2097 #endif /* CONFIG_PROC_FS */
2098
2099  
2100 /* ******************************************************************** */
2101 /* *                    Init SCC driver                               * */
2102 /* ******************************************************************** */
2103
2104 static int __init scc_init_driver (void)
2105 {
2106         char devname[IFNAMSIZ];
2107         
2108         printk(banner);
2109         
2110         sprintf(devname,"%s0", SCC_DriverName);
2111         
2112         rtnl_lock();
2113         if (scc_net_alloc(devname, SCC_Info)) {
2114                 rtnl_unlock();
2115                 printk(KERN_ERR "z8530drv: cannot initialize module\n");
2116                 return -EIO;
2117         }
2118         rtnl_unlock();
2119
2120         proc_net_fops_create(&init_net, "z8530drv", 0, &scc_net_seq_fops);
2121
2122         return 0;
2123 }
2124
2125 static void __exit scc_cleanup_driver(void)
2126 {
2127         io_port ctrl;
2128         int k;
2129         struct scc_channel *scc;
2130         struct net_device *dev;
2131         
2132         if (Nchips == 0 && (dev = SCC_Info[0].dev)) 
2133         {
2134                 unregister_netdev(dev);
2135                 free_netdev(dev);
2136         }
2137
2138         /* Guard against chip prattle */
2139         local_irq_disable();
2140         
2141         for (k = 0; k < Nchips; k++)
2142                 if ( (ctrl = SCC_ctrl[k].chan_A) )
2143                 {
2144                         Outb(ctrl, 0);
2145                         OutReg(ctrl,R9,FHWRES); /* force hardware reset */
2146                         udelay(50);
2147                 }
2148                 
2149         /* To unload the port must be closed so no real IRQ pending */
2150         for (k = 0; k < nr_irqs ; k++)
2151                 if (Ivec[k].used) free_irq(k, NULL);
2152                 
2153         local_irq_enable();
2154                 
2155         /* Now clean up */
2156         for (k = 0; k < Nchips*2; k++)
2157         {
2158                 scc = &SCC_Info[k];
2159                 if (scc->ctrl)
2160                 {
2161                         release_region(scc->ctrl, 1);
2162                         release_region(scc->data, 1);
2163                 }
2164                 if (scc->dev)
2165                 {
2166                         unregister_netdev(scc->dev);
2167                         free_netdev(scc->dev);
2168                 }
2169         }
2170         
2171                 
2172         if (Vector_Latch)
2173                 release_region(Vector_Latch, 1);
2174
2175         proc_net_remove(&init_net, "z8530drv");
2176 }
2177
2178 MODULE_AUTHOR("Joerg Reuter <jreuter@yaina.de>");
2179 MODULE_DESCRIPTION("AX.25 Device Driver for Z8530 based HDLC cards");
2180 MODULE_SUPPORTED_DEVICE("Z8530 based SCC cards for Amateur Radio");
2181 MODULE_LICENSE("GPL");
2182 module_init(scc_init_driver);
2183 module_exit(scc_cleanup_driver);