linux/drivers/net/hamradio/scc.c
<<
>>
Prefs
   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/delay.h>
 162#include <linux/skbuff.h>
 163#include <linux/netdevice.h>
 164#include <linux/rtnetlink.h>
 165#include <linux/if_ether.h>
 166#include <linux/if_arp.h>
 167#include <linux/socket.h>
 168#include <linux/init.h>
 169#include <linux/scc.h>
 170#include <linux/ctype.h>
 171#include <linux/kernel.h>
 172#include <linux/proc_fs.h>
 173#include <linux/seq_file.h>
 174#include <linux/bitops.h>
 175
 176#include <net/net_namespace.h>
 177#include <net/ax25.h>
 178
 179#include <asm/irq.h>
 180#include <asm/io.h>
 181#include <asm/uaccess.h>
 182
 183#include "z8530.h"
 184
 185static const char banner[] __initconst = KERN_INFO \
 186        "AX.25: Z8530 SCC driver version "VERSION".dl1bke\n";
 187
 188static void t_dwait(unsigned long);
 189static void t_txdelay(unsigned long);
 190static void t_tail(unsigned long);
 191static void t_busy(unsigned long);
 192static void t_maxkeyup(unsigned long);
 193static void t_idle(unsigned long);
 194static void scc_tx_done(struct scc_channel *);
 195static void scc_start_tx_timer(struct scc_channel *, void (*)(unsigned long), unsigned long);
 196static void scc_start_maxkeyup(struct scc_channel *);
 197static void scc_start_defer(struct scc_channel *);
 198
 199static void z8530_init(void);
 200
 201static void init_channel(struct scc_channel *scc);
 202static void scc_key_trx (struct scc_channel *scc, char tx);
 203static void scc_init_timer(struct scc_channel *scc);
 204
 205static int scc_net_alloc(const char *name, struct scc_channel *scc);
 206static void scc_net_setup(struct net_device *dev);
 207static int scc_net_open(struct net_device *dev);
 208static int scc_net_close(struct net_device *dev);
 209static void scc_net_rx(struct scc_channel *scc, struct sk_buff *skb);
 210static netdev_tx_t scc_net_tx(struct sk_buff *skb,
 211                              struct net_device *dev);
 212static int scc_net_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd);
 213static int scc_net_set_mac_address(struct net_device *dev, void *addr);
 214static struct net_device_stats * scc_net_get_stats(struct net_device *dev);
 215
 216static unsigned char SCC_DriverName[] = "scc";
 217
 218static struct irqflags { unsigned char used : 1; } Ivec[NR_IRQS];
 219        
 220static struct scc_channel SCC_Info[2 * SCC_MAXCHIPS];   /* information per channel */
 221
 222static struct scc_ctrl {
 223        io_port chan_A;
 224        io_port chan_B;
 225        int irq;
 226} SCC_ctrl[SCC_MAXCHIPS+1];
 227
 228static unsigned char Driver_Initialized;
 229static int Nchips;
 230static 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
 239static DEFINE_SPINLOCK(iolock); /* Guards paired accesses */
 240
 241static 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
 260static 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
 275static 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
 281static 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
 286static 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
 295static 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
 321static 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
 340static 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
 355static 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 */
 366static 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 */
 430static 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 */
 515static 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 */
 563static 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
 609static 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
 629static 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
 718static 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
 726static 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
 740static 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 
 792static 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
 898static 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
 995static 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
