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