| #define RCS_ID "$Id: scc.c,v 1.75 1998/11/04 15:15:01 jreuter Exp jreuter $" | |
| #define VERSION "3.0" | |
| /* | |
| * Please use z8530drv-utils-3.0 with this version. | |
| * ------------------ | |
| * | |
| * You can find a subset of the documentation in | |
| * Documentation/networking/z8530drv.txt. | |
| */ | |
| /* | |
| ******************************************************************** | |
| * SCC.C - Linux driver for Z8530 based HDLC cards for AX.25 * | |
| ******************************************************************** | |
| ******************************************************************** | |
| Copyright (c) 1993, 2000 Joerg Reuter DL1BKE | |
| portions (c) 1993 Guido ten Dolle PE1NNZ | |
| ******************************************************************** | |
| The driver and the programs in the archive are UNDER CONSTRUCTION. | |
| The code is likely to fail, and so your kernel could --- even | |
| a whole network. | |
| This driver is intended for Amateur Radio use. If you are running it | |
| for commercial purposes, please drop me a note. I am nosy... | |
| ...BUT: | |
| ! You m u s t recognize the appropriate legislations of your country ! | |
| ! before you connect a radio to the SCC board and start to transmit or ! | |
| ! receive. The GPL allows you to use the d r i v e r, NOT the RADIO! ! | |
| For non-Amateur-Radio use please note that you might need a special | |
| allowance/licence from the designer of the SCC Board and/or the | |
| MODEM. | |
| This program is free software; you can redistribute it and/or modify | |
| it under the terms of the (modified) GNU General Public License | |
| delivered with the Linux kernel source. | |
| This program is distributed in the hope that it will be useful, | |
| but WITHOUT ANY WARRANTY; without even the implied warranty of | |
| MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| GNU General Public License for more details. | |
| You should find a copy of the GNU General Public License in | |
| /usr/src/linux/COPYING; | |
| ******************************************************************** | |
| Incomplete history of z8530drv: | |
| ------------------------------- | |
| 1994-09-13 started to write the driver, rescued most of my own | |
| code (and Hans Alblas' memory buffer pool concept) from | |
| an earlier project "sccdrv" which was initiated by | |
| Guido ten Dolle. Not much of the old driver survived, | |
| though. The first version I put my hands on was sccdrv1.3 | |
| from August 1993. The memory buffer pool concept | |
| appeared in an unauthorized sccdrv version (1.5) from | |
| August 1994. | |
| 1995-01-31 changed copyright notice to GPL without limitations. | |
| . | |
| . <SNIP> | |
| . | |
| 1996-10-05 New semester, new driver... | |
| * KISS TNC emulator removed (TTY driver) | |
| * Source moved to drivers/net/ | |
| * Includes Z8530 defines from drivers/net/z8530.h | |
| * Uses sk_buffer memory management | |
| * Reduced overhead of /proc/net/z8530drv output | |
| * Streamlined quite a lot things | |
| * Invents brand new bugs... ;-) | |
| The move to version number 3.0 reflects theses changes. | |
| You can use 'kissbridge' if you need a KISS TNC emulator. | |
| 1996-12-13 Fixed for Linux networking changes. (G4KLX) | |
| 1997-01-08 Fixed the remaining problems. | |
| 1997-04-02 Hopefully fixed the problems with the new *_timer() | |
| routines, added calibration code. | |
| 1997-10-12 Made SCC_DELAY a CONFIG option, added CONFIG_SCC_TRXECHO | |
| 1998-01-29 Small fix to avoid lock-up on initialization | |
| 1998-09-29 Fixed the "grouping" bugs, tx_inhibit works again, | |
| using dev->tx_queue_len now instead of MAXQUEUE now. | |
| 1998-10-21 Postponed the spinlock changes, would need a lot of | |
| testing I currently don't have the time to. Softdcd doesn't | |
| work. | |
| 1998-11-04 Softdcd does not work correctly in DPLL mode, in fact it | |
| never did. The DPLL locks on noise, the SYNC unit sees | |
| flags that aren't... Restarting the DPLL does not help | |
| either, it resynchronizes too slow and the first received | |
| frame gets lost. | |
| 2000-02-13 Fixed for new network driver interface changes, still | |
| does TX timeouts itself since it uses its own queue | |
| scheme. | |
| Thanks to all who contributed to this driver with ideas and bug | |
| reports! | |
| NB -- if you find errors, change something, please let me know | |
| first before you distribute it... And please don't touch | |
| the version number. Just replace my callsign in | |
| "v3.0.dl1bke" with your own. Just to avoid confusion... | |
| If you want to add your modification to the linux distribution | |
| please (!) contact me first. | |
| New versions of the driver will be announced on the linux-hams | |
| mailing list on vger.kernel.org. To subscribe send an e-mail | |
| to majordomo@vger.kernel.org with the following line in | |
| the body of the mail: | |
| subscribe linux-hams | |
| The content of the "Subject" field will be ignored. | |
| vy 73, | |
| Joerg Reuter ampr-net: dl1bke@db0pra.ampr.org | |
| AX-25 : DL1BKE @ DB0ABH.#BAY.DEU.EU | |
| Internet: jreuter@yaina.de | |
| www : http://yaina.de/jreuter | |
| */ | |
| /* ----------------------------------------------------------------------- */ | |
| #undef SCC_LDELAY /* slow it even a bit more down */ | |
| #undef SCC_DONT_CHECK /* don't look if the SCCs you specified are available */ | |
| #define SCC_MAXCHIPS 4 /* number of max. supported chips */ | |
| #define SCC_BUFSIZE 384 /* must not exceed 4096 */ | |
| #undef SCC_DEBUG | |
| #define SCC_DEFAULT_CLOCK 4915200 | |
| /* default pclock if nothing is specified */ | |
| /* ----------------------------------------------------------------------- */ | |
| #include <linux/module.h> | |
| #include <linux/errno.h> | |
| #include <linux/signal.h> | |
| #include <linux/timer.h> | |
| #include <linux/interrupt.h> | |
| #include <linux/ioport.h> | |
| #include <linux/string.h> | |
| #include <linux/in.h> | |
| #include <linux/fcntl.h> | |
| #include <linux/ptrace.h> | |
| #include <linux/delay.h> | |
| #include <linux/skbuff.h> | |
| #include <linux/netdevice.h> | |
| #include <linux/rtnetlink.h> | |
| #include <linux/if_ether.h> | |
| #include <linux/if_arp.h> | |
| #include <linux/socket.h> | |
| #include <linux/init.h> | |
| #include <linux/scc.h> | |
| #include <linux/ctype.h> | |
| #include <linux/kernel.h> | |
| #include <linux/proc_fs.h> | |
| #include <linux/seq_file.h> | |
| #include <linux/bitops.h> | |
| #include <net/net_namespace.h> | |
| #include <net/ax25.h> | |
| #include <asm/irq.h> | |
| #include <asm/io.h> | |
| #include <asm/uaccess.h> | |
| #include "z8530.h" | |
| static const char banner[] __initconst = KERN_INFO \ | |
| "AX.25: Z8530 SCC driver version "VERSION".dl1bke\n"; | |
| static void t_dwait(unsigned long); | |
| static void t_txdelay(unsigned long); | |
| static void t_tail(unsigned long); | |
| static void t_busy(unsigned long); | |
| static void t_maxkeyup(unsigned long); | |
| static void t_idle(unsigned long); | |
| static void scc_tx_done(struct scc_channel *); | |
| static void scc_start_tx_timer(struct scc_channel *, void (*)(unsigned long), unsigned long); | |
| static void scc_start_maxkeyup(struct scc_channel *); | |
| static void scc_start_defer(struct scc_channel *); | |
| static void z8530_init(void); | |
| static void init_channel(struct scc_channel *scc); | |
| static void scc_key_trx (struct scc_channel *scc, char tx); | |
| static void scc_init_timer(struct scc_channel *scc); | |
| static int scc_net_alloc(const char *name, struct scc_channel *scc); | |
| static void scc_net_setup(struct net_device *dev); | |
| static int scc_net_open(struct net_device *dev); | |
| static int scc_net_close(struct net_device *dev); | |
| static void scc_net_rx(struct scc_channel *scc, struct sk_buff *skb); | |
| static netdev_tx_t scc_net_tx(struct sk_buff *skb, | |
| struct net_device *dev); | |
| static int scc_net_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd); | |
| static int scc_net_set_mac_address(struct net_device *dev, void *addr); | |
| static struct net_device_stats * scc_net_get_stats(struct net_device *dev); | |
| static unsigned char SCC_DriverName[] = "scc"; | |
| static struct irqflags { unsigned char used : 1; } Ivec[NR_IRQS]; | |
| static struct scc_channel SCC_Info[2 * SCC_MAXCHIPS]; /* information per channel */ | |
| static struct scc_ctrl { | |
| io_port chan_A; | |
| io_port chan_B; | |
| int irq; | |
| } SCC_ctrl[SCC_MAXCHIPS+1]; | |
| static unsigned char Driver_Initialized; | |
| static int Nchips; | |
| static io_port Vector_Latch; | |
| /* ******************************************************************** */ | |
| /* * Port Access Functions * */ | |
| /* ******************************************************************** */ | |
| /* These provide interrupt save 2-step access to the Z8530 registers */ | |
| static DEFINE_SPINLOCK(iolock); /* Guards paired accesses */ | |
| static inline unsigned char InReg(io_port port, unsigned char reg) | |
| { | |
| unsigned long flags; | |
| unsigned char r; | |
| spin_lock_irqsave(&iolock, flags); | |
| #ifdef SCC_LDELAY | |
| Outb(port, reg); | |
| udelay(SCC_LDELAY); | |
| r=Inb(port); | |
| udelay(SCC_LDELAY); | |
| #else | |
| Outb(port, reg); | |
| r=Inb(port); | |
| #endif | |
| spin_unlock_irqrestore(&iolock, flags); | |
| return r; | |
| } | |
| static inline void OutReg(io_port port, unsigned char reg, unsigned char val) | |
| { | |
| unsigned long flags; | |
| spin_lock_irqsave(&iolock, flags); | |
| #ifdef SCC_LDELAY | |
| Outb(port, reg); udelay(SCC_LDELAY); | |
| Outb(port, val); udelay(SCC_LDELAY); | |
| #else | |
| Outb(port, reg); | |
| Outb(port, val); | |
| #endif | |
| spin_unlock_irqrestore(&iolock, flags); | |
| } | |
| static inline void wr(struct scc_channel *scc, unsigned char reg, | |
| unsigned char val) | |
| { | |
| OutReg(scc->ctrl, reg, (scc->wreg[reg] = val)); | |
| } | |
| static inline void or(struct scc_channel *scc, unsigned char reg, unsigned char val) | |
| { | |
| OutReg(scc->ctrl, reg, (scc->wreg[reg] |= val)); | |
| } | |
| static inline void cl(struct scc_channel *scc, unsigned char reg, unsigned char val) | |
| { | |
| OutReg(scc->ctrl, reg, (scc->wreg[reg] &= ~val)); | |
| } | |
| /* ******************************************************************** */ | |
| /* * Some useful macros * */ | |
| /* ******************************************************************** */ | |
| static inline void scc_discard_buffers(struct scc_channel *scc) | |
| { | |
| unsigned long flags; | |
| spin_lock_irqsave(&scc->lock, flags); | |
| if (scc->tx_buff != NULL) | |
| { | |
| dev_kfree_skb(scc->tx_buff); | |
| scc->tx_buff = NULL; | |
| } | |
| while (!skb_queue_empty(&scc->tx_queue)) | |
| dev_kfree_skb(skb_dequeue(&scc->tx_queue)); | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| } | |
| /* ******************************************************************** */ | |
| /* * Interrupt Service Routines * */ | |
| /* ******************************************************************** */ | |
| /* ----> subroutines for the interrupt handlers <---- */ | |
| static inline void scc_notify(struct scc_channel *scc, int event) | |
| { | |
| struct sk_buff *skb; | |
| char *bp; | |
| if (scc->kiss.fulldup != KISS_DUPLEX_OPTIMA) | |
| return; | |
| skb = dev_alloc_skb(2); | |
| if (skb != NULL) | |
| { | |
| bp = skb_put(skb, 2); | |
| *bp++ = PARAM_HWEVENT; | |
| *bp++ = event; | |
| scc_net_rx(scc, skb); | |
| } else | |
| scc->stat.nospace++; | |
| } | |
| static inline void flush_rx_FIFO(struct scc_channel *scc) | |
| { | |
| int k; | |
| for (k=0; k<3; k++) | |
| Inb(scc->data); | |
| if(scc->rx_buff != NULL) /* did we receive something? */ | |
| { | |
| scc->stat.rxerrs++; /* then count it as an error */ | |
| dev_kfree_skb_irq(scc->rx_buff); | |
| scc->rx_buff = NULL; | |
| } | |
| } | |
| static void start_hunt(struct scc_channel *scc) | |
| { | |
| if ((scc->modem.clocksrc != CLK_EXTERNAL)) | |
| OutReg(scc->ctrl,R14,SEARCH|scc->wreg[R14]); /* DPLL: enter search mode */ | |
| or(scc,R3,ENT_HM|RxENABLE); /* enable the receiver, hunt mode */ | |
| } | |
| /* ----> four different interrupt handlers for Tx, Rx, changing of */ | |
| /* DCD/CTS and Rx/Tx errors */ | |
| /* Transmitter interrupt handler */ | |
| static inline void scc_txint(struct scc_channel *scc) | |
| { | |
| struct sk_buff *skb; | |
| scc->stat.txints++; | |
| skb = scc->tx_buff; | |
| /* send first octet */ | |
| if (skb == NULL) | |
| { | |
| skb = skb_dequeue(&scc->tx_queue); | |
| scc->tx_buff = skb; | |
| netif_wake_queue(scc->dev); | |
| if (skb == NULL) | |
| { | |
| scc_tx_done(scc); | |
| Outb(scc->ctrl, RES_Tx_P); | |
| return; | |
| } | |
| if (skb->len == 0) /* Paranoia... */ | |
| { | |
| dev_kfree_skb_irq(skb); | |
| scc->tx_buff = NULL; | |
| scc_tx_done(scc); | |
| Outb(scc->ctrl, RES_Tx_P); | |
| return; | |
| } | |
| scc->stat.tx_state = TXS_ACTIVE; | |
| OutReg(scc->ctrl, R0, RES_Tx_CRC); | |
| /* reset CRC generator */ | |
| or(scc,R10,ABUNDER); /* re-install underrun protection */ | |
| Outb(scc->data,*skb->data); /* send byte */ | |
| skb_pull(skb, 1); | |
| if (!scc->enhanced) /* reset EOM latch */ | |
| Outb(scc->ctrl,RES_EOM_L); | |
| return; | |
| } | |
| /* End Of Frame... */ | |
| if (skb->len == 0) | |
| { | |
| Outb(scc->ctrl, RES_Tx_P); /* reset pending int */ | |
| cl(scc, R10, ABUNDER); /* send CRC */ | |
| dev_kfree_skb_irq(skb); | |
| scc->tx_buff = NULL; | |
| scc->stat.tx_state = TXS_NEWFRAME; /* next frame... */ | |
| return; | |
| } | |
| /* send octet */ | |
| Outb(scc->data,*skb->data); | |
| skb_pull(skb, 1); | |
| } | |
| /* External/Status interrupt handler */ | |
| static inline void scc_exint(struct scc_channel *scc) | |
| { | |
| unsigned char status,changes,chg_and_stat; | |
| scc->stat.exints++; | |
| status = InReg(scc->ctrl,R0); | |
| changes = status ^ scc->status; | |
| chg_and_stat = changes & status; | |
| /* ABORT: generated whenever DCD drops while receiving */ | |
| if (chg_and_stat & BRK_ABRT) /* Received an ABORT */ | |
| flush_rx_FIFO(scc); | |
| /* HUNT: software DCD; on = waiting for SYNC, off = receiving frame */ | |
| if ((changes & SYNC_HUNT) && scc->kiss.softdcd) | |
| { | |
| if (status & SYNC_HUNT) | |
| { | |
| scc->dcd = 0; | |
| flush_rx_FIFO(scc); | |
| if ((scc->modem.clocksrc != CLK_EXTERNAL)) | |
| OutReg(scc->ctrl,R14,SEARCH|scc->wreg[R14]); /* DPLL: enter search mode */ | |
| } else { | |
| scc->dcd = 1; | |
| } | |
| scc_notify(scc, scc->dcd? HWEV_DCD_OFF:HWEV_DCD_ON); | |
| } | |
| /* DCD: on = start to receive packet, off = ABORT condition */ | |
| /* (a successfully received packet generates a special condition int) */ | |
| if((changes & DCD) && !scc->kiss.softdcd) /* DCD input changed state */ | |
| { | |
| if(status & DCD) /* DCD is now ON */ | |
| { | |
| start_hunt(scc); | |
| scc->dcd = 1; | |
| } else { /* DCD is now OFF */ | |
| cl(scc,R3,ENT_HM|RxENABLE); /* disable the receiver */ | |
| flush_rx_FIFO(scc); | |
| scc->dcd = 0; | |
| } | |
| scc_notify(scc, scc->dcd? HWEV_DCD_ON:HWEV_DCD_OFF); | |
| } | |
| #ifdef notdef | |
| /* CTS: use external TxDelay (what's that good for?!) | |
| * Anyway: If we _could_ use it (BayCom USCC uses CTS for | |
| * own purposes) we _should_ use the "autoenable" feature | |
| * of the Z8530 and not this interrupt... | |
| */ | |
| if (chg_and_stat & CTS) /* CTS is now ON */ | |
| { | |
| if (scc->kiss.txdelay == 0) /* zero TXDELAY = wait for CTS */ | |
| scc_start_tx_timer(scc, t_txdelay, 0); | |
| } | |
| #endif | |
| if (scc->stat.tx_state == TXS_ACTIVE && (status & TxEOM)) | |
| { | |
| scc->stat.tx_under++; /* oops, an underrun! count 'em */ | |
| Outb(scc->ctrl, RES_EXT_INT); /* reset ext/status interrupts */ | |
| if (scc->tx_buff != NULL) | |
| { | |
| dev_kfree_skb_irq(scc->tx_buff); | |
| scc->tx_buff = NULL; | |
| } | |
| or(scc,R10,ABUNDER); | |
| scc_start_tx_timer(scc, t_txdelay, 0); /* restart transmission */ | |
| } | |
| scc->status = status; | |
| Outb(scc->ctrl,RES_EXT_INT); | |
| } | |
| /* Receiver interrupt handler */ | |
| static inline void scc_rxint(struct scc_channel *scc) | |
| { | |
| struct sk_buff *skb; | |
| scc->stat.rxints++; | |
| if((scc->wreg[5] & RTS) && scc->kiss.fulldup == KISS_DUPLEX_HALF) | |
| { | |
| Inb(scc->data); /* discard char */ | |
| or(scc,R3,ENT_HM); /* enter hunt mode for next flag */ | |
| return; | |
| } | |
| skb = scc->rx_buff; | |
| if (skb == NULL) | |
| { | |
| skb = dev_alloc_skb(scc->stat.bufsize); | |
| if (skb == NULL) | |
| { | |
| scc->dev_stat.rx_dropped++; | |
| scc->stat.nospace++; | |
| Inb(scc->data); | |
| or(scc, R3, ENT_HM); | |
| return; | |
| } | |
| scc->rx_buff = skb; | |
| *(skb_put(skb, 1)) = 0; /* KISS data */ | |
| } | |
| if (skb->len >= scc->stat.bufsize) | |
| { | |
| #ifdef notdef | |
| printk(KERN_DEBUG "z8530drv: oops, scc_rxint() received huge frame...\n"); | |
| #endif | |
| dev_kfree_skb_irq(skb); | |
| scc->rx_buff = NULL; | |
| Inb(scc->data); | |
| or(scc, R3, ENT_HM); | |
| return; | |
| } | |
| *(skb_put(skb, 1)) = Inb(scc->data); | |
| } | |
| /* Receive Special Condition interrupt handler */ | |
| static inline void scc_spint(struct scc_channel *scc) | |
| { | |
| unsigned char status; | |
| struct sk_buff *skb; | |
| scc->stat.spints++; | |
| status = InReg(scc->ctrl,R1); /* read receiver status */ | |
| Inb(scc->data); /* throw away Rx byte */ | |
| skb = scc->rx_buff; | |
| if(status & Rx_OVR) /* receiver overrun */ | |
| { | |
| scc->stat.rx_over++; /* count them */ | |
| or(scc,R3,ENT_HM); /* enter hunt mode for next flag */ | |
| if (skb != NULL) | |
| dev_kfree_skb_irq(skb); | |
| scc->rx_buff = skb = NULL; | |
| } | |
| if(status & END_FR && skb != NULL) /* end of frame */ | |
| { | |
| /* CRC okay, frame ends on 8 bit boundary and received something ? */ | |
| if (!(status & CRC_ERR) && (status & 0xe) == RES8 && skb->len > 0) | |
| { | |
| /* ignore last received byte (first of the CRC bytes) */ | |
| skb_trim(skb, skb->len-1); | |
| scc_net_rx(scc, skb); | |
| scc->rx_buff = NULL; | |
| scc->stat.rxframes++; | |
| } else { /* a bad frame */ | |
| dev_kfree_skb_irq(skb); | |
| scc->rx_buff = NULL; | |
| scc->stat.rxerrs++; | |
| } | |
| } | |
| Outb(scc->ctrl,ERR_RES); | |
| } | |
| /* ----> interrupt service routine for the Z8530 <---- */ | |
| static void scc_isr_dispatch(struct scc_channel *scc, int vector) | |
| { | |
| spin_lock(&scc->lock); | |
| switch (vector & VECTOR_MASK) | |
| { | |
| case TXINT: scc_txint(scc); break; | |
| case EXINT: scc_exint(scc); break; | |
| case RXINT: scc_rxint(scc); break; | |
| case SPINT: scc_spint(scc); break; | |
| } | |
| spin_unlock(&scc->lock); | |
| } | |
| /* If the card has a latch for the interrupt vector (like the PA0HZP card) | |
| use it to get the number of the chip that generated the int. | |
| If not: poll all defined chips. | |
| */ | |
| #define SCC_IRQTIMEOUT 30000 | |
| static irqreturn_t scc_isr(int irq, void *dev_id) | |
| { | |
| int chip_irq = (long) dev_id; | |
| unsigned char vector; | |
| struct scc_channel *scc; | |
| struct scc_ctrl *ctrl; | |
| int k; | |
| if (Vector_Latch) | |
| { | |
| for(k=0; k < SCC_IRQTIMEOUT; k++) | |
| { | |
| Outb(Vector_Latch, 0); /* Generate INTACK */ | |
| /* Read the vector */ | |
| if((vector=Inb(Vector_Latch)) >= 16 * Nchips) break; | |
| if (vector & 0x01) break; | |
| scc=&SCC_Info[vector >> 3 ^ 0x01]; | |
| if (!scc->dev) break; | |
| scc_isr_dispatch(scc, vector); | |
| OutReg(scc->ctrl,R0,RES_H_IUS); /* Reset Highest IUS */ | |
| } | |
| if (k == SCC_IRQTIMEOUT) | |
| printk(KERN_WARNING "z8530drv: endless loop in scc_isr()?\n"); | |
| return IRQ_HANDLED; | |
| } | |
| /* Find the SCC generating the interrupt by polling all attached SCCs | |
| * reading RR3A (the interrupt pending register) | |
| */ | |
| ctrl = SCC_ctrl; | |
| while (ctrl->chan_A) | |
| { | |
| if (ctrl->irq != chip_irq) | |
| { | |
| ctrl++; | |
| continue; | |
| } | |
| scc = NULL; | |
| for (k = 0; InReg(ctrl->chan_A,R3) && k < SCC_IRQTIMEOUT; k++) | |
| { | |
| vector=InReg(ctrl->chan_B,R2); /* Read the vector */ | |
| if (vector & 0x01) break; | |
| scc = &SCC_Info[vector >> 3 ^ 0x01]; | |
| if (!scc->dev) break; | |
| scc_isr_dispatch(scc, vector); | |
| } | |
| if (k == SCC_IRQTIMEOUT) | |
| { | |
| printk(KERN_WARNING "z8530drv: endless loop in scc_isr()?!\n"); | |
| break; | |
| } | |
| /* This looks weird and it is. At least the BayCom USCC doesn't | |
| * use the Interrupt Daisy Chain, thus we'll have to start | |
| * all over again to be sure not to miss an interrupt from | |
| * (any of) the other chip(s)... | |
| * Honestly, the situation *is* braindamaged... | |
| */ | |
| if (scc != NULL) | |
| { | |
| OutReg(scc->ctrl,R0,RES_H_IUS); | |
| ctrl = SCC_ctrl; | |
| } else | |
| ctrl++; | |
| } | |
| return IRQ_HANDLED; | |
| } | |
| /* ******************************************************************** */ | |
| /* * Init Channel */ | |
| /* ******************************************************************** */ | |
| /* ----> set SCC channel speed <---- */ | |
| static inline void set_brg(struct scc_channel *scc, unsigned int tc) | |
| { | |
| cl(scc,R14,BRENABL); /* disable baudrate generator */ | |
| wr(scc,R12,tc & 255); /* brg rate LOW */ | |
| wr(scc,R13,tc >> 8); /* brg rate HIGH */ | |
| or(scc,R14,BRENABL); /* enable baudrate generator */ | |
| } | |
| static inline void set_speed(struct scc_channel *scc) | |
| { | |
| unsigned long flags; | |
| spin_lock_irqsave(&scc->lock, flags); | |
| if (scc->modem.speed > 0) /* paranoia... */ | |
| set_brg(scc, (unsigned) (scc->clock / (scc->modem.speed * 64)) - 2); | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| } | |
| /* ----> initialize a SCC channel <---- */ | |
| static inline void init_brg(struct scc_channel *scc) | |
| { | |
| wr(scc, R14, BRSRC); /* BRG source = PCLK */ | |
| OutReg(scc->ctrl, R14, SSBR|scc->wreg[R14]); /* DPLL source = BRG */ | |
| OutReg(scc->ctrl, R14, SNRZI|scc->wreg[R14]); /* DPLL NRZI mode */ | |
| } | |
| /* | |
| * Initialization according to the Z8530 manual (SGS-Thomson's version): | |
| * | |
| * 1. Modes and constants | |
| * | |
| * WR9 11000000 chip reset | |
| * WR4 XXXXXXXX Tx/Rx control, async or sync mode | |
| * WR1 0XX00X00 select W/REQ (optional) | |
| * WR2 XXXXXXXX program interrupt vector | |
| * WR3 XXXXXXX0 select Rx control | |
| * WR5 XXXX0XXX select Tx control | |
| * WR6 XXXXXXXX sync character | |
| * WR7 XXXXXXXX sync character | |
| * WR9 000X0XXX select interrupt control | |
| * WR10 XXXXXXXX miscellaneous control (optional) | |
| * WR11 XXXXXXXX clock control | |
| * WR12 XXXXXXXX time constant lower byte (optional) | |
| * WR13 XXXXXXXX time constant upper byte (optional) | |
| * WR14 XXXXXXX0 miscellaneous control | |
| * WR14 XXXSSSSS commands (optional) | |
| * | |
| * 2. Enables | |
| * | |
| * WR14 000SSSS1 baud rate enable | |
| * WR3 SSSSSSS1 Rx enable | |
| * WR5 SSSS1SSS Tx enable | |
| * WR0 10000000 reset Tx CRG (optional) | |
| * WR1 XSS00S00 DMA enable (optional) | |
| * | |
| * 3. Interrupt status | |
| * | |
| * WR15 XXXXXXXX enable external/status | |
| * WR0 00010000 reset external status | |
| * WR0 00010000 reset external status twice | |
| * WR1 SSSXXSXX enable Rx, Tx and Ext/status | |
| * WR9 000SXSSS enable master interrupt enable | |
| * | |
| * 1 = set to one, 0 = reset to zero | |
| * X = user defined, S = same as previous init | |
| * | |
| * | |
| * Note that the implementation differs in some points from above scheme. | |
| * | |
| */ | |
| static void init_channel(struct scc_channel *scc) | |
| { | |
| del_timer(&scc->tx_t); | |
| del_timer(&scc->tx_wdog); | |
| disable_irq(scc->irq); | |
| wr(scc,R4,X1CLK|SDLC); /* *1 clock, SDLC mode */ | |
| wr(scc,R1,0); /* no W/REQ operation */ | |
| wr(scc,R3,Rx8|RxCRC_ENAB); /* RX 8 bits/char, CRC, disabled */ | |
| wr(scc,R5,Tx8|DTR|TxCRC_ENAB); /* TX 8 bits/char, disabled, DTR */ | |
| wr(scc,R6,0); /* SDLC address zero (not used) */ | |
| wr(scc,R7,FLAG); /* SDLC flag value */ | |
| wr(scc,R9,VIS); /* vector includes status */ | |
| wr(scc,R10,(scc->modem.nrz? NRZ : NRZI)|CRCPS|ABUNDER); /* abort on underrun, preset CRC generator, NRZ(I) */ | |
| wr(scc,R14, 0); | |
| /* set clock sources: | |
| CLK_DPLL: normal halfduplex operation | |
| RxClk: use DPLL | |
| TxClk: use DPLL | |
| TRxC mode DPLL output | |
| CLK_EXTERNAL: external clocking (G3RUH or DF9IC modem) | |
| BayCom: others: | |
| TxClk = pin RTxC TxClk = pin TRxC | |
| RxClk = pin TRxC RxClk = pin RTxC | |
| CLK_DIVIDER: | |
| RxClk = use DPLL | |
| TxClk = pin RTxC | |
| BayCom: others: | |
| pin TRxC = DPLL pin TRxC = BRG | |
| (RxClk * 1) (RxClk * 32) | |
| */ | |
| switch(scc->modem.clocksrc) | |
| { | |
| case CLK_DPLL: | |
| wr(scc, R11, RCDPLL|TCDPLL|TRxCOI|TRxCDP); | |
| init_brg(scc); | |
| break; | |
| case CLK_DIVIDER: | |
| wr(scc, R11, ((scc->brand & BAYCOM)? TRxCDP : TRxCBR) | RCDPLL|TCRTxCP|TRxCOI); | |
| init_brg(scc); | |
| break; | |
| case CLK_EXTERNAL: | |
| wr(scc, R11, (scc->brand & BAYCOM)? RCTRxCP|TCRTxCP : RCRTxCP|TCTRxCP); | |
| OutReg(scc->ctrl, R14, DISDPLL); | |
| break; | |
| } | |
| set_speed(scc); /* set baudrate */ | |
| if(scc->enhanced) | |
| { | |
| or(scc,R15,SHDLCE|FIFOE); /* enable FIFO, SDLC/HDLC Enhancements (From now R7 is R7') */ | |
| wr(scc,R7,AUTOEOM); | |
| } | |
| if(scc->kiss.softdcd || (InReg(scc->ctrl,R0) & DCD)) | |
| /* DCD is now ON */ | |
| { | |
| start_hunt(scc); | |
| } | |
| /* enable ABORT, DCD & SYNC/HUNT interrupts */ | |
| wr(scc,R15, BRKIE|TxUIE|(scc->kiss.softdcd? SYNCIE:DCDIE)); | |
| Outb(scc->ctrl,RES_EXT_INT); /* reset ext/status interrupts */ | |
| Outb(scc->ctrl,RES_EXT_INT); /* must be done twice */ | |
| or(scc,R1,INT_ALL_Rx|TxINT_ENAB|EXT_INT_ENAB); /* enable interrupts */ | |
| scc->status = InReg(scc->ctrl,R0); /* read initial status */ | |
| or(scc,R9,MIE); /* master interrupt enable */ | |
| scc_init_timer(scc); | |
| enable_irq(scc->irq); | |
| } | |
| /* ******************************************************************** */ | |
| /* * SCC timer functions * */ | |
| /* ******************************************************************** */ | |
| /* ----> scc_key_trx sets the time constant for the baudrate | |
| generator and keys the transmitter <---- */ | |
| static void scc_key_trx(struct scc_channel *scc, char tx) | |
| { | |
| unsigned int time_const; | |
| if (scc->brand & PRIMUS) | |
| Outb(scc->ctrl + 4, scc->option | (tx? 0x80 : 0)); | |
| if (scc->modem.speed < 300) | |
| scc->modem.speed = 1200; | |
| time_const = (unsigned) (scc->clock / (scc->modem.speed * (tx? 2:64))) - 2; | |
| disable_irq(scc->irq); | |
| if (tx) | |
| { | |
| or(scc, R1, TxINT_ENAB); /* t_maxkeyup may have reset these */ | |
| or(scc, R15, TxUIE); | |
| } | |
| if (scc->modem.clocksrc == CLK_DPLL) | |
| { /* force simplex operation */ | |
| if (tx) | |
| { | |
| #ifdef CONFIG_SCC_TRXECHO | |
| cl(scc, R3, RxENABLE|ENT_HM); /* switch off receiver */ | |
| cl(scc, R15, DCDIE|SYNCIE); /* No DCD changes, please */ | |
| #endif | |
| set_brg(scc, time_const); /* reprogram baudrate generator */ | |
| /* DPLL -> Rx clk, BRG -> Tx CLK, TRxC mode output, TRxC = BRG */ | |
| wr(scc, R11, RCDPLL|TCBR|TRxCOI|TRxCBR); | |
| /* By popular demand: tx_inhibit */ | |
| if (scc->kiss.tx_inhibit) | |
| { | |
| or(scc,R5, TxENAB); | |
| scc->wreg[R5] |= RTS; | |
| } else { | |
| or(scc,R5,RTS|TxENAB); /* set the RTS line and enable TX */ | |
| } | |
| } else { | |
| cl(scc,R5,RTS|TxENAB); | |
| set_brg(scc, time_const); /* reprogram baudrate generator */ | |
| /* DPLL -> Rx clk, DPLL -> Tx CLK, TRxC mode output, TRxC = DPLL */ | |
| wr(scc, R11, RCDPLL|TCDPLL|TRxCOI|TRxCDP); | |
| #ifndef CONFIG_SCC_TRXECHO | |
| if (scc->kiss.softdcd) | |
| #endif | |
| { | |
| or(scc,R15, scc->kiss.softdcd? SYNCIE:DCDIE); | |
| start_hunt(scc); | |
| } | |
| } | |
| } else { | |
| if (tx) | |
| { | |
| #ifdef CONFIG_SCC_TRXECHO | |
| if (scc->kiss.fulldup == KISS_DUPLEX_HALF) | |
| { | |
| cl(scc, R3, RxENABLE); | |
| cl(scc, R15, DCDIE|SYNCIE); | |
| } | |
| #endif | |
| if (scc->kiss.tx_inhibit) | |
| { | |
| or(scc,R5, TxENAB); | |
| scc->wreg[R5] |= RTS; | |
| } else { | |
| or(scc,R5,RTS|TxENAB); /* enable tx */ | |
| } | |
| } else { | |
| cl(scc,R5,RTS|TxENAB); /* disable tx */ | |
| if ((scc->kiss.fulldup == KISS_DUPLEX_HALF) && | |
| #ifndef CONFIG_SCC_TRXECHO | |
| scc->kiss.softdcd) | |
| #else | |
| 1) | |
| #endif | |
| { | |
| or(scc, R15, scc->kiss.softdcd? SYNCIE:DCDIE); | |
| start_hunt(scc); | |
| } | |
| } | |
| } | |
| enable_irq(scc->irq); | |
| } | |
| /* ----> SCC timer interrupt handler and friends. <---- */ | |
| static void __scc_start_tx_timer(struct scc_channel *scc, void (*handler)(unsigned long), unsigned long when) | |
| { | |
| del_timer(&scc->tx_t); | |
| if (when == 0) | |
| { | |
| handler((unsigned long) scc); | |
| } else | |
| if (when != TIMER_OFF) | |
| { | |
| scc->tx_t.data = (unsigned long) scc; | |
| scc->tx_t.function = handler; | |
| scc->tx_t.expires = jiffies + (when*HZ)/100; | |
| add_timer(&scc->tx_t); | |
| } | |
| } | |
| static void scc_start_tx_timer(struct scc_channel *scc, void (*handler)(unsigned long), unsigned long when) | |
| { | |
| unsigned long flags; | |
| spin_lock_irqsave(&scc->lock, flags); | |
| __scc_start_tx_timer(scc, handler, when); | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| } | |
| static void scc_start_defer(struct scc_channel *scc) | |
| { | |
| unsigned long flags; | |
| spin_lock_irqsave(&scc->lock, flags); | |
| del_timer(&scc->tx_wdog); | |
| if (scc->kiss.maxdefer != 0 && scc->kiss.maxdefer != TIMER_OFF) | |
| { | |
| scc->tx_wdog.data = (unsigned long) scc; | |
| scc->tx_wdog.function = t_busy; | |
| scc->tx_wdog.expires = jiffies + HZ*scc->kiss.maxdefer; | |
| add_timer(&scc->tx_wdog); | |
| } | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| } | |
| static void scc_start_maxkeyup(struct scc_channel *scc) | |
| { | |
| unsigned long flags; | |
| spin_lock_irqsave(&scc->lock, flags); | |
| del_timer(&scc->tx_wdog); | |
| if (scc->kiss.maxkeyup != 0 && scc->kiss.maxkeyup != TIMER_OFF) | |
| { | |
| scc->tx_wdog.data = (unsigned long) scc; | |
| scc->tx_wdog.function = t_maxkeyup; | |
| scc->tx_wdog.expires = jiffies + HZ*scc->kiss.maxkeyup; | |
| add_timer(&scc->tx_wdog); | |
| } | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| } | |
| /* | |
| * This is called from scc_txint() when there are no more frames to send. | |
| * Not exactly a timer function, but it is a close friend of the family... | |
| */ | |
| static void scc_tx_done(struct scc_channel *scc) | |
| { | |
| /* | |
| * trx remains keyed in fulldup mode 2 until t_idle expires. | |
| */ | |
| switch (scc->kiss.fulldup) | |
| { | |
| case KISS_DUPLEX_LINK: | |
| scc->stat.tx_state = TXS_IDLE2; | |
| if (scc->kiss.idletime != TIMER_OFF) | |
| scc_start_tx_timer(scc, t_idle, | |
| scc->kiss.idletime*100); | |
| break; | |
| case KISS_DUPLEX_OPTIMA: | |
| scc_notify(scc, HWEV_ALL_SENT); | |
| break; | |
| default: | |
| scc->stat.tx_state = TXS_BUSY; | |
| scc_start_tx_timer(scc, t_tail, scc->kiss.tailtime); | |
| } | |
| netif_wake_queue(scc->dev); | |
| } | |
| static unsigned char Rand = 17; | |
| static inline int is_grouped(struct scc_channel *scc) | |
| { | |
| int k; | |
| struct scc_channel *scc2; | |
| unsigned char grp1, grp2; | |
| grp1 = scc->kiss.group; | |
| for (k = 0; k < (Nchips * 2); k++) | |
| { | |
| scc2 = &SCC_Info[k]; | |
| grp2 = scc2->kiss.group; | |
| if (scc2 == scc || !(scc2->dev && grp2)) | |
| continue; | |
| if ((grp1 & 0x3f) == (grp2 & 0x3f)) | |
| { | |
| if ( (grp1 & TXGROUP) && (scc2->wreg[R5] & RTS) ) | |
| return 1; | |
| if ( (grp1 & RXGROUP) && scc2->dcd ) | |
| return 1; | |
| } | |
| } | |
| return 0; | |
| } | |
| /* DWAIT and SLOTTIME expired | |
| * | |
| * fulldup == 0: DCD is active or Rand > P-persistence: start t_busy timer | |
| * else key trx and start txdelay | |
| * fulldup == 1: key trx and start txdelay | |
| * fulldup == 2: mintime expired, reset status or key trx and start txdelay | |
| */ | |
| static void t_dwait(unsigned long channel) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) channel; | |
| if (scc->stat.tx_state == TXS_WAIT) /* maxkeyup or idle timeout */ | |
| { | |
| if (skb_queue_empty(&scc->tx_queue)) { /* nothing to send */ | |
| scc->stat.tx_state = TXS_IDLE; | |
| netif_wake_queue(scc->dev); /* t_maxkeyup locked it. */ | |
| return; | |
| } | |
| scc->stat.tx_state = TXS_BUSY; | |
| } | |
| if (scc->kiss.fulldup == KISS_DUPLEX_HALF) | |
| { | |
| Rand = Rand * 17 + 31; | |
| if (scc->dcd || (scc->kiss.persist) < Rand || (scc->kiss.group && is_grouped(scc)) ) | |
| { | |
| scc_start_defer(scc); | |
| scc_start_tx_timer(scc, t_dwait, scc->kiss.slottime); | |
| return ; | |
| } | |
| } | |
| if ( !(scc->wreg[R5] & RTS) ) | |
| { | |
| scc_key_trx(scc, TX_ON); | |
| scc_start_tx_timer(scc, t_txdelay, scc->kiss.txdelay); | |
| } else { | |
| scc_start_tx_timer(scc, t_txdelay, 0); | |
| } | |
| } | |
| /* TXDELAY expired | |
| * | |
| * kick transmission by a fake scc_txint(scc), start 'maxkeyup' watchdog. | |
| */ | |
| static void t_txdelay(unsigned long channel) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) channel; | |
| scc_start_maxkeyup(scc); | |
| if (scc->tx_buff == NULL) | |
| { | |
| disable_irq(scc->irq); | |
| scc_txint(scc); | |
| enable_irq(scc->irq); | |
| } | |
| } | |
| /* TAILTIME expired | |
| * | |
| * switch off transmitter. If we were stopped by Maxkeyup restart | |
| * transmission after 'mintime' seconds | |
| */ | |
| static void t_tail(unsigned long channel) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) channel; | |
| unsigned long flags; | |
| spin_lock_irqsave(&scc->lock, flags); | |
| del_timer(&scc->tx_wdog); | |
| scc_key_trx(scc, TX_OFF); | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| if (scc->stat.tx_state == TXS_TIMEOUT) /* we had a timeout? */ | |
| { | |
| scc->stat.tx_state = TXS_WAIT; | |
| scc_start_tx_timer(scc, t_dwait, scc->kiss.mintime*100); | |
| return; | |
| } | |
| scc->stat.tx_state = TXS_IDLE; | |
| netif_wake_queue(scc->dev); | |
| } | |
| /* BUSY timeout | |
| * | |
| * throw away send buffers if DCD remains active too long. | |
| */ | |
| static void t_busy(unsigned long channel) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) channel; | |
| del_timer(&scc->tx_t); | |
| netif_stop_queue(scc->dev); /* don't pile on the wabbit! */ | |
| scc_discard_buffers(scc); | |
| scc->stat.txerrs++; | |
| scc->stat.tx_state = TXS_IDLE; | |
| netif_wake_queue(scc->dev); | |
| } | |
| /* MAXKEYUP timeout | |
| * | |
| * this is our watchdog. | |
| */ | |
| static void t_maxkeyup(unsigned long channel) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) channel; | |
| unsigned long flags; | |
| spin_lock_irqsave(&scc->lock, flags); | |
| /* | |
| * let things settle down before we start to | |
| * accept new data. | |
| */ | |
| netif_stop_queue(scc->dev); | |
| scc_discard_buffers(scc); | |
| del_timer(&scc->tx_t); | |
| cl(scc, R1, TxINT_ENAB); /* force an ABORT, but don't */ | |
| cl(scc, R15, TxUIE); /* count it. */ | |
| OutReg(scc->ctrl, R0, RES_Tx_P); | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| scc->stat.txerrs++; | |
| scc->stat.tx_state = TXS_TIMEOUT; | |
| scc_start_tx_timer(scc, t_tail, scc->kiss.tailtime); | |
| } | |
| /* IDLE timeout | |
| * | |
| * in fulldup mode 2 it keys down the transmitter after 'idle' seconds | |
| * of inactivity. We will not restart transmission before 'mintime' | |
| * expires. | |
| */ | |
| static void t_idle(unsigned long channel) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) channel; | |
| del_timer(&scc->tx_wdog); | |
| scc_key_trx(scc, TX_OFF); | |
| if(scc->kiss.mintime) | |
| scc_start_tx_timer(scc, t_dwait, scc->kiss.mintime*100); | |
| scc->stat.tx_state = TXS_WAIT; | |
| } | |
| static void scc_init_timer(struct scc_channel *scc) | |
| { | |
| unsigned long flags; | |
| spin_lock_irqsave(&scc->lock, flags); | |
| scc->stat.tx_state = TXS_IDLE; | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| } | |
| /* ******************************************************************** */ | |
| /* * Set/get L1 parameters * */ | |
| /* ******************************************************************** */ | |
| /* | |
| * this will set the "hardware" parameters through KISS commands or ioctl() | |
| */ | |
| #define CAST(x) (unsigned long)(x) | |
| static unsigned int scc_set_param(struct scc_channel *scc, unsigned int cmd, unsigned int arg) | |
| { | |
| switch (cmd) | |
| { | |
| case PARAM_TXDELAY: scc->kiss.txdelay=arg; break; | |
| case PARAM_PERSIST: scc->kiss.persist=arg; break; | |
| case PARAM_SLOTTIME: scc->kiss.slottime=arg; break; | |
| case PARAM_TXTAIL: scc->kiss.tailtime=arg; break; | |
| case PARAM_FULLDUP: scc->kiss.fulldup=arg; break; | |
| case PARAM_DTR: break; /* does someone need this? */ | |
| case PARAM_GROUP: scc->kiss.group=arg; break; | |
| case PARAM_IDLE: scc->kiss.idletime=arg; break; | |
| case PARAM_MIN: scc->kiss.mintime=arg; break; | |
| case PARAM_MAXKEY: scc->kiss.maxkeyup=arg; break; | |
| case PARAM_WAIT: scc->kiss.waittime=arg; break; | |
| case PARAM_MAXDEFER: scc->kiss.maxdefer=arg; break; | |
| case PARAM_TX: scc->kiss.tx_inhibit=arg; break; | |
| case PARAM_SOFTDCD: | |
| scc->kiss.softdcd=arg; | |
| if (arg) | |
| { | |
| or(scc, R15, SYNCIE); | |
| cl(scc, R15, DCDIE); | |
| start_hunt(scc); | |
| } else { | |
| or(scc, R15, DCDIE); | |
| cl(scc, R15, SYNCIE); | |
| } | |
| break; | |
| case PARAM_SPEED: | |
| if (arg < 256) | |
| scc->modem.speed=arg*100; | |
| else | |
| scc->modem.speed=arg; | |
| if (scc->stat.tx_state == 0) /* only switch baudrate on rx... ;-) */ | |
| set_speed(scc); | |
| break; | |
| case PARAM_RTS: | |
| if ( !(scc->wreg[R5] & RTS) ) | |
| { | |
| if (arg != TX_OFF) { | |
| scc_key_trx(scc, TX_ON); | |
| scc_start_tx_timer(scc, t_txdelay, scc->kiss.txdelay); | |
| } | |
| } else { | |
| if (arg == TX_OFF) | |
| { | |
| scc->stat.tx_state = TXS_BUSY; | |
| scc_start_tx_timer(scc, t_tail, scc->kiss.tailtime); | |
| } | |
| } | |
| break; | |
| case PARAM_HWEVENT: | |
| scc_notify(scc, scc->dcd? HWEV_DCD_ON:HWEV_DCD_OFF); | |
| break; | |
| default: return -EINVAL; | |
| } | |
| return 0; | |
| } | |
| static unsigned long scc_get_param(struct scc_channel *scc, unsigned int cmd) | |
| { | |
| switch (cmd) | |
| { | |
| case PARAM_TXDELAY: return CAST(scc->kiss.txdelay); | |
| case PARAM_PERSIST: return CAST(scc->kiss.persist); | |
| case PARAM_SLOTTIME: return CAST(scc->kiss.slottime); | |
| case PARAM_TXTAIL: return CAST(scc->kiss.tailtime); | |
| case PARAM_FULLDUP: return CAST(scc->kiss.fulldup); | |
| case PARAM_SOFTDCD: return CAST(scc->kiss.softdcd); | |
| case PARAM_DTR: return CAST((scc->wreg[R5] & DTR)? 1:0); | |
| case PARAM_RTS: return CAST((scc->wreg[R5] & RTS)? 1:0); | |
| case PARAM_SPEED: return CAST(scc->modem.speed); | |
| case PARAM_GROUP: return CAST(scc->kiss.group); | |
| case PARAM_IDLE: return CAST(scc->kiss.idletime); | |
| case PARAM_MIN: return CAST(scc->kiss.mintime); | |
| case PARAM_MAXKEY: return CAST(scc->kiss.maxkeyup); | |
| case PARAM_WAIT: return CAST(scc->kiss.waittime); | |
| case PARAM_MAXDEFER: return CAST(scc->kiss.maxdefer); | |
| case PARAM_TX: return CAST(scc->kiss.tx_inhibit); | |
| default: return NO_SUCH_PARAM; | |
| } | |
| } | |
| #undef CAST | |
| /* ******************************************************************* */ | |
| /* * Send calibration pattern * */ | |
| /* ******************************************************************* */ | |
| static void scc_stop_calibrate(unsigned long channel) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) channel; | |
| unsigned long flags; | |
| spin_lock_irqsave(&scc->lock, flags); | |
| del_timer(&scc->tx_wdog); | |
| scc_key_trx(scc, TX_OFF); | |
| wr(scc, R6, 0); | |
| wr(scc, R7, FLAG); | |
| Outb(scc->ctrl,RES_EXT_INT); /* reset ext/status interrupts */ | |
| Outb(scc->ctrl,RES_EXT_INT); | |
| netif_wake_queue(scc->dev); | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| } | |
| static void | |
| scc_start_calibrate(struct scc_channel *scc, int duration, unsigned char pattern) | |
| { | |
| unsigned long flags; | |
| spin_lock_irqsave(&scc->lock, flags); | |
| netif_stop_queue(scc->dev); | |
| scc_discard_buffers(scc); | |
| del_timer(&scc->tx_wdog); | |
| scc->tx_wdog.data = (unsigned long) scc; | |
| scc->tx_wdog.function = scc_stop_calibrate; | |
| scc->tx_wdog.expires = jiffies + HZ*duration; | |
| add_timer(&scc->tx_wdog); | |
| /* This doesn't seem to work. Why not? */ | |
| wr(scc, R6, 0); | |
| wr(scc, R7, pattern); | |
| /* | |
| * Don't know if this works. | |
| * Damn, where is my Z8530 programming manual...? | |
| */ | |
| Outb(scc->ctrl,RES_EXT_INT); /* reset ext/status interrupts */ | |
| Outb(scc->ctrl,RES_EXT_INT); | |
| scc_key_trx(scc, TX_ON); | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| } | |
| /* ******************************************************************* */ | |
| /* * Init channel structures, special HW, etc... * */ | |
| /* ******************************************************************* */ | |
| /* | |
| * Reset the Z8530s and setup special hardware | |
| */ | |
| static void z8530_init(void) | |
| { | |
| struct scc_channel *scc; | |
| int chip, k; | |
| unsigned long flags; | |
| char *flag; | |
| printk(KERN_INFO "Init Z8530 driver: %u channels, IRQ", Nchips*2); | |
| flag=" "; | |
| for (k = 0; k < nr_irqs; k++) | |
| if (Ivec[k].used) | |
| { | |
| printk("%s%d", flag, k); | |
| flag=","; | |
| } | |
| printk("\n"); | |
| /* reset and pre-init all chips in the system */ | |
| for (chip = 0; chip < Nchips; chip++) | |
| { | |
| scc=&SCC_Info[2*chip]; | |
| if (!scc->ctrl) continue; | |
| /* Special SCC cards */ | |
| if(scc->brand & EAGLE) /* this is an EAGLE card */ | |
| Outb(scc->special,0x08); /* enable interrupt on the board */ | |
| if(scc->brand & (PC100 | PRIMUS)) /* this is a PC100/PRIMUS card */ | |
| Outb(scc->special,scc->option); /* set the MODEM mode (0x22) */ | |
| /* Reset and pre-init Z8530 */ | |
| spin_lock_irqsave(&scc->lock, flags); | |
| Outb(scc->ctrl, 0); | |
| OutReg(scc->ctrl,R9,FHWRES); /* force hardware reset */ | |
| udelay(100); /* give it 'a bit' more time than required */ | |
| wr(scc, R2, chip*16); /* interrupt vector */ | |
| wr(scc, R9, VIS); /* vector includes status */ | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| } | |
| Driver_Initialized = 1; | |
| } | |
| /* | |
| * Allocate device structure, err, instance, and register driver | |
| */ | |
| static int scc_net_alloc(const char *name, struct scc_channel *scc) | |
| { | |
| int err; | |
| struct net_device *dev; | |
| dev = alloc_netdev(0, name, NET_NAME_UNKNOWN, scc_net_setup); | |
| if (!dev) | |
| return -ENOMEM; | |
| dev->ml_priv = scc; | |
| scc->dev = dev; | |
| spin_lock_init(&scc->lock); | |
| init_timer(&scc->tx_t); | |
| init_timer(&scc->tx_wdog); | |
| err = register_netdevice(dev); | |
| if (err) { | |
| printk(KERN_ERR "%s: can't register network device (%d)\n", | |
| name, err); | |
| free_netdev(dev); | |
| scc->dev = NULL; | |
| return err; | |
| } | |
| return 0; | |
| } | |
| /* ******************************************************************** */ | |
| /* * Network driver methods * */ | |
| /* ******************************************************************** */ | |
| static const struct net_device_ops scc_netdev_ops = { | |
| .ndo_open = scc_net_open, | |
| .ndo_stop = scc_net_close, | |
| .ndo_start_xmit = scc_net_tx, | |
| .ndo_set_mac_address = scc_net_set_mac_address, | |
| .ndo_get_stats = scc_net_get_stats, | |
| .ndo_do_ioctl = scc_net_ioctl, | |
| }; | |
| /* ----> Initialize device <----- */ | |
| static void scc_net_setup(struct net_device *dev) | |
| { | |
| dev->tx_queue_len = 16; /* should be enough... */ | |
| dev->netdev_ops = &scc_netdev_ops; | |
| dev->header_ops = &ax25_header_ops; | |
| memcpy(dev->broadcast, &ax25_bcast, AX25_ADDR_LEN); | |
| memcpy(dev->dev_addr, &ax25_defaddr, AX25_ADDR_LEN); | |
| dev->flags = 0; | |
| dev->type = ARPHRD_AX25; | |
| dev->hard_header_len = AX25_MAX_HEADER_LEN + AX25_BPQ_HEADER_LEN; | |
| dev->mtu = AX25_DEF_PACLEN; | |
| dev->addr_len = AX25_ADDR_LEN; | |
| } | |
| /* ----> open network device <---- */ | |
| static int scc_net_open(struct net_device *dev) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) dev->ml_priv; | |
| if (!scc->init) | |
| return -EINVAL; | |
| scc->tx_buff = NULL; | |
| skb_queue_head_init(&scc->tx_queue); | |
| init_channel(scc); | |
| netif_start_queue(dev); | |
| return 0; | |
| } | |
| /* ----> close network device <---- */ | |
| static int scc_net_close(struct net_device *dev) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) dev->ml_priv; | |
| unsigned long flags; | |
| netif_stop_queue(dev); | |
| spin_lock_irqsave(&scc->lock, flags); | |
| Outb(scc->ctrl,0); /* Make sure pointer is written */ | |
| wr(scc,R1,0); /* disable interrupts */ | |
| wr(scc,R3,0); | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| del_timer_sync(&scc->tx_t); | |
| del_timer_sync(&scc->tx_wdog); | |
| scc_discard_buffers(scc); | |
| return 0; | |
| } | |
| /* ----> receive frame, called from scc_rxint() <---- */ | |
| static void scc_net_rx(struct scc_channel *scc, struct sk_buff *skb) | |
| { | |
| if (skb->len == 0) { | |
| dev_kfree_skb_irq(skb); | |
| return; | |
| } | |
| scc->dev_stat.rx_packets++; | |
| scc->dev_stat.rx_bytes += skb->len; | |
| skb->protocol = ax25_type_trans(skb, scc->dev); | |
| netif_rx(skb); | |
| } | |
| /* ----> transmit frame <---- */ | |
| static netdev_tx_t scc_net_tx(struct sk_buff *skb, struct net_device *dev) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) dev->ml_priv; | |
| unsigned long flags; | |
| char kisscmd; | |
| if (skb->len > scc->stat.bufsize || skb->len < 2) { | |
| scc->dev_stat.tx_dropped++; /* bogus frame */ | |
| dev_kfree_skb(skb); | |
| return NETDEV_TX_OK; | |
| } | |
| scc->dev_stat.tx_packets++; | |
| scc->dev_stat.tx_bytes += skb->len; | |
| scc->stat.txframes++; | |
| kisscmd = *skb->data & 0x1f; | |
| skb_pull(skb, 1); | |
| if (kisscmd) { | |
| scc_set_param(scc, kisscmd, *skb->data); | |
| dev_kfree_skb(skb); | |
| return NETDEV_TX_OK; | |
| } | |
| spin_lock_irqsave(&scc->lock, flags); | |
| if (skb_queue_len(&scc->tx_queue) > scc->dev->tx_queue_len) { | |
| struct sk_buff *skb_del; | |
| skb_del = skb_dequeue(&scc->tx_queue); | |
| dev_kfree_skb(skb_del); | |
| } | |
| skb_queue_tail(&scc->tx_queue, skb); | |
| dev->trans_start = jiffies; | |
| /* | |
| * Start transmission if the trx state is idle or | |
| * t_idle hasn't expired yet. Use dwait/persistence/slottime | |
| * algorithm for normal halfduplex operation. | |
| */ | |
| if(scc->stat.tx_state == TXS_IDLE || scc->stat.tx_state == TXS_IDLE2) { | |
| scc->stat.tx_state = TXS_BUSY; | |
| if (scc->kiss.fulldup == KISS_DUPLEX_HALF) | |
| __scc_start_tx_timer(scc, t_dwait, scc->kiss.waittime); | |
| else | |
| __scc_start_tx_timer(scc, t_dwait, 0); | |
| } | |
| spin_unlock_irqrestore(&scc->lock, flags); | |
| return NETDEV_TX_OK; | |
| } | |
| /* ----> ioctl functions <---- */ | |
| /* | |
| * SIOCSCCCFG - configure driver arg: (struct scc_hw_config *) arg | |
| * SIOCSCCINI - initialize driver arg: --- | |
| * SIOCSCCCHANINI - initialize channel arg: (struct scc_modem *) arg | |
| * SIOCSCCSMEM - set memory arg: (struct scc_mem_config *) arg | |
| * SIOCSCCGKISS - get level 1 parameter arg: (struct scc_kiss_cmd *) arg | |
| * SIOCSCCSKISS - set level 1 parameter arg: (struct scc_kiss_cmd *) arg | |
| * SIOCSCCGSTAT - get driver status arg: (struct scc_stat *) arg | |
| * SIOCSCCCAL - send calib. pattern arg: (struct scc_calibrate *) arg | |
| */ | |
| static int scc_net_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) | |
| { | |
| struct scc_kiss_cmd kiss_cmd; | |
| struct scc_mem_config memcfg; | |
| struct scc_hw_config hwcfg; | |
| struct scc_calibrate cal; | |
| struct scc_channel *scc = (struct scc_channel *) dev->ml_priv; | |
| int chan; | |
| unsigned char device_name[IFNAMSIZ]; | |
| void __user *arg = ifr->ifr_data; | |
| if (!Driver_Initialized) | |
| { | |
| if (cmd == SIOCSCCCFG) | |
| { | |
| int found = 1; | |
| if (!capable(CAP_SYS_RAWIO)) return -EPERM; | |
| if (!arg) return -EFAULT; | |
| if (Nchips >= SCC_MAXCHIPS) | |
| return -EINVAL; | |
| if (copy_from_user(&hwcfg, arg, sizeof(hwcfg))) | |
| return -EFAULT; | |
| if (hwcfg.irq == 2) hwcfg.irq = 9; | |
| if (hwcfg.irq < 0 || hwcfg.irq >= nr_irqs) | |
| return -EINVAL; | |
| if (!Ivec[hwcfg.irq].used && hwcfg.irq) | |
| { | |
| if (request_irq(hwcfg.irq, scc_isr, | |
| 0, "AX.25 SCC", | |
| (void *)(long) hwcfg.irq)) | |
| printk(KERN_WARNING "z8530drv: warning, cannot get IRQ %d\n", hwcfg.irq); | |
| else | |
| Ivec[hwcfg.irq].used = 1; | |
| } | |
| if (hwcfg.vector_latch && !Vector_Latch) { | |
| if (!request_region(hwcfg.vector_latch, 1, "scc vector latch")) | |
| printk(KERN_WARNING "z8530drv: warning, cannot reserve vector latch port 0x%lx\n, disabled.", hwcfg.vector_latch); | |
| else | |
| Vector_Latch = hwcfg.vector_latch; | |
| } | |
| if (hwcfg.clock == 0) | |
| hwcfg.clock = SCC_DEFAULT_CLOCK; | |
| #ifndef SCC_DONT_CHECK | |
| if(request_region(hwcfg.ctrl_a, 1, "scc-probe")) | |
| { | |
| disable_irq(hwcfg.irq); | |
| Outb(hwcfg.ctrl_a, 0); | |
| OutReg(hwcfg.ctrl_a, R9, FHWRES); | |
| udelay(100); | |
| OutReg(hwcfg.ctrl_a,R13,0x55); /* is this chip really there? */ | |
| udelay(5); | |
| if (InReg(hwcfg.ctrl_a,R13) != 0x55) | |
| found = 0; | |
| enable_irq(hwcfg.irq); | |
| release_region(hwcfg.ctrl_a, 1); | |
| } | |
| else | |
| found = 0; | |
| #endif | |
| if (found) | |
| { | |
| SCC_Info[2*Nchips ].ctrl = hwcfg.ctrl_a; | |
| SCC_Info[2*Nchips ].data = hwcfg.data_a; | |
| SCC_Info[2*Nchips ].irq = hwcfg.irq; | |
| SCC_Info[2*Nchips+1].ctrl = hwcfg.ctrl_b; | |
| SCC_Info[2*Nchips+1].data = hwcfg.data_b; | |
| SCC_Info[2*Nchips+1].irq = hwcfg.irq; | |
| SCC_ctrl[Nchips].chan_A = hwcfg.ctrl_a; | |
| SCC_ctrl[Nchips].chan_B = hwcfg.ctrl_b; | |
| SCC_ctrl[Nchips].irq = hwcfg.irq; | |
| } | |
| for (chan = 0; chan < 2; chan++) | |
| { | |
| sprintf(device_name, "%s%i", SCC_DriverName, 2*Nchips+chan); | |
| SCC_Info[2*Nchips+chan].special = hwcfg.special; | |
| SCC_Info[2*Nchips+chan].clock = hwcfg.clock; | |
| SCC_Info[2*Nchips+chan].brand = hwcfg.brand; | |
| SCC_Info[2*Nchips+chan].option = hwcfg.option; | |
| SCC_Info[2*Nchips+chan].enhanced = hwcfg.escc; | |
| #ifdef SCC_DONT_CHECK | |
| printk(KERN_INFO "%s: data port = 0x%3.3x control port = 0x%3.3x\n", | |
| device_name, | |
| SCC_Info[2*Nchips+chan].data, | |
| SCC_Info[2*Nchips+chan].ctrl); | |
| #else | |
| printk(KERN_INFO "%s: data port = 0x%3.3lx control port = 0x%3.3lx -- %s\n", | |
| device_name, | |
| chan? hwcfg.data_b : hwcfg.data_a, | |
| chan? hwcfg.ctrl_b : hwcfg.ctrl_a, | |
| found? "found" : "missing"); | |
| #endif | |
| if (found) | |
| { | |
| request_region(SCC_Info[2*Nchips+chan].ctrl, 1, "scc ctrl"); | |
| request_region(SCC_Info[2*Nchips+chan].data, 1, "scc data"); | |
| if (Nchips+chan != 0 && | |
| scc_net_alloc(device_name, | |
| &SCC_Info[2*Nchips+chan])) | |
| return -EINVAL; | |
| } | |
| } | |
| if (found) Nchips++; | |
| return 0; | |
| } | |
| if (cmd == SIOCSCCINI) | |
| { | |
| if (!capable(CAP_SYS_RAWIO)) | |
| return -EPERM; | |
| if (Nchips == 0) | |
| return -EINVAL; | |
| z8530_init(); | |
| return 0; | |
| } | |
| return -EINVAL; /* confuse the user */ | |
| } | |
| if (!scc->init) | |
| { | |
| if (cmd == SIOCSCCCHANINI) | |
| { | |
| if (!capable(CAP_NET_ADMIN)) return -EPERM; | |
| if (!arg) return -EINVAL; | |
| scc->stat.bufsize = SCC_BUFSIZE; | |
| if (copy_from_user(&scc->modem, arg, sizeof(struct scc_modem))) | |
| return -EINVAL; | |
| /* default KISS Params */ | |
| if (scc->modem.speed < 4800) | |
| { | |
| scc->kiss.txdelay = 36; /* 360 ms */ | |
| scc->kiss.persist = 42; /* 25% persistence */ /* was 25 */ | |
| scc->kiss.slottime = 16; /* 160 ms */ | |
| scc->kiss.tailtime = 4; /* minimal reasonable value */ | |
| scc->kiss.fulldup = 0; /* CSMA */ | |
| scc->kiss.waittime = 50; /* 500 ms */ | |
| scc->kiss.maxkeyup = 10; /* 10 s */ | |
| scc->kiss.mintime = 3; /* 3 s */ | |
| scc->kiss.idletime = 30; /* 30 s */ | |
| scc->kiss.maxdefer = 120; /* 2 min */ | |
| scc->kiss.softdcd = 0; /* hardware dcd */ | |
| } else { | |
| scc->kiss.txdelay = 10; /* 100 ms */ | |
| scc->kiss.persist = 64; /* 25% persistence */ /* was 25 */ | |
| scc->kiss.slottime = 8; /* 160 ms */ | |
| scc->kiss.tailtime = 1; /* minimal reasonable value */ | |
| scc->kiss.fulldup = 0; /* CSMA */ | |
| scc->kiss.waittime = 50; /* 500 ms */ | |
| scc->kiss.maxkeyup = 7; /* 7 s */ | |
| scc->kiss.mintime = 3; /* 3 s */ | |
| scc->kiss.idletime = 30; /* 30 s */ | |
| scc->kiss.maxdefer = 120; /* 2 min */ | |
| scc->kiss.softdcd = 0; /* hardware dcd */ | |
| } | |
| scc->tx_buff = NULL; | |
| skb_queue_head_init(&scc->tx_queue); | |
| scc->init = 1; | |
| return 0; | |
| } | |
| return -EINVAL; | |
| } | |
| switch(cmd) | |
| { | |
| case SIOCSCCRESERVED: | |
| return -ENOIOCTLCMD; | |
| case SIOCSCCSMEM: | |
| if (!capable(CAP_SYS_RAWIO)) return -EPERM; | |
| if (!arg || copy_from_user(&memcfg, arg, sizeof(memcfg))) | |
| return -EINVAL; | |
| scc->stat.bufsize = memcfg.bufsize; | |
| return 0; | |
| case SIOCSCCGSTAT: | |
| if (!arg || copy_to_user(arg, &scc->stat, sizeof(scc->stat))) | |
| return -EINVAL; | |
| return 0; | |
| case SIOCSCCGKISS: | |
| if (!arg || copy_from_user(&kiss_cmd, arg, sizeof(kiss_cmd))) | |
| return -EINVAL; | |
| kiss_cmd.param = scc_get_param(scc, kiss_cmd.command); | |
| if (copy_to_user(arg, &kiss_cmd, sizeof(kiss_cmd))) | |
| return -EINVAL; | |
| return 0; | |
| case SIOCSCCSKISS: | |
| if (!capable(CAP_NET_ADMIN)) return -EPERM; | |
| if (!arg || copy_from_user(&kiss_cmd, arg, sizeof(kiss_cmd))) | |
| return -EINVAL; | |
| return scc_set_param(scc, kiss_cmd.command, kiss_cmd.param); | |
| case SIOCSCCCAL: | |
| if (!capable(CAP_SYS_RAWIO)) return -EPERM; | |
| if (!arg || copy_from_user(&cal, arg, sizeof(cal)) || cal.time == 0) | |
| return -EINVAL; | |
| scc_start_calibrate(scc, cal.time, cal.pattern); | |
| return 0; | |
| default: | |
| return -ENOIOCTLCMD; | |
| } | |
| return -EINVAL; | |
| } | |
| /* ----> set interface callsign <---- */ | |
| static int scc_net_set_mac_address(struct net_device *dev, void *addr) | |
| { | |
| struct sockaddr *sa = (struct sockaddr *) addr; | |
| memcpy(dev->dev_addr, sa->sa_data, dev->addr_len); | |
| return 0; | |
| } | |
| /* ----> get statistics <---- */ | |
| static struct net_device_stats *scc_net_get_stats(struct net_device *dev) | |
| { | |
| struct scc_channel *scc = (struct scc_channel *) dev->ml_priv; | |
| scc->dev_stat.rx_errors = scc->stat.rxerrs + scc->stat.rx_over; | |
| scc->dev_stat.tx_errors = scc->stat.txerrs + scc->stat.tx_under; | |
| scc->dev_stat.rx_fifo_errors = scc->stat.rx_over; | |
| scc->dev_stat.tx_fifo_errors = scc->stat.tx_under; | |
| return &scc->dev_stat; | |
| } | |
| /* ******************************************************************** */ | |
| /* * dump statistics to /proc/net/z8530drv * */ | |
| /* ******************************************************************** */ | |
| #ifdef CONFIG_PROC_FS | |
| static inline struct scc_channel *scc_net_seq_idx(loff_t pos) | |
| { | |
| int k; | |
| for (k = 0; k < Nchips*2; ++k) { | |
| if (!SCC_Info[k].init) | |
| continue; | |
| if (pos-- == 0) | |
| return &SCC_Info[k]; | |
| } | |
| return NULL; | |
| } | |
| static void *scc_net_seq_start(struct seq_file *seq, loff_t *pos) | |
| { | |
| return *pos ? scc_net_seq_idx(*pos - 1) : SEQ_START_TOKEN; | |
| } | |
| static void *scc_net_seq_next(struct seq_file *seq, void *v, loff_t *pos) | |
| { | |
| unsigned k; | |
| struct scc_channel *scc = v; | |
| ++*pos; | |
| for (k = (v == SEQ_START_TOKEN) ? 0 : (scc - SCC_Info)+1; | |
| k < Nchips*2; ++k) { | |
| if (SCC_Info[k].init) | |
| return &SCC_Info[k]; | |
| } | |
| return NULL; | |
| } | |
| static void scc_net_seq_stop(struct seq_file *seq, void *v) | |
| { | |
| } | |
| static int scc_net_seq_show(struct seq_file *seq, void *v) | |
| { | |
| if (v == SEQ_START_TOKEN) { | |
| seq_puts(seq, "z8530drv-"VERSION"\n"); | |
| } else if (!Driver_Initialized) { | |
| seq_puts(seq, "not initialized\n"); | |
| } else if (!Nchips) { | |
| seq_puts(seq, "chips missing\n"); | |
| } else { | |
| const struct scc_channel *scc = v; | |
| const struct scc_stat *stat = &scc->stat; | |
| const struct scc_kiss *kiss = &scc->kiss; | |
| /* dev data ctrl irq clock brand enh vector special option | |
| * baud nrz clocksrc softdcd bufsize | |
| * rxints txints exints spints | |
| * rcvd rxerrs over / xmit txerrs under / nospace bufsize | |
| * txd pers slot tail ful wait min maxk idl defr txof grp | |
| * W ## ## ## ## ## ## ## ## ## ## ## ## ## ## ## ## | |
| * R ## ## XX ## ## ## ## ## XX ## ## ## ## ## ## ## | |
| */ | |
| seq_printf(seq, "%s\t%3.3lx %3.3lx %d %lu %2.2x %d %3.3lx %3.3lx %d\n", | |
| scc->dev->name, | |
| scc->data, scc->ctrl, scc->irq, scc->clock, scc->brand, | |
| scc->enhanced, Vector_Latch, scc->special, | |
| scc->option); | |
| seq_printf(seq, "\t%lu %d %d %d %d\n", | |
| scc->modem.speed, scc->modem.nrz, | |
| scc->modem.clocksrc, kiss->softdcd, | |
| stat->bufsize); | |
| seq_printf(seq, "\t%lu %lu %lu %lu\n", | |
| stat->rxints, stat->txints, stat->exints, stat->spints); | |
| seq_printf(seq, "\t%lu %lu %d / %lu %lu %d / %d %d\n", | |
| stat->rxframes, stat->rxerrs, stat->rx_over, | |
| stat->txframes, stat->txerrs, stat->tx_under, | |
| stat->nospace, stat->tx_state); | |
| #define K(x) kiss->x | |
| seq_printf(seq, "\t%d %d %d %d %d %d %d %d %d %d %d %d\n", | |
| K(txdelay), K(persist), K(slottime), K(tailtime), | |
| K(fulldup), K(waittime), K(mintime), K(maxkeyup), | |
| K(idletime), K(maxdefer), K(tx_inhibit), K(group)); | |
| #undef K | |
| #ifdef SCC_DEBUG | |
| { | |
| int reg; | |
| seq_printf(seq, "\tW "); | |
| for (reg = 0; reg < 16; reg++) | |
| seq_printf(seq, "%2.2x ", scc->wreg[reg]); | |
| seq_printf(seq, "\n"); | |
| seq_printf(seq, "\tR %2.2x %2.2x XX ", InReg(scc->ctrl,R0), InReg(scc->ctrl,R1)); | |
| for (reg = 3; reg < 8; reg++) | |
| seq_printf(seq, "%2.2x ", InReg(scc->ctrl, reg)); | |
| seq_printf(seq, "XX "); | |
| for (reg = 9; reg < 16; reg++) | |
| seq_printf(seq, "%2.2x ", InReg(scc->ctrl, reg)); | |
| seq_printf(seq, "\n"); | |
| } | |
| #endif | |
| seq_putc(seq, '\n'); | |
| } | |
| return 0; | |
| } | |
| static const struct seq_operations scc_net_seq_ops = { | |
| .start = scc_net_seq_start, | |
| .next = scc_net_seq_next, | |
| .stop = scc_net_seq_stop, | |
| .show = scc_net_seq_show, | |
| }; | |
| static int scc_net_seq_open(struct inode *inode, struct file *file) | |
| { | |
| return seq_open(file, &scc_net_seq_ops); | |
| } | |
| static const struct file_operations scc_net_seq_fops = { | |
| .owner = THIS_MODULE, | |
| .open = scc_net_seq_open, | |
| .read = seq_read, | |
| .llseek = seq_lseek, | |
| .release = seq_release_private, | |
| }; | |
| #endif /* CONFIG_PROC_FS */ | |
| /* ******************************************************************** */ | |
| /* * Init SCC driver * */ | |
| /* ******************************************************************** */ | |
| static int __init scc_init_driver (void) | |
| { | |
| char devname[IFNAMSIZ]; | |
| printk(banner); | |
| sprintf(devname,"%s0", SCC_DriverName); | |
| rtnl_lock(); | |
| if (scc_net_alloc(devname, SCC_Info)) { | |
| rtnl_unlock(); | |
| printk(KERN_ERR "z8530drv: cannot initialize module\n"); | |
| return -EIO; | |
| } | |
| rtnl_unlock(); | |
| proc_create("z8530drv", 0, init_net.proc_net, &scc_net_seq_fops); | |
| return 0; | |
| } | |
| static void __exit scc_cleanup_driver(void) | |
| { | |
| io_port ctrl; | |
| int k; | |
| struct scc_channel *scc; | |
| struct net_device *dev; | |
| if (Nchips == 0 && (dev = SCC_Info[0].dev)) | |
| { | |
| unregister_netdev(dev); | |
| free_netdev(dev); | |
| } | |
| /* Guard against chip prattle */ | |
| local_irq_disable(); | |
| for (k = 0; k < Nchips; k++) | |
| if ( (ctrl = SCC_ctrl[k].chan_A) ) | |
| { | |
| Outb(ctrl, 0); | |
| OutReg(ctrl,R9,FHWRES); /* force hardware reset */ | |
| udelay(50); | |
| } | |
| /* To unload the port must be closed so no real IRQ pending */ | |
| for (k = 0; k < nr_irqs ; k++) | |
| if (Ivec[k].used) free_irq(k, NULL); | |
| local_irq_enable(); | |
| /* Now clean up */ | |
| for (k = 0; k < Nchips*2; k++) | |
| { | |
| scc = &SCC_Info[k]; | |
| if (scc->ctrl) | |
| { | |
| release_region(scc->ctrl, 1); | |
| release_region(scc->data, 1); | |
| } | |
| if (scc->dev) | |
| { | |
| unregister_netdev(scc->dev); | |
| free_netdev(scc->dev); | |
| } | |
| } | |
| if (Vector_Latch) | |
| release_region(Vector_Latch, 1); | |
| remove_proc_entry("z8530drv", init_net.proc_net); | |
| } | |
| MODULE_AUTHOR("Joerg Reuter <jreuter@yaina.de>"); | |
| MODULE_DESCRIPTION("AX.25 Device Driver for Z8530 based HDLC cards"); | |
| MODULE_SUPPORTED_DEVICE("Z8530 based SCC cards for Amateur Radio"); | |
| MODULE_LICENSE("GPL"); | |
| module_init(scc_init_driver); | |
| module_exit(scc_cleanup_driver); |