1012static 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
1021static 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
1038static 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
1060static 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,
1072                                                   scc->kiss.idletime*100);
1073                        break;
1074                case KISS_DUPLEX_OPTIMA:
1075                        scc_notify(scc, HWEV_ALL_SENT);
1076                        break;
1077                default:
1078                        scc->stat.tx_state = TXS_BUSY;
1079                        scc_start_tx_timer(scc, t_tail, scc->kiss.tailtime);
1080        }
1081
1082        netif_wake_queue(scc->dev);
1083}
1084
1085
1086static unsigned char Rand = 17;
1087
1088static inline int is_grouped(struct scc_channel *scc)
1089{
1090        int k;
1091        struct scc_channel *scc2;
1092        unsigned char grp1, grp2;
1093
1094        grp1 = scc->kiss.group;
1095        
1096        for (k = 0; k < (Nchips * 2); k++)
1097        {
1098                scc2 = &SCC_Info[k];
1099                grp2 = scc2->kiss.group;
1100                
1101                if (scc2 == scc || !(scc2->dev && grp2))
1102                        continue;
1103                
1104                if ((grp1 & 0x3f) == (grp2 & 0x3f))
1105                {
1106                        if ( (grp1 & TXGROUP) && (scc2->wreg[R5] & RTS) )
1107                                return 1;
1108                        
1109                        if ( (grp1 & RXGROUP) && scc2->dcd )
1110                                return 1;
1111                }
1112        }
1113        return 0;
1114}
1115
1116/* DWAIT and SLOTTIME expired
1117 *
1118 * fulldup == 0:  DCD is active or Rand > P-persistence: start t_busy timer
1119 *                else key trx and start txdelay
1120 * fulldup == 1:  key trx and start txdelay
1121 * fulldup == 2:  mintime expired, reset status or key trx and start txdelay
1122 */
1123
1124static void t_dwait(unsigned long channel)
1125{
1126        struct scc_channel *scc = (struct scc_channel *) channel;
1127        
1128        if (scc->stat.tx_state == TXS_WAIT)     /* maxkeyup or idle timeout */
1129        {
1130                if (skb_queue_empty(&scc->tx_queue)) {  /* nothing to send */
1131                        scc->stat.tx_state = TXS_IDLE;
1132                        netif_wake_queue(scc->dev);     /* t_maxkeyup locked it. */
1133                        return;
1134                }
1135
1136                scc->stat.tx_state = TXS_BUSY;
1137        }
1138
1139        if (scc->kiss.fulldup == KISS_DUPLEX_HALF)
1140        {
1141                Rand = Rand * 17 + 31;
1142                
1143                if (scc->dcd || (scc->kiss.persist) < Rand || (scc->kiss.group && is_grouped(scc)) )
1144                {
1145                        scc_start_defer(scc);
1146                        scc_start_tx_timer(scc, t_dwait, scc->kiss.slottime);
1147                        return ;
1148                }
1149        }
1150
1151        if ( !(scc->wreg[R5] & RTS) )
1152        {
1153                scc_key_trx(scc, TX_ON);
1154                scc_start_tx_timer(scc, t_txdelay, scc->kiss.txdelay);
1155        } else {
1156                scc_start_tx_timer(scc, t_txdelay, 0);
1157        }
1158}
1159
1160
1161/* TXDELAY expired
1162 *
1163 * kick transmission by a fake scc_txint(scc), start 'maxkeyup' watchdog.
1164 */
1165
1166static void t_txdelay(unsigned long channel)
1167{
1168        struct scc_channel *scc = (struct scc_channel *) channel;
1169
1170        scc_start_maxkeyup(scc);
1171
1172        if (scc->tx_buff == NULL)
1173        {
1174                disable_irq(scc->irq);
1175                scc_txint(scc); 
1176                enable_irq(scc->irq);
1177        }
1178}
1179        
1180
1181/* TAILTIME expired
1182 *
1183 * switch off transmitter. If we were stopped by Maxkeyup restart
1184 * transmission after 'mintime' seconds
1185 */
1186
1187static void t_tail(unsigned long channel)
1188{
1189        struct scc_channel *scc = (struct scc_channel *) channel;
1190        unsigned long flags;
1191        
1192        spin_lock_irqsave(&scc->lock, flags); 
1193        del_timer(&scc->tx_wdog);       
1194        scc_key_trx(scc, TX_OFF);
1195        spin_unlock_irqrestore(&scc->lock, flags);
1196
1197        if (scc->stat.tx_state == TXS_TIMEOUT)          /* we had a timeout? */
1198        {
1199                scc->stat.tx_state = TXS_WAIT;
1200                scc_start_tx_timer(scc, t_dwait, scc->kiss.mintime*100);
1201                return;
1202        }
1203        
1204        scc->stat.tx_state = TXS_IDLE;
1205        netif_wake_queue(scc->dev);
1206}
1207
1208
1209/* BUSY timeout
1210 *
1211 * throw away send buffers if DCD remains active too long.
1212 */
1213
1214static void t_busy(unsigned long channel)
1215{
1216        struct scc_channel *scc = (struct scc_channel *) channel;
1217
1218        del_timer(&scc->tx_t);
1219        netif_stop_queue(scc->dev);     /* don't pile on the wabbit! */
1220
1221        scc_discard_buffers(scc);
1222        scc->stat.txerrs++;
1223        scc->stat.tx_state = TXS_IDLE;
1224
1225        netif_wake_queue(scc->dev);     
1226}
1227
1228/* MAXKEYUP timeout
1229 *
1230 * this is our watchdog.
1231 */
1232
1233static void t_maxkeyup(unsigned long channel)
1234{
1235        struct scc_channel *scc = (struct scc_channel *) channel;
1236        unsigned long flags;
1237
1238        spin_lock_irqsave(&scc->lock, flags);
1239        /* 
1240         * let things settle down before we start to
1241         * accept new data.
1242         */
1243
1244        netif_stop_queue(scc->dev);
1245        scc_discard_buffers(scc);
1246
1247        del_timer(&scc->tx_t);
1248
1249        cl(scc, R1, TxINT_ENAB);        /* force an ABORT, but don't */
1250        cl(scc, R15, TxUIE);            /* count it. */
1251        OutReg(scc->ctrl, R0, RES_Tx_P);
1252
1253        spin_unlock_irqrestore(&scc->lock, flags);
1254
1255        scc->stat.txerrs++;
1256        scc->stat.tx_state = TXS_TIMEOUT;
1257        scc_start_tx_timer(scc, t_tail, scc->kiss.tailtime);
1258}
1259
1260/* IDLE timeout
1261 *
1262 * in fulldup mode 2 it keys down the transmitter after 'idle' seconds
1263 * of inactivity. We will not restart transmission before 'mintime'
1264 * expires.
1265 */
1266
1267static void t_idle(unsigned long channel)
1268{
1269        struct scc_channel *scc = (struct scc_channel *) channel;
1270        
1271        del_timer(&scc->tx_wdog);
1272
1273        scc_key_trx(scc, TX_OFF);
1274        if(scc->kiss.mintime)
1275                scc_start_tx_timer(scc, t_dwait, scc->kiss.mintime*100);
1276        scc->stat.tx_state = TXS_WAIT;
1277}
1278
1279static void scc_init_timer(struct scc_channel *scc)
1280{
1281        unsigned long flags;
1282
1283        spin_lock_irqsave(&scc->lock, flags);   
1284        scc->stat.tx_state = TXS_IDLE;
1285        spin_unlock_irqrestore(&scc->lock, flags);
1286}
1287
1288
1289/* ******************************************************************** */
1290/* *                    Set/get L1 parameters                         * */
1291/* ******************************************************************** */
1292
1293
1294/*
1295 * this will set the "hardware" parameters through KISS commands or ioctl()
1296 */
1297
1298#define CAST(x) (unsigned long)(x)
1299
1300static unsigned int scc_set_param(struct scc_channel *scc, unsigned int cmd, unsigned int arg)
1301{
1302        switch (cmd)
1303        {
1304                case PARAM_TXDELAY:     scc->kiss.txdelay=arg;          break;
1305                case PARAM_PERSIST:     scc->kiss.persist=arg;          break;
1306                case PARAM_SLOTTIME:    scc->kiss.slottime=arg;         break;
1307                case PARAM_TXTAIL:      scc->kiss.tailtime=arg;         break;
1308                case PARAM_FULLDUP:     scc->kiss.fulldup=arg;          break;
1309                case PARAM_DTR:         break; /* does someone need this? */
1310                case PARAM_GROUP:       scc->kiss.group=arg;            break;
1311                case PARAM_IDLE:        scc->kiss.idletime=arg;         break;
1312                case PARAM_MIN:         scc->kiss.mintime=arg;          break;
1313                case PARAM_MAXKEY:      scc->kiss.maxkeyup=arg;         break;
1314                case PARAM_WAIT:        scc->kiss.waittime=arg;         break;
1315                case PARAM_MAXDEFER:    scc->kiss.maxdefer=arg;         break;
1316                case PARAM_TX:          scc->kiss.tx_inhibit=arg;       break;
1317
1318                case PARAM_SOFTDCD:     
1319                        scc->kiss.softdcd=arg;
1320                        if (arg)
1321                        {
1322                                or(scc, R15, SYNCIE);
1323                                cl(scc, R15, DCDIE);
1324                                start_hunt(scc);
1325                        } else {
1326                                or(scc, R15, DCDIE);
1327                                cl(scc, R15, SYNCIE);
1328                        }
1329                        break;
1330                                
1331                case PARAM_SPEED:
1332                        if (arg < 256)
1333                                scc->modem.speed=arg*100;
1334                        else
1335                                scc->modem.speed=arg;
1336
1337                        if (scc->stat.tx_state == 0)    /* only switch baudrate on rx... ;-) */
1338                                set_speed(scc);
1339                        break;
1340                        
1341                case PARAM_RTS: 
1342                        if ( !(scc->wreg[R5] & RTS) )
1343                        {
1344                                if (arg != TX_OFF) {
1345                                        scc_key_trx(scc, TX_ON);
1346                                        scc_start_tx_timer(scc, t_txdelay, scc->kiss.txdelay);
1347                                }
1348                        } else {
1349                                if (arg == TX_OFF)
1350                                {
1351                                        scc->stat.tx_state = TXS_BUSY;
1352                                        scc_start_tx_timer(scc, t_tail, scc->kiss.tailtime);
1353                                }
1354                        }
1355                        break;
1356                        
1357                case PARAM_HWEVENT:
1358                        scc_notify(scc, scc->dcd? HWEV_DCD_ON:HWEV_DCD_OFF);
1359                        break;
1360
1361                default:                return -EINVAL;
1362        }
1363        
1364        return 0;
1365}
1366
1367
1368 
1369static unsigned long scc_get_param(struct scc_channel *scc, unsigned int cmd)
1370{
1371        switch (cmd)
1372        {
1373                case PARAM_TXDELAY:     return CAST(scc->kiss.txdelay);
1374                case PARAM_PERSIST:     return CAST(scc->kiss.persist);
1375                case PARAM_SLOTTIME:    return CAST(scc->kiss.slottime);
1376                case PARAM_TXTAIL:      return CAST(scc->kiss.tailtime);
1377                case PARAM_FULLDUP:     return CAST(scc->kiss.fulldup);
1378                case PARAM_SOFTDCD:     return CAST(scc->kiss.softdcd);
1379                case PARAM_DTR:         return CAST((scc->wreg[R5] & DTR)? 1:0);
1380                case PARAM_RTS:         return CAST((scc->wreg[R5] & RTS)? 1:0);
1381                case PARAM_SPEED:       return CAST(scc->modem.speed);
1382                case PARAM_GROUP:       return CAST(scc->kiss.group);
1383                case PARAM_IDLE:        return CAST(scc->kiss.idletime);
1384                case PARAM_MIN:         return CAST(scc->kiss.mintime);
1385                case PARAM_MAXKEY:      return CAST(scc->kiss.maxkeyup);
1386                case PARAM_WAIT:        return CAST(scc->kiss.waittime);
1387                case PARAM_MAXDEFER:    return CAST(scc->kiss.maxdefer);
1388                case PARAM_TX:          return CAST(scc->kiss.tx_inhibit);
1389                default:                return NO_SUCH_PARAM;
1390        }
1391
1392}
1393
1394#undef CAST
1395
1396/* ******************************************************************* */
1397/* *                    Send calibration pattern                     * */
1398/* ******************************************************************* */
1399
1400static void scc_stop_calibrate(unsigned long channel)
1401{
1402        struct scc_channel *scc = (struct scc_channel *) channel;
1403        unsigned long flags;
1404        
1405        spin_lock_irqsave(&scc->lock, flags);
1406        del_timer(&scc->tx_wdog);
1407        scc_key_trx(scc, TX_OFF);
1408        wr(scc, R6, 0);
1409        wr(scc, R7, FLAG);
1410        Outb(scc->ctrl,RES_EXT_INT);    /* reset ext/status interrupts */
1411        Outb(scc->ctrl,RES_EXT_INT);
1412
1413        netif_wake_queue(scc->dev);
1414        spin_unlock_irqrestore(&scc->lock, flags);
1415}
1416
1417
1418static void
1419scc_start_calibrate(struct scc_channel *scc, int duration, unsigned char pattern)
1420{
1421        unsigned long flags;
1422        
1423        spin_lock_irqsave(&scc->lock, flags);
1424        netif_stop_queue(scc->dev);
1425        scc_discard_buffers(scc);
1426
1427        del_timer(&scc->tx_wdog);
1428
1429        scc->tx_wdog.data = (unsigned long) scc;
1430        scc->tx_wdog.function = scc_stop_calibrate;
1431        scc->tx_wdog.expires = jiffies + HZ*duration;
1432        add_timer(&scc->tx_wdog);
1433
1434        /* This doesn't seem to work. Why not? */       
1435        wr(scc, R6, 0);
1436        wr(scc, R7, pattern);
1437
1438        /* 
1439         * Don't know if this works. 
1440         * Damn, where is my Z8530 programming manual...? 
1441         */
1442
1443        Outb(scc->ctrl,RES_EXT_INT);    /* reset ext/status interrupts */
1444        Outb(scc->ctrl,RES_EXT_INT);
1445
1446        scc_key_trx(scc, TX_ON);
1447        spin_unlock_irqrestore(&scc->lock, flags);
1448}
1449
1450/* ******************************************************************* */
1451/* *            Init channel structures, special HW, etc...          * */
1452/* ******************************************************************* */
1453
1454/*
1455 * Reset the Z8530s and setup special hardware
1456 */
1457
1458static void z8530_init(void)
1459{
1460        struct scc_channel *scc;
1461        int chip, k;
1462        unsigned long flags;
1463        char *flag;
1464
1465
1466        printk(KERN_INFO "Init Z8530 driver: %u channels, IRQ", Nchips*2);
1467        
1468        flag=" ";
1469        for (k = 0; k < nr_irqs; k++)
1470                if (Ivec[k].used) 
1471                {
1472                        printk("%s%d", flag, k);
1473                        flag=",";
1474                }
1475        printk("\n");
1476
1477
1478        /* reset and pre-init all chips in the system */
1479        for (chip = 0; chip < Nchips; chip++)
1480        {
1481                scc=&SCC_Info[2*chip];
1482                if (!scc->ctrl) continue;
1483
1484                /* Special SCC cards */
1485
1486                if(scc->brand & EAGLE)                  /* this is an EAGLE card */
1487                        Outb(scc->special,0x08);        /* enable interrupt on the board */
1488                        
1489                if(scc->brand & (PC100 | PRIMUS))       /* this is a PC100/PRIMUS card */
1490                        Outb(scc->special,scc->option); /* set the MODEM mode (0x22) */
1491
1492                        
1493                /* Reset and pre-init Z8530 */
1494
1495                spin_lock_irqsave(&scc->lock, flags);
1496                                
1497                Outb(scc->ctrl, 0);
1498                OutReg(scc->ctrl,R9,FHWRES);            /* force hardware reset */
1499                udelay(100);                            /* give it 'a bit' more time than required */
1500                wr(scc, R2, chip*16);                   /* interrupt vector */
1501                wr(scc, R9, VIS);                       /* vector includes status */
1502                spin_unlock_irqrestore(&scc->lock, flags);              
1503        }
1504
1505 
1506        Driver_Initialized = 1;
1507}
1508
1509/*
1510 * Allocate device structure, err, instance, and register driver
1511 */
1512
1513static int scc_net_alloc(const char *name, struct scc_channel *scc)
1514{
1515        int err;
1516        struct net_device *dev;
1517
1518        dev = alloc_netdev(0, name, scc_net_setup);
1519        if (!dev) 
1520                return -ENOMEM;
1521
1522        dev->ml_priv = scc;
1523        scc->dev = dev;
1524        spin_lock_init(&scc->lock);
1525        init_timer(&scc->tx_t);
1526        init_timer(&scc->tx_wdog);
1527
1528        err = register_netdevice(dev);
1529        if (err) {
1530                printk(KERN_ERR "%s: can't register network device (%d)\n", 
1531                       name, err);
1532                free_netdev(dev);
1533                scc->dev = NULL;
1534                return err;
1535        }
1536
1537        return 0;
1538}
1539
1540
1541
1542/* ******************************************************************** */
1543/* *                        Network driver methods                    * */
1544/* ******************************************************************** */
1545
1546static const struct net_device_ops scc_netdev_ops = {
1547        .ndo_open            = scc_net_open,
1548        .ndo_stop            = scc_net_close,
1549        .ndo_start_xmit      = scc_net_tx,
1550        .ndo_set_mac_address = scc_net_set_mac_address,
1551        .ndo_get_stats       = scc_net_get_stats,
1552        .ndo_do_ioctl        = scc_net_ioctl,
1553};
1554
1555/* ----> Initialize device <----- */
1556
1557static void scc_net_setup(struct net_device *dev)
1558{
1559        dev->tx_queue_len    = 16;      /* should be enough... */
1560
1561        dev->netdev_ops      = &scc_netdev_ops;
1562        dev->header_ops      = &ax25_header_ops;
1563
1564        memcpy(dev->broadcast, &ax25_bcast,  AX25_ADDR_LEN);
1565        memcpy(dev->dev_addr,  &ax25_defaddr, AX25_ADDR_LEN);
1566 
1567        dev->flags      = 0;
1568
1569        dev->type = ARPHRD_AX25;
1570        dev->hard_header_len = AX25_MAX_HEADER_LEN + AX25_BPQ_HEADER_LEN;
1571        dev->mtu = AX25_DEF_PACLEN;
1572        dev->addr_len = AX25_ADDR_LEN;
1573
1574}
1575
1576/* ----> open network device <---- */
1577
1578static int scc_net_open(struct net_device *dev)
1579{
1580        struct scc_channel *scc = (struct scc_channel *) dev->ml_priv;
1581
1582        if (!scc->init)
1583                return -EINVAL;
1584
1585        scc->tx_buff = NULL;
1586        skb_queue_head_init(&scc->tx_queue);
1587 
1588        init_channel(scc);
1589
1590        netif_start_queue(dev);
1591        return 0;
1592}
1593
1594/* ----> close network device <---- */
1595
1596static int scc_net_close(struct net_device *dev)
1597{
1598        struct scc_channel *scc = (struct scc_channel *) dev->ml_priv;
1599        unsigned long flags;
1600
1601        netif_stop_queue(dev);
1602
1603        spin_lock_irqsave(&scc->lock, flags);   
1604        Outb(scc->ctrl,0);              /* Make sure pointer is written */
1605        wr(scc,R1,0);                   /* disable interrupts */
1606        wr(scc,R3,0);
1607        spin_unlock_irqrestore(&scc->lock, flags);
1608
1609        del_timer_sync(&scc->tx_t);
1610        del_timer_sync(&scc->tx_wdog);
1611        
1612        scc_discard_buffers(scc);
1613
1614        return 0;
1615}
1616
1617/* ----> receive frame, called from scc_rxint() <---- */
1618
1619static void scc_net_rx(struct scc_channel *scc, struct sk_buff *skb)
1620{
1621        if (skb->len == 0) {
1622                dev_kfree_skb_irq(skb);
1623                return;
1624        }
1625                
1626        scc->dev_stat.rx_packets++;
1627        scc->dev_stat.rx_bytes += skb->len;
1628
1629        skb->protocol = ax25_type_trans(skb, scc->dev);
1630        
1631        netif_rx(skb);
1632}
1633
1634/* ----> transmit frame <---- */
1635
1636static netdev_tx_t scc_net_tx(struct sk_buff *skb, struct net_device *dev)
1637{
1638        struct scc_channel *scc = (struct scc_channel *) dev->ml_priv;
1639        unsigned long flags;
1640        char kisscmd;
1641
1642        if (skb->len > scc->stat.bufsize || skb->len < 2) {
1643                scc->dev_stat.tx_dropped++;     /* bogus frame */
1644                dev_kfree_skb(skb);
1645                return NETDEV_TX_OK;
1646        }
1647        
1648        scc->dev_stat.tx_packets++;
1649        scc->dev_stat.tx_bytes += skb->len;
1650        scc->stat.txframes++;
1651        
1652        kisscmd = *skb->data & 0x1f;
1653        skb_pull(skb, 1);
1654
1655        if (kisscmd) {
1656                scc_set_param(scc, kisscmd, *skb->data);
1657                dev_kfree_skb(skb);
1658                return NETDEV_TX_OK;
1659        }
1660
1661        spin_lock_irqsave(&scc->lock, flags);
1662                
1663        if (skb_queue_len(&scc->tx_queue) > scc->dev->tx_queue_len) {
1664                struct sk_buff *skb_del;
1665                skb_del = skb_dequeue(&scc->tx_queue);
1666                dev_kfree_skb(skb_del);
1667        }
1668        skb_queue_tail(&scc->tx_queue, skb);
1669        netif_trans_update(dev);
1670        
1671
1672        /*
1673         * Start transmission if the trx state is idle or
1674         * t_idle hasn't expired yet. Use dwait/persistence/slottime
1675         * algorithm for normal halfduplex operation.
1676         */
1677
1678        if(scc->stat.tx_state == TXS_IDLE || scc->stat.tx_state == TXS_IDLE2) {
1679                scc->stat.tx_state = TXS_BUSY;
1680                if (scc->kiss.fulldup == KISS_DUPLEX_HALF)
1681                        __scc_start_tx_timer(scc, t_dwait, scc->kiss.waittime);
1682                else
1683                        __scc_start_tx_timer(scc, t_dwait, 0);
1684        }
1685        spin_unlock_irqrestore(&scc->lock, flags);
1686        return NETDEV_TX_OK;
1687}
1688
1689/* ----> ioctl functions <---- */
1690
1691/*
1692 * SIOCSCCCFG           - configure driver      arg: (struct scc_hw_config *) arg
1693 * SIOCSCCINI           - initialize driver     arg: ---
1694 * SIOCSCCCHANINI       - initialize channel    arg: (struct scc_modem *) arg
1695 * SIOCSCCSMEM          - set memory            arg: (struct scc_mem_config *) arg
1696 * SIOCSCCGKISS         - get level 1 parameter arg: (struct scc_kiss_cmd *) arg
1697 * SIOCSCCSKISS         - set level 1 parameter arg: (struct scc_kiss_cmd *) arg
1698 * SIOCSCCGSTAT         - get driver status     arg: (struct scc_stat *) arg
1699 * SIOCSCCCAL           - send calib. pattern   arg: (struct scc_calibrate *) arg
1700 */
1701
1702static int scc_net_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
1703{
1704        struct scc_kiss_cmd kiss_cmd;
1705        struct scc_mem_config memcfg;
1706        struct scc_hw_config hwcfg;
1707        struct scc_calibrate cal;
1708        struct scc_channel *scc = (struct scc_channel *) dev->ml_priv;
1709        int chan;
1710        unsigned char device_name[IFNAMSIZ];
1711        void __user *arg = ifr->ifr_data;
1712        
1713        
1714        if (!Driver_Initialized)
1715        {
1716                if (cmd == SIOCSCCCFG)
1717                {
1718                        int found = 1;
1719
1720                        if (!capable(CAP_SYS_RAWIO)) return -EPERM;
1721                        if (!arg) return -EFAULT;
1722
1723                        if (Nchips >= SCC_MAXCHIPS) 
1724                                return -EINVAL;
1725
1726                        if (copy_from_user(&hwcfg, arg, sizeof(hwcfg)))
1727                                return -EFAULT;
1728
1729                        if (hwcfg.irq == 2) hwcfg.irq = 9;
1730
1731                        if (hwcfg.irq < 0 || hwcfg.irq >= nr_irqs)
1732                                return -EINVAL;
1733                                
1734                        if (!Ivec[hwcfg.irq].used && hwcfg.irq)
1735                        {
1736                                if (request_irq(hwcfg.irq, scc_isr,
1737                                                IRQF_DISABLED, "AX.25 SCC",
1738                                                (void *)(long) hwcfg.irq))
1739                                        printk(KERN_WARNING "z8530drv: warning, cannot get IRQ %d\n", hwcfg.irq);
1740                                else
1741                                        Ivec[hwcfg.irq].used = 1;
1742                        }
1743
1744                        if (hwcfg.vector_latch && !Vector_Latch) {
1745                                if (!request_region(hwcfg.vector_latch, 1, "scc vector latch"))
1746                                        printk(KERN_WARNING "z8530drv: warning, cannot reserve vector latch port 0x%lx\n, disabled.", hwcfg.vector_latch);
1747                                else
1748                                        Vector_Latch = hwcfg.vector_latch;
1749                        }
1750
1751                        if (hwcfg.clock == 0)
1752                                hwcfg.clock = SCC_DEFAULT_CLOCK;
1753
1754#ifndef SCC_DONT_CHECK
1755
1756                        if(request_region(hwcfg.ctrl_a, 1, "scc-probe"))
1757                        {
1758                                disable_irq(hwcfg.irq);
1759                                Outb(hwcfg.ctrl_a, 0);
1760                                OutReg(hwcfg.ctrl_a, R9, FHWRES);
1761                                udelay(100);
1762                                OutReg(hwcfg.ctrl_a,R13,0x55);          /* is this chip really there? */
1763                                udelay(5);
1764
1765                                if (InReg(hwcfg.ctrl_a,R13) != 0x55)
1766                                        found = 0;
1767                                enable_irq(hwcfg.irq);
1768                                release_region(hwcfg.ctrl_a, 1);
1769                        }
1770                        else
1771                                found = 0;
1772#endif
1773
1774                        if (found)
1775                        {
1776                                SCC_Info[2*Nchips  ].ctrl = hwcfg.ctrl_a;
1777                                SCC_Info[2*Nchips  ].data = hwcfg.data_a;
1778                                SCC_Info[2*Nchips  ].irq  = hwcfg.irq;
1779                                SCC_Info[2*Nchips+1].ctrl = hwcfg.ctrl_b;
1780                                SCC_Info[2*Nchips+1].data = hwcfg.data_b;
1781                                SCC_Info[2*Nchips+1].irq  = hwcfg.irq;
1782                        
1783                                SCC_ctrl[Nchips].chan_A = hwcfg.ctrl_a;
1784                                SCC_ctrl[Nchips].chan_B = hwcfg.ctrl_b;
1785                                SCC_ctrl[Nchips].irq    = hwcfg.irq;
1786                        }
1787
1788
1789                        for (chan = 0; chan < 2; chan++)
1790                        {
1791                                sprintf(device_name, "%s%i", SCC_DriverName, 2*Nchips+chan);
1792
1793                                SCC_Info[2*Nchips+chan].special = hwcfg.special;
1794                                SCC_Info[2*Nchips+chan].clock = hwcfg.clock;
1795                                SCC_Info[2*Nchips+chan].brand = hwcfg.brand;
1796                                SCC_Info[2*Nchips+chan].option = hwcfg.option;
1797                                SCC_Info[2*Nchips+chan].enhanced = hwcfg.escc;
1798
1799#ifdef SCC_DONT_CHECK
1800                                printk(KERN_INFO "%s: data port = 0x%3.3x  control port = 0x%3.3x\n",
1801                                        device_name, 
1802                                        SCC_Info[2*Nchips+chan].data, 
1803                                        SCC_Info[2*Nchips+chan].ctrl);
1804
1805#else
1806                                printk(KERN_INFO "%s: data port = 0x%3.3lx  control port = 0x%3.3lx -- %s\n",
1807                                        device_name,
1808                                        chan? hwcfg.data_b : hwcfg.data_a, 
1809                                        chan? hwcfg.ctrl_b : hwcfg.ctrl_a,
1810                                        found? "found" : "missing");
1811#endif
1812
1813                                if (found)
1814                                {
1815                                        request_region(SCC_Info[2*Nchips+chan].ctrl, 1, "scc ctrl");
1816                                        request_region(SCC_Info[2*Nchips+chan].data, 1, "scc data");
1817                                        if (Nchips+chan != 0 &&
1818                                            scc_net_alloc(device_name, 
1819                                                          &SCC_Info[2*Nchips+chan]))
1820                                            return -EINVAL;
1821                                }
1822                        }
1823                        
1824                        if (found) Nchips++;
1825                        
1826                        return 0;
1827                }
1828                
1829                if (cmd == SIOCSCCINI)
1830                {
1831                        if (!capable(CAP_SYS_RAWIO))
1832                                return -EPERM;
1833                                
1834                        if (Nchips == 0)
1835                                return -EINVAL;
1836
1837                        z8530_init();
1838                        return 0;
1839                }
1840                
1841                return -EINVAL; /* confuse the user */
1842        }
1843        
1844        if (!scc->init)
1845        {
1846                if (cmd == SIOCSCCCHANINI)
1847                {
1848                        if (!capable(CAP_NET_ADMIN)) return -EPERM;
1849                        if (!arg) return -EINVAL;
1850                        
1851                        scc->stat.bufsize   = SCC_BUFSIZE;
1852
1853                        if (copy_from_user(&scc->modem, arg, sizeof(struct scc_modem)))
1854                                return -EINVAL;
1855                        
1856                        /* default KISS Params */
1857                
1858                        if (scc->modem.speed < 4800)
1859                        {
1860                                scc->kiss.txdelay = 36;         /* 360 ms */
1861                                scc->kiss.persist = 42;         /* 25% persistence */                   /* was 25 */
1862                                scc->kiss.slottime = 16;        /* 160 ms */
1863                                scc->kiss.tailtime = 4;         /* minimal reasonable value */
1864                                scc->kiss.fulldup = 0;          /* CSMA */
1865                                scc->kiss.waittime = 50;        /* 500 ms */
1866                                scc->kiss.maxkeyup = 10;        /* 10 s */
1867                                scc->kiss.mintime = 3;          /* 3 s */
1868                                scc->kiss.idletime = 30;        /* 30 s */
1869                                scc->kiss.maxdefer = 120;       /* 2 min */
1870                                scc->kiss.softdcd = 0;          /* hardware dcd */
1871                        } else {
1872                                scc->kiss.txdelay = 10;         /* 100 ms */
1873                                scc->kiss.persist = 64;         /* 25% persistence */                   /* was 25 */
1874                                scc->kiss.slottime = 8;         /* 160 ms */
1875                                scc->kiss.tailtime = 1;         /* minimal reasonable value */
1876                                scc->kiss.fulldup = 0;          /* CSMA */
1877                                scc->kiss.waittime = 50;        /* 500 ms */
1878                                scc->kiss.maxkeyup = 7;         /* 7 s */
1879                                scc->kiss.mintime = 3;          /* 3 s */
1880                                scc->kiss.idletime = 30;        /* 30 s */
1881                                scc->kiss.maxdefer = 120;       /* 2 min */
1882                                scc->kiss.softdcd = 0;          /* hardware dcd */
1883                        }
1884                        
1885                        scc->tx_buff = NULL;
1886                        skb_queue_head_init(&scc->tx_queue);
1887                        scc->init = 1;
1888                        
1889                        return 0;
1890                }
1891                
1892                return -EINVAL;
1893        }
1894        
1895        switch(cmd)
1896        {
1897                case SIOCSCCRESERVED:
1898                        return -ENOIOCTLCMD;
1899
1900                case SIOCSCCSMEM:
1901                        if (!capable(CAP_SYS_RAWIO)) return -EPERM;
1902                        if (!arg || copy_from_user(&memcfg, arg, sizeof(memcfg)))
1903                                return -EINVAL;
1904                        scc->stat.bufsize   = memcfg.bufsize;
1905                        return 0;
1906                
1907                case SIOCSCCGSTAT:
1908                        if (!arg || copy_to_user(arg, &scc->stat, sizeof(scc->stat)))
1909                                return -EINVAL;
1910                        return 0;
1911                
1912                case SIOCSCCGKISS:
1913                        if (!arg || copy_from_user(&kiss_cmd, arg, sizeof(kiss_cmd)))
1914                                return -EINVAL;
1915                        kiss_cmd.param = scc_get_param(scc, kiss_cmd.command);
1916                        if (copy_to_user(arg, &kiss_cmd, sizeof(kiss_cmd)))
1917                                return -EINVAL;
1918                        return 0;
1919                
1920                case SIOCSCCSKISS:
1921                        if (!capable(CAP_NET_ADMIN)) return -EPERM;
1922                        if (!arg || copy_from_user(&kiss_cmd, arg, sizeof(kiss_cmd)))
1923                                return -EINVAL;
1924                        return scc_set_param(scc, kiss_cmd.command, kiss_cmd.param);
1925                
1926                case SIOCSCCCAL:
1927                        if (!capable(CAP_SYS_RAWIO)) return -EPERM;
1928                        if (!arg || copy_from_user(&cal, arg, sizeof(cal)) || cal.time == 0)
1929                                return -EINVAL;
1930
1931                        scc_start_calibrate(scc, cal.time, cal.pattern);
1932                        return 0;
1933
1934                default:
1935                        return -ENOIOCTLCMD;
1936                
1937        }
1938        
1939        return -EINVAL;
1940}
1941
1942/* ----> set interface callsign <---- */
1943
1944static int scc_net_set_mac_address(struct net_device *dev, void *addr)
1945{
1946        struct sockaddr *sa = (struct sockaddr *) addr;
1947        memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
1948        return 0;
1949}
1950
1951/* ----> get statistics <---- */
1952
1953static struct net_device_stats *scc_net_get_stats(struct net_device *dev)
1954{
1955        struct scc_channel *scc = (struct scc_channel *) dev->ml_priv;
1956        
1957        scc->dev_stat.rx_errors = scc->stat.rxerrs + scc->stat.rx_over;
1958        scc->dev_stat.tx_errors = scc->stat.txerrs + scc->stat.tx_under;
1959        scc->dev_stat.rx_fifo_errors = scc->stat.rx_over;
1960        scc->dev_stat.tx_fifo_errors = scc->stat.tx_under;
1961
1962        return &scc->dev_stat;
1963}
1964
1965/* ******************************************************************** */
1966/* *            dump statistics to /proc/net/z8530drv                 * */
1967/* ******************************************************************** */
1968
1969#ifdef CONFIG_PROC_FS
1970
1971static inline struct scc_channel *scc_net_seq_idx(loff_t pos)
1972{
1973        int k;
1974
1975        for (k = 0; k < Nchips*2; ++k) {
1976                if (!SCC_Info[k].init) 
1977                        continue;
1978                if (pos-- == 0)
1979                        return &SCC_Info[k];
1980        }
1981        return NULL;
1982}
1983
1984static void *scc_net_seq_start(struct seq_file *seq, loff_t *pos)
1985{
1986        return *pos ? scc_net_seq_idx(*pos - 1) : SEQ_START_TOKEN;
1987        
1988}
1989
1990static void *scc_net_seq_next(struct seq_file *seq, void *v, loff_t *pos)
1991{
1992        unsigned k;
1993        struct scc_channel *scc = v;
1994        ++*pos;
1995        
1996        for (k = (v == SEQ_START_TOKEN) ? 0 : (scc - SCC_Info)+1;
1997             k < Nchips*2; ++k) {
1998                if (SCC_Info[k].init) 
1999                        return &SCC_Info[k];
2000        }
2001        return NULL;
2002}
2003
2004static void scc_net_seq_stop(struct seq_file *seq, void *v)
2005{
2006}
2007
2008static int scc_net_seq_show(struct seq_file *seq, void *v)
2009{
2010        if (v == SEQ_START_TOKEN) {
2011                seq_puts(seq, "z8530drv-"VERSION"\n");
2012        } else if (!Driver_Initialized) {
2013                seq_puts(seq, "not initialized\n");
2014        } else if (!Nchips) {
2015                seq_puts(seq, "chips missing\n");
2016        } else {
2017                const struct scc_channel *scc = v;
2018                const struct scc_stat *stat = &scc->stat;
2019                const struct scc_kiss *kiss = &scc->kiss;
2020
2021
2022                /* dev  data ctrl irq clock brand enh vector special option 
2023                 *      baud nrz clocksrc softdcd bufsize
2024                 *      rxints txints exints spints
2025                 *      rcvd rxerrs over / xmit txerrs under / nospace bufsize
2026                 *      txd pers slot tail ful wait min maxk idl defr txof grp
2027                 *      W ## ## ## ## ## ## ## ## ## ## ## ## ## ## ## ##
2028                 *      R ## ## XX ## ## ## ## ## XX ## ## ## ## ## ## ##
2029                 */
2030
2031                seq_printf(seq, "%s\t%3.3lx %3.3lx %d %lu %2.2x %d %3.3lx %3.3lx %d\n",
2032                                scc->dev->name,
2033                                scc->data, scc->ctrl, scc->irq, scc->clock, scc->brand,
2034                                scc->enhanced, Vector_Latch, scc->special,
2035                                scc->option);
2036                seq_printf(seq, "\t%lu %d %d %d %d\n",
2037                                scc->modem.speed, scc->modem.nrz,
2038                                scc->modem.clocksrc, kiss->softdcd,
2039                                stat->bufsize);
2040                seq_printf(seq, "\t%lu %lu %lu %lu\n",
2041                                stat->rxints, stat->txints, stat->exints, stat->spints);
2042                seq_printf(seq, "\t%lu %lu %d / %lu %lu %d / %d %d\n",
2043                                stat->rxframes, stat->rxerrs, stat->rx_over,
2044                                stat->txframes, stat->txerrs, stat->tx_under,
2045                                stat->nospace,  stat->tx_state);
2046
2047#define K(x) kiss->x
2048                seq_printf(seq, "\t%d %d %d %d %d %d %d %d %d %d %d %d\n",
2049                                K(txdelay), K(persist), K(slottime), K(tailtime),
2050                                K(fulldup), K(waittime), K(mintime), K(maxkeyup),
2051                                K(idletime), K(maxdefer), K(tx_inhibit), K(group));
2052#undef K
2053#ifdef SCC_DEBUG
2054                {
2055                        int reg;
2056
2057                seq_printf(seq, "\tW ");
2058                        for (reg = 0; reg < 16; reg++)
2059                                seq_printf(seq, "%2.2x ", scc->wreg[reg]);
2060                        seq_printf(seq, "\n");
2061                        
2062                seq_printf(seq, "\tR %2.2x %2.2x XX ", InReg(scc->ctrl,R0), InReg(scc->ctrl,R1));
2063                        for (reg = 3; reg < 8; reg++)
2064                                seq_printf(seq, "%2.2x ", InReg(scc->ctrl, reg));
2065                        seq_printf(seq, "XX ");
2066                        for (reg = 9; reg < 16; reg++)
2067                                seq_printf(seq, "%2.2x ", InReg(scc->ctrl, reg));
2068                        seq_printf(seq, "\n");
2069                }
2070#endif
2071                seq_putc(seq, '\n');
2072        }
2073
2074        return 0;
2075}
2076
2077static const struct seq_operations scc_net_seq_ops = {
2078        .start  = scc_net_seq_start,
2079        .next   = scc_net_seq_next,
2080        .stop   = scc_net_seq_stop,
2081        .show   = scc_net_seq_show,
2082};
2083
2084
2085static int scc_net_seq_open(struct inode *inode, struct file *file)
2086{
2087        return seq_open(file, &scc_net_seq_ops);
2088}
2089
2090static const struct file_operations scc_net_seq_fops = {
2091        .owner   = THIS_MODULE,
2092        .open    = scc_net_seq_open,
2093        .read    = seq_read,
2094        .llseek  = seq_lseek,
2095        .release = seq_release_private,
2096};
2097
2098#endif /* CONFIG_PROC_FS */
2099
2100 
2101/* ******************************************************************** */
2102/* *                    Init SCC driver                               * */
2103/* ******************************************************************** */
2104
2105static int __init scc_init_driver (void)
2106{
2107        char devname[IFNAMSIZ];
2108        
2109        printk(banner);
2110        
2111        sprintf(devname,"%s0", SCC_DriverName);
2112        
2113        rtnl_lock();
2114        if (scc_net_alloc(devname, SCC_Info)) {
2115                rtnl_unlock();
2116                printk(KERN_ERR "z8530drv: cannot initialize module\n");
2117                return -EIO;
2118        }
2119        rtnl_unlock();
2120
2121        proc_create("z8530drv", 0, init_net.proc_net, &scc_net_seq_fops);
2122
2123        return 0;
2124}
2125
2126static void __exit scc_cleanup_driver(void)
2127{
2128        io_port ctrl;
2129        int k;
2130        struct scc_channel *scc;
2131        struct net_device *dev;
2132        
2133        if (Nchips == 0 && (dev = SCC_Info[0].dev)) 
2134        {
2135                unregister_netdev(dev);
2136                free_netdev(dev);
2137        }
2138
2139        /* Guard against chip prattle */
2140        local_irq_disable();
2141        
2142        for (k = 0; k < Nchips; k++)
2143                if ( (ctrl = SCC_ctrl[k].chan_A) )
2144                {
2145                        Outb(ctrl, 0);
2146                        OutReg(ctrl,R9,FHWRES); /* force hardware reset */
2147                        udelay(50);
2148                }
2149                
2150        /* To unload the port must be closed so no real IRQ pending */
2151        for (k = 0; k < nr_irqs ; k++)
2152                if (Ivec[k].used) free_irq(k, NULL);
2153                
2154        local_irq_enable();
2155                
2156        /* Now clean up */
2157        for (k = 0; k < Nchips*2; k++)
2158        {
2159                scc = &SCC_Info[k];
2160                if (scc->ctrl)
2161                {
2162                        release_region(scc->ctrl, 1);
2163                        release_region(scc->data, 1);
2164                }
2165                if (scc->dev)
2166                {
2167                        unregister_netdev(scc->dev);
2168                        free_netdev(scc->dev);
2169                }
2170        }
2171        
2172                
2173        if (Vector_Latch)
2174                release_region(Vector_Latch, 1);
2175
2176        remove_proc_entry("z8530drv", init_net.proc_net);
2177}
2178
2179MODULE_AUTHOR("Joerg Reuter <jreuter@yaina.de>");
2180MODULE_DESCRIPTION("AX.25 Device Driver for Z8530 based HDLC cards");
2181MODULE_SUPPORTED_DEVICE("Z8530 based SCC cards for Amateur Radio");
2182MODULE_LICENSE("GPL");
2183module_init(scc_init_driver);
2184module_exit(scc_cleanup_driver);
2185