git.oblomov.eu Git - linux-2.6/blob - drivers/net/hamradio/yam.c

   1 /*****************************************************************************/
   2
   3 /*
   4  *    yam.c  -- YAM radio modem driver.
   5  *
   6  *      Copyright (C) 1998 Frederic Rible F1OAT (frible@teaser.fr)
   7  *      Adapted from baycom.c driver written by Thomas Sailer (sailer@ife.ee.ethz.ch)
   8  *
   9  *      This program is free software; you can redistribute it and/or modify
  10  *      it under the terms of the GNU General Public License as published by
  11  *      the Free Software Foundation; either version 2 of the License, or
  12  *      (at your option) any later version.
  13  *
  14  *      This program is distributed in the hope that it will be useful,
  15  *      but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  *      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  *      GNU General Public License for more details.
  18  *
  19  *      You should have received a copy of the GNU General Public License
  20  *      along with this program; if not, write to the Free Software
  21  *      Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  22  *
  23  *  Please note that the GPL allows you to use the driver, NOT the radio.
  24  *  In order to use the radio, you need a license from the communications
  25  *  authority of your country.
  26  *
  27  *
  28  *  History:
  29  *   0.0 F1OAT 06.06.98  Begin of work with baycom.c source code V 0.3
  30  *   0.1 F1OAT 07.06.98  Add timer polling routine for channel arbitration
  31  *   0.2 F6FBB 08.06.98  Added delay after FPGA programming
  32  *   0.3 F6FBB 29.07.98  Delayed PTT implementation for dupmode=2
  33  *   0.4 F6FBB 30.07.98  Added TxTail, Slottime and Persistance
  34  *   0.5 F6FBB 01.08.98  Shared IRQs, /proc/net and network statistics
  35  *   0.6 F6FBB 25.08.98  Added 1200Bds format
  36  *   0.7 F6FBB 12.09.98  Added to the kernel configuration
  37  *   0.8 F6FBB 14.10.98  Fixed slottime/persistence timing bug
  38  *       OK1ZIA 2.09.01  Fixed "kfree_skb on hard IRQ"
  39  *                       using dev_kfree_skb_any(). (important in 2.4 kernel)
  40  *
  41  */
  42
  43 /*****************************************************************************/
  44
  45 #include <linux/module.h>
  46 #include <linux/types.h>
  47 #include <linux/net.h>
  48 #include <linux/in.h>
  49 #include <linux/if.h>
  50 #include <linux/slab.h>
  51 #include <linux/errno.h>
  52 #include <linux/bitops.h>
  53 #include <asm/io.h>
  54 #include <asm/system.h>
  55 #include <linux/interrupt.h>
  56 #include <linux/ioport.h>
  57
  58 #include <linux/netdevice.h>
  59 #include <linux/if_arp.h>
  60 #include <linux/etherdevice.h>
  61 #include <linux/skbuff.h>
  62 #include <net/ax25.h>
  63
  64 #include <linux/kernel.h>
  65 #include <linux/proc_fs.h>
  66 #include <linux/seq_file.h>
  67
  68 #include <asm/uaccess.h>
  69 #include <linux/init.h>
  70
  71 #include <linux/yam.h>
  72 #include "yam9600.h"
  73 #include "yam1200.h"
  74
  75 /* --------------------------------------------------------------------- */
  76
  77 static const char yam_drvname[] = "yam";
  78 static char yam_drvinfo[] __initdata = KERN_INFO "YAM driver version 0.8 by F1OAT/F6FBB\n";
  79
  80 /* --------------------------------------------------------------------- */
  81
  82 #define YAM_9600        1
  83 #define YAM_1200        2
  84
  85 #define NR_PORTS        4
  86 #define YAM_MAGIC       0xF10A7654
  87
  88 /* Transmitter states */
  89
  90 #define TX_OFF          0
  91 #define TX_HEAD         1
  92 #define TX_DATA         2
  93 #define TX_CRC1         3
  94 #define TX_CRC2         4
  95 #define TX_TAIL         5
  96
  97 #define YAM_MAX_FRAME   1024
  98
  99 #define DEFAULT_BITRATE 9600                    /* bps */
 100 #define DEFAULT_HOLDD   10                      /* sec */
 101 #define DEFAULT_TXD     300                     /* ms */
 102 #define DEFAULT_TXTAIL  10                      /* ms */
 103 #define DEFAULT_SLOT    100                     /* ms */
 104 #define DEFAULT_PERS    64                      /* 0->255 */
 105
 106 struct yam_port {
 107         int magic;
 108         int bitrate;
 109         int baudrate;
 110         int iobase;
 111         int irq;
 112         int dupmode;
 113
 114         struct net_device *dev;
 115
 116         /* Stats section */
 117
 118         struct net_device_stats stats;
 119
 120         int nb_rxint;
 121         int nb_mdint;
 122
 123         /* Parameters section */
 124
 125         int txd;                                /* tx delay */
 126         int holdd;                              /* duplex ptt delay */
 127         int txtail;                             /* txtail delay */
 128         int slot;                               /* slottime */
 129         int pers;                               /* persistence */
 130
 131         /* Tx section */
 132
 133         int tx_state;
 134         int tx_count;
 135         int slotcnt;
 136         unsigned char tx_buf[YAM_MAX_FRAME];
 137         int tx_len;
 138         int tx_crcl, tx_crch;
 139         struct sk_buff_head send_queue;         /* Packets awaiting transmission */
 140
 141         /* Rx section */
 142
 143         int dcd;
 144         unsigned char rx_buf[YAM_MAX_FRAME];
 145         int rx_len;
 146         int rx_crcl, rx_crch;
 147 };
 148
 149 struct yam_mcs {
 150         unsigned char bits[YAM_FPGA_SIZE];
 151         int bitrate;
 152         struct yam_mcs *next;
 153 };
 154
 155 static struct net_device *yam_devs[NR_PORTS];
 156
 157 static struct yam_mcs *yam_data;
 158
 159 static char ax25_bcast[7] =
 160 {'Q' << 1, 'S' << 1, 'T' << 1, ' ' << 1, ' ' << 1, ' ' << 1, '0' << 1};
 161 static char ax25_test[7] =
 162 {'L' << 1, 'I' << 1, 'N' << 1, 'U' << 1, 'X' << 1, ' ' << 1, '1' << 1};
 163
 164 static DEFINE_TIMER(yam_timer, NULL, 0, 0);
 165
 166 /* --------------------------------------------------------------------- */
 167
 168 #define RBR(iobase)     (iobase+0)
 169 #define THR(iobase)     (iobase+0)
 170 #define IER(iobase)     (iobase+1)
 171 #define IIR(iobase)     (iobase+2)
 172 #define FCR(iobase)     (iobase+2)
 173 #define LCR(iobase)     (iobase+3)
 174 #define MCR(iobase)     (iobase+4)
 175 #define LSR(iobase)     (iobase+5)
 176 #define MSR(iobase)     (iobase+6)
 177 #define SCR(iobase)     (iobase+7)
 178 #define DLL(iobase)     (iobase+0)
 179 #define DLM(iobase)     (iobase+1)
 180
 181 #define YAM_EXTENT      8
 182
 183 /* Interrupt Identification Register Bit Masks */
 184 #define IIR_NOPEND      1
 185 #define IIR_MSR         0
 186 #define IIR_TX          2
 187 #define IIR_RX          4
 188 #define IIR_LSR         6
 189 #define IIR_TIMEOUT     12                      /* Fifo mode only */
 190
 191 #define IIR_MASK        0x0F
 192
 193 /* Interrupt Enable Register Bit Masks */
 194 #define IER_RX          1                       /* enable rx interrupt */
 195 #define IER_TX          2                       /* enable tx interrupt */
 196 #define IER_LSR         4                       /* enable line status interrupts */
 197 #define IER_MSR         8                       /* enable modem status interrupts */
 198
 199 /* Modem Control Register Bit Masks */
 200 #define MCR_DTR         0x01                    /* DTR output */
 201 #define MCR_RTS         0x02                    /* RTS output */
 202 #define MCR_OUT1        0x04                    /* OUT1 output (not accessible in RS232) */
 203 #define MCR_OUT2        0x08                    /* Master Interrupt enable (must be set on PCs) */
 204 #define MCR_LOOP        0x10                    /* Loopback enable */
 205
 206 /* Modem Status Register Bit Masks */
 207 #define MSR_DCTS        0x01                    /* Delta CTS input */
 208 #define MSR_DDSR        0x02                    /* Delta DSR */
 209 #define MSR_DRIN        0x04                    /* Delta RI */
 210 #define MSR_DDCD        0x08                    /* Delta DCD */
 211 #define MSR_CTS         0x10                    /* CTS input */
 212 #define MSR_DSR         0x20                    /* DSR input */
 213 #define MSR_RING        0x40                    /* RI  input */
 214 #define MSR_DCD         0x80                    /* DCD input */
 215
 216 /* line status register bit mask */
 217 #define LSR_RXC         0x01
 218 #define LSR_OE          0x02
 219 #define LSR_PE          0x04
 220 #define LSR_FE          0x08
 221 #define LSR_BREAK       0x10
 222 #define LSR_THRE        0x20
 223 #define LSR_TSRE        0x40
 224
 225 /* Line Control Register Bit Masks */
 226 #define LCR_DLAB        0x80
 227 #define LCR_BREAK       0x40
 228 #define LCR_PZERO       0x28
 229 #define LCR_PEVEN       0x18
 230 #define LCR_PODD        0x08
 231 #define LCR_STOP1       0x00
 232 #define LCR_STOP2       0x04
 233 #define LCR_BIT5        0x00
 234 #define LCR_BIT6        0x02
 235 #define LCR_BIT7        0x01
 236 #define LCR_BIT8        0x03
 237
 238 /* YAM Modem <-> UART Port mapping */
 239
 240 #define TX_RDY          MSR_DCTS                /* transmitter ready to send */
 241 #define RX_DCD          MSR_DCD                 /* carrier detect */
 242 #define RX_FLAG         MSR_RING                /* hdlc flag received */
 243 #define FPGA_DONE       MSR_DSR                 /* FPGA is configured */
 244 #define PTT_ON          (MCR_RTS|MCR_OUT2)      /* activate PTT */
 245 #define PTT_OFF         (MCR_DTR|MCR_OUT2)      /* release PTT */
 246
 247 #define ENABLE_RXINT    IER_RX                  /* enable uart rx interrupt during rx */
 248 #define ENABLE_TXINT    IER_MSR                 /* enable uart ms interrupt during tx */
 249 #define ENABLE_RTXINT   (IER_RX|IER_MSR)        /* full duplex operations */
 250
 251
 252 /*************************************************************************
 253 * CRC Tables
 254 ************************************************************************/
 255
 256 static const unsigned char chktabl[256] =
 257 {0x00, 0x89, 0x12, 0x9b, 0x24, 0xad, 0x36, 0xbf, 0x48, 0xc1, 0x5a, 0xd3, 0x6c, 0xe5, 0x7e,
 258  0xf7, 0x81, 0x08, 0x93, 0x1a, 0xa5, 0x2c, 0xb7, 0x3e, 0xc9, 0x40, 0xdb, 0x52, 0xed, 0x64,
 259  0xff, 0x76, 0x02, 0x8b, 0x10, 0x99, 0x26, 0xaf, 0x34, 0xbd, 0x4a, 0xc3, 0x58, 0xd1, 0x6e,
 260  0xe7, 0x7c, 0xf5, 0x83, 0x0a, 0x91, 0x18, 0xa7, 0x2e, 0xb5, 0x3c, 0xcb, 0x42, 0xd9, 0x50,
 261  0xef, 0x66, 0xfd, 0x74, 0x04, 0x8d, 0x16, 0x9f, 0x20, 0xa9, 0x32, 0xbb, 0x4c, 0xc5, 0x5e,
 262  0xd7, 0x68, 0xe1, 0x7a, 0xf3, 0x85, 0x0c, 0x97, 0x1e, 0xa1, 0x28, 0xb3, 0x3a, 0xcd, 0x44,
 263  0xdf, 0x56, 0xe9, 0x60, 0xfb, 0x72, 0x06, 0x8f, 0x14, 0x9d, 0x22, 0xab, 0x30, 0xb9, 0x4e,
 264  0xc7, 0x5c, 0xd5, 0x6a, 0xe3, 0x78, 0xf1, 0x87, 0x0e, 0x95, 0x1c, 0xa3, 0x2a, 0xb1, 0x38,
 265  0xcf, 0x46, 0xdd, 0x54, 0xeb, 0x62, 0xf9, 0x70, 0x08, 0x81, 0x1a, 0x93, 0x2c, 0xa5, 0x3e,
 266  0xb7, 0x40, 0xc9, 0x52, 0xdb, 0x64, 0xed, 0x76, 0xff, 0x89, 0x00, 0x9b, 0x12, 0xad, 0x24,
 267  0xbf, 0x36, 0xc1, 0x48, 0xd3, 0x5a, 0xe5, 0x6c, 0xf7, 0x7e, 0x0a, 0x83, 0x18, 0x91, 0x2e,
 268  0xa7, 0x3c, 0xb5, 0x42, 0xcb, 0x50, 0xd9, 0x66, 0xef, 0x74, 0xfd, 0x8b, 0x02, 0x99, 0x10,
 269  0xaf, 0x26, 0xbd, 0x34, 0xc3, 0x4a, 0xd1, 0x58, 0xe7, 0x6e, 0xf5, 0x7c, 0x0c, 0x85, 0x1e,
 270  0x97, 0x28, 0xa1, 0x3a, 0xb3, 0x44, 0xcd, 0x56, 0xdf, 0x60, 0xe9, 0x72, 0xfb, 0x8d, 0x04,
 271  0x9f, 0x16, 0xa9, 0x20, 0xbb, 0x32, 0xc5, 0x4c, 0xd7, 0x5e, 0xe1, 0x68, 0xf3, 0x7a, 0x0e,
 272  0x87, 0x1c, 0x95, 0x2a, 0xa3, 0x38, 0xb1, 0x46, 0xcf, 0x54, 0xdd, 0x62, 0xeb, 0x70, 0xf9,
 273  0x8f, 0x06, 0x9d, 0x14, 0xab, 0x22, 0xb9, 0x30, 0xc7, 0x4e, 0xd5, 0x5c, 0xe3, 0x6a, 0xf1,
 274  0x78};
 275 static const unsigned char chktabh[256] =
 276 {0x00, 0x11, 0x23, 0x32, 0x46, 0x57, 0x65, 0x74, 0x8c, 0x9d, 0xaf, 0xbe, 0xca, 0xdb, 0xe9,
 277  0xf8, 0x10, 0x01, 0x33, 0x22, 0x56, 0x47, 0x75, 0x64, 0x9c, 0x8d, 0xbf, 0xae, 0xda, 0xcb,
 278  0xf9, 0xe8, 0x21, 0x30, 0x02, 0x13, 0x67, 0x76, 0x44, 0x55, 0xad, 0xbc, 0x8e, 0x9f, 0xeb,
 279  0xfa, 0xc8, 0xd9, 0x31, 0x20, 0x12, 0x03, 0x77, 0x66, 0x54, 0x45, 0xbd, 0xac, 0x9e, 0x8f,
 280  0xfb, 0xea, 0xd8, 0xc9, 0x42, 0x53, 0x61, 0x70, 0x04, 0x15, 0x27, 0x36, 0xce, 0xdf, 0xed,
 281  0xfc, 0x88, 0x99, 0xab, 0xba, 0x52, 0x43, 0x71, 0x60, 0x14, 0x05, 0x37, 0x26, 0xde, 0xcf,
 282  0xfd, 0xec, 0x98, 0x89, 0xbb, 0xaa, 0x63, 0x72, 0x40, 0x51, 0x25, 0x34, 0x06, 0x17, 0xef,
 283  0xfe, 0xcc, 0xdd, 0xa9, 0xb8, 0x8a, 0x9b, 0x73, 0x62, 0x50, 0x41, 0x35, 0x24, 0x16, 0x07,
 284  0xff, 0xee, 0xdc, 0xcd, 0xb9, 0xa8, 0x9a, 0x8b, 0x84, 0x95, 0xa7, 0xb6, 0xc2, 0xd3, 0xe1,
 285  0xf0, 0x08, 0x19, 0x2b, 0x3a, 0x4e, 0x5f, 0x6d, 0x7c, 0x94, 0x85, 0xb7, 0xa6, 0xd2, 0xc3,
 286  0xf1, 0xe0, 0x18, 0x09, 0x3b, 0x2a, 0x5e, 0x4f, 0x7d, 0x6c, 0xa5, 0xb4, 0x86, 0x97, 0xe3,
 287  0xf2, 0xc0, 0xd1, 0x29, 0x38, 0x0a, 0x1b, 0x6f, 0x7e, 0x4c, 0x5d, 0xb5, 0xa4, 0x96, 0x87,
 288  0xf3, 0xe2, 0xd0, 0xc1, 0x39, 0x28, 0x1a, 0x0b, 0x7f, 0x6e, 0x5c, 0x4d, 0xc6, 0xd7, 0xe5,
 289  0xf4, 0x80, 0x91, 0xa3, 0xb2, 0x4a, 0x5b, 0x69, 0x78, 0x0c, 0x1d, 0x2f, 0x3e, 0xd6, 0xc7,
 290  0xf5, 0xe4, 0x90, 0x81, 0xb3, 0xa2, 0x5a, 0x4b, 0x79, 0x68, 0x1c, 0x0d, 0x3f, 0x2e, 0xe7,
 291  0xf6, 0xc4, 0xd5, 0xa1, 0xb0, 0x82, 0x93, 0x6b, 0x7a, 0x48, 0x59, 0x2d, 0x3c, 0x0e, 0x1f,
 292  0xf7, 0xe6, 0xd4, 0xc5, 0xb1, 0xa0, 0x92, 0x83, 0x7b, 0x6a, 0x58, 0x49, 0x3d, 0x2c, 0x1e,
 293  0x0f};
 294
 295 /*************************************************************************
 296 * FPGA functions
 297 ************************************************************************/
 298
 299 static void delay(int ms)
 300 {
 301         unsigned long timeout = jiffies + ((ms * HZ) / 1000);
 302         while (time_before(jiffies, timeout))
 303                 cpu_relax();
 304 }
 305
 306 /*
 307  * reset FPGA
 308  */
 309
 310 static void fpga_reset(int iobase)
 311 {
 312         outb(0, IER(iobase));
 313         outb(LCR_DLAB | LCR_BIT5, LCR(iobase));
 314         outb(1, DLL(iobase));
 315         outb(0, DLM(iobase));
 316
 317         outb(LCR_BIT5, LCR(iobase));
 318         inb(LSR(iobase));
 319         inb(MSR(iobase));
 320         /* turn off FPGA supply voltage */
 321         outb(MCR_OUT1 | MCR_OUT2, MCR(iobase));
 322         delay(100);
 323         /* turn on FPGA supply voltage again */
 324         outb(MCR_DTR | MCR_RTS | MCR_OUT1 | MCR_OUT2, MCR(iobase));
 325         delay(100);
 326 }
 327
 328 /*
 329  * send one byte to FPGA
 330  */
 331
 332 static int fpga_write(int iobase, unsigned char wrd)
 333 {
 334         unsigned char bit;
 335         int k;
 336         unsigned long timeout = jiffies + HZ / 10;
 337
 338         for (k = 0; k < 8; k++) {
 339                 bit = (wrd & 0x80) ? (MCR_RTS | MCR_DTR) : MCR_DTR;
 340                 outb(bit | MCR_OUT1 | MCR_OUT2, MCR(iobase));
 341                 wrd <<= 1;
 342                 outb(0xfc, THR(iobase));
 343                 while ((inb(LSR(iobase)) & LSR_TSRE) == 0)
 344                         if (time_after(jiffies, timeout))
 345                                 return -1;
 346         }
 347
 348         return 0;
 349 }
 350
 351 static unsigned char *add_mcs(unsigned char *bits, int bitrate)
 352 {
 353         struct yam_mcs *p;
 354
 355         /* If it already exists, replace the bit data */
 356         p = yam_data;
 357         while (p) {
 358                 if (p->bitrate == bitrate) {
 359                         memcpy(p->bits, bits, YAM_FPGA_SIZE);
 360                         return p->bits;
 361                 }
 362                 p = p->next;
 363         }
 364
 365         /* Allocate a new mcs */
 366         if ((p = kmalloc(sizeof(struct yam_mcs), GFP_KERNEL)) == NULL) {
 367                 printk(KERN_WARNING "YAM: no memory to allocate mcs\n");
 368                 return NULL;
 369         }
 370         memcpy(p->bits, bits, YAM_FPGA_SIZE);
 371         p->bitrate = bitrate;
 372         p->next = yam_data;
 373         yam_data = p;
 374
 375         return p->bits;
 376 }
 377
 378 static unsigned char *get_mcs(int bitrate)
 379 {
 380         struct yam_mcs *p;
 381
 382         p = yam_data;
 383         while (p) {
 384                 if (p->bitrate == bitrate)
 385                         return p->bits;
 386                 p = p->next;
 387         }
 388
 389         /* Load predefined mcs data */
 390         switch (bitrate) {
 391         case 1200:
 392                 return add_mcs(bits_1200, bitrate);
 393         default:
 394                 return add_mcs(bits_9600, bitrate);
 395         }
 396 }
 397
 398 /*
 399  * download bitstream to FPGA
 400  * data is contained in bits[] array in yam1200.h resp. yam9600.h
 401  */
 402
 403 static int fpga_download(int iobase, int bitrate)
 404 {
 405         int i, rc;
 406         unsigned char *pbits;
 407
 408         pbits = get_mcs(bitrate);
 409         if (pbits == NULL)
 410                 return -1;
 411
 412         fpga_reset(iobase);
 413         for (i = 0; i < YAM_FPGA_SIZE; i++) {
 414                 if (fpga_write(iobase, pbits[i])) {
 415                         printk(KERN_ERR "yam: error in write cycle\n");
 416                         return -1;                      /* write... */
 417                 }
 418         }
 419
 420         fpga_write(iobase, 0xFF);
 421         rc = inb(MSR(iobase));          /* check DONE signal */
 422
 423         /* Needed for some hardwares */
 424         delay(50);
 425
 426         return (rc & MSR_DSR) ? 0 : -1;
 427 }
 428
 429
 430 /************************************************************************
 431 * Serial port init
 432 ************************************************************************/
 433
 434 static void yam_set_uart(struct net_device *dev)
 435 {
 436         struct yam_port *yp = netdev_priv(dev);
 437         int divisor = 115200 / yp->baudrate;
 438
 439         outb(0, IER(dev->base_addr));
 440         outb(LCR_DLAB | LCR_BIT8, LCR(dev->base_addr));
 441         outb(divisor, DLL(dev->base_addr));
 442         outb(0, DLM(dev->base_addr));
 443         outb(LCR_BIT8, LCR(dev->base_addr));
 444         outb(PTT_OFF, MCR(dev->base_addr));
 445         outb(0x00, FCR(dev->base_addr));
 446
 447         /* Flush pending irq */
 448
 449         inb(RBR(dev->base_addr));
 450         inb(MSR(dev->base_addr));
 451
 452         /* Enable rx irq */
 453
 454         outb(ENABLE_RTXINT, IER(dev->base_addr));
 455 }
 456
 457
 458 /* --------------------------------------------------------------------- */
 459
 460 enum uart {
 461         c_uart_unknown, c_uart_8250,
 462         c_uart_16450, c_uart_16550, c_uart_16550A
 463 };
 464
 465 static const char *uart_str[] =
 466 {"unknown", "8250", "16450", "16550", "16550A"};
 467
 468 static enum uart yam_check_uart(unsigned int iobase)
 469 {
 470         unsigned char b1, b2, b3;
 471         enum uart u;
 472         enum uart uart_tab[] =
 473         {c_uart_16450, c_uart_unknown, c_uart_16550, c_uart_16550A};
 474
 475         b1 = inb(MCR(iobase));
 476         outb(b1 | 0x10, MCR(iobase));   /* loopback mode */
 477         b2 = inb(MSR(iobase));
 478         outb(0x1a, MCR(iobase));
 479         b3 = inb(MSR(iobase)) & 0xf0;
 480         outb(b1, MCR(iobase));          /* restore old values */
 481         outb(b2, MSR(iobase));
 482         if (b3 != 0x90)
 483                 return c_uart_unknown;
 484         inb(RBR(iobase));
 485         inb(RBR(iobase));
 486         outb(0x01, FCR(iobase));        /* enable FIFOs */
 487         u = uart_tab[(inb(IIR(iobase)) >> 6) & 3];
 488         if (u == c_uart_16450) {
 489                 outb(0x5a, SCR(iobase));
 490                 b1 = inb(SCR(iobase));
 491                 outb(0xa5, SCR(iobase));
 492                 b2 = inb(SCR(iobase));
 493                 if ((b1 != 0x5a) || (b2 != 0xa5))
 494                         u = c_uart_8250;
 495         }
 496         return u;
 497 }
 498
 499 /******************************************************************************
 500 * Rx Section
 501 ******************************************************************************/
 502 static inline void yam_rx_flag(struct net_device *dev, struct yam_port *yp)
 503 {
 504         if (yp->dcd && yp->rx_len >= 3 && yp->rx_len < YAM_MAX_FRAME) {
 505                 int pkt_len = yp->rx_len - 2 + 1;       /* -CRC + kiss */
 506                 struct sk_buff *skb;
 507
 508                 if ((yp->rx_crch & yp->rx_crcl) != 0xFF) {
 509                         /* Bad crc */
 510                 } else {
 511                         if (!(skb = dev_alloc_skb(pkt_len))) {
 512                                 printk(KERN_WARNING "%s: memory squeeze, dropping packet\n", dev->name);
 513                                 ++yp->stats.rx_dropped;
 514                         } else {
 515                                 unsigned char *cp;
 516                                 cp = skb_put(skb, pkt_len);
 517                                 *cp++ = 0;              /* KISS kludge */
 518                                 memcpy(cp, yp->rx_buf, pkt_len - 1);
 519                                 skb->protocol = ax25_type_trans(skb, dev);
 520                                 netif_rx(skb);
 521                                 dev->last_rx = jiffies;
 522                                 ++yp->stats.rx_packets;
 523                         }
 524                 }
 525         }
 526         yp->rx_len = 0;
 527         yp->rx_crcl = 0x21;
 528         yp->rx_crch = 0xf3;
 529 }
 530
 531 static inline void yam_rx_byte(struct net_device *dev, struct yam_port *yp, unsigned char rxb)
 532 {
 533         if (yp->rx_len < YAM_MAX_FRAME) {
 534                 unsigned char c = yp->rx_crcl;
 535                 yp->rx_crcl = (chktabl[c] ^ yp->rx_crch);
 536                 yp->rx_crch = (chktabh[c] ^ rxb);
 537                 yp->rx_buf[yp->rx_len++] = rxb;
 538         }
 539 }
 540
 541 /********************************************************************************
 542 * TX Section
 543 ********************************************************************************/
 544
 545 static void ptt_on(struct net_device *dev)
 546 {
 547         outb(PTT_ON, MCR(dev->base_addr));
 548 }
 549
 550 static void ptt_off(struct net_device *dev)
 551 {
 552         outb(PTT_OFF, MCR(dev->base_addr));
 553 }
 554
 555 static int yam_send_packet(struct sk_buff *skb, struct net_device *dev)
 556 {
 557         struct yam_port *yp = netdev_priv(dev);
 558
 559         skb_queue_tail(&yp->send_queue, skb);
 560         dev->trans_start = jiffies;
 561         return 0;
 562 }
 563
 564 static void yam_start_tx(struct net_device *dev, struct yam_port *yp)
 565 {
 566         if ((yp->tx_state == TX_TAIL) || (yp->txd == 0))
 567                 yp->tx_count = 1;
 568         else
 569                 yp->tx_count = (yp->bitrate * yp->txd) / 8000;
 570         yp->tx_state = TX_HEAD;
 571         ptt_on(dev);
 572 }
 573
 574 static unsigned short random_seed;
 575
 576 static inline unsigned short random_num(void)
 577 {
 578         random_seed = 28629 * random_seed + 157;
 579         return random_seed;
 580 }
 581
 582 static void yam_arbitrate(struct net_device *dev)
 583 {
 584         struct yam_port *yp = netdev_priv(dev);
 585
 586         if (yp->magic != YAM_MAGIC || yp->tx_state != TX_OFF ||
 587             skb_queue_empty(&yp->send_queue))
 588                 return;
 589         /* tx_state is TX_OFF and there is data to send */
 590
 591         if (yp->dupmode) {
 592                 /* Full duplex mode, don't wait */
 593                 yam_start_tx(dev, yp);
 594                 return;
 595         }
 596         if (yp->dcd) {
 597                 /* DCD on, wait slotime ... */
 598                 yp->slotcnt = yp->slot / 10;
 599                 return;
 600         }
 601         /* Is slottime passed ? */
 602         if ((--yp->slotcnt) > 0)
 603                 return;
 604
 605         yp->slotcnt = yp->slot / 10;
 606
 607         /* is random > persist ? */
 608         if ((random_num() % 256) > yp->pers)
 609                 return;
 610
 611         yam_start_tx(dev, yp);
 612 }
 613
 614 static void yam_dotimer(unsigned long dummy)
 615 {
 616         int i;
 617
 618         for (i = 0; i < NR_PORTS; i++) {
 619                 struct net_device *dev = yam_devs[i];
 620                 if (dev && netif_running(dev))
 621                         yam_arbitrate(dev);
 622         }
 623         yam_timer.expires = jiffies + HZ / 100;
 624         add_timer(&yam_timer);
 625 }
 626
 627 static void yam_tx_byte(struct net_device *dev, struct yam_port *yp)
 628 {
 629         struct sk_buff *skb;
 630         unsigned char b, temp;
 631
 632         switch (yp->tx_state) {
 633         case TX_OFF:
 634                 break;
 635         case TX_HEAD:
 636                 if (--yp->tx_count <= 0) {
 637                         if (!(skb = skb_dequeue(&yp->send_queue))) {
 638                                 ptt_off(dev);
 639                                 yp->tx_state = TX_OFF;
 640                                 break;
 641                         }
 642                         yp->tx_state = TX_DATA;
 643                         if (skb->data[0] != 0) {
 644 /*                              do_kiss_params(s, skb->data, skb->len); */
 645                                 dev_kfree_skb_any(skb);
 646                                 break;
 647                         }
 648                         yp->tx_len = skb->len - 1;      /* strip KISS byte */
 649                         if (yp->tx_len >= YAM_MAX_FRAME || yp->tx_len < 2) {
 650                                 dev_kfree_skb_any(skb);
 651                                 break;
 652                         }
 653                         memcpy(yp->tx_buf, skb->data + 1, yp->tx_len);
 654                         dev_kfree_skb_any(skb);
 655                         yp->tx_count = 0;
 656                         yp->tx_crcl = 0x21;
 657                         yp->tx_crch = 0xf3;
 658                         yp->tx_state = TX_DATA;
 659                 }
 660                 break;
 661         case TX_DATA:
 662                 b = yp->tx_buf[yp->tx_count++];
 663                 outb(b, THR(dev->base_addr));
 664                 temp = yp->tx_crcl;
 665                 yp->tx_crcl = chktabl[temp] ^ yp->tx_crch;
 666                 yp->tx_crch = chktabh[temp] ^ b;
 667                 if (yp->tx_count >= yp->tx_len) {
 668                         yp->tx_state = TX_CRC1;
 669                 }
 670                 break;
 671         case TX_CRC1:
 672                 yp->tx_crch = chktabl[yp->tx_crcl] ^ yp->tx_crch;
 673                 yp->tx_crcl = chktabh[yp->tx_crcl] ^ chktabl[yp->tx_crch] ^ 0xff;
 674                 outb(yp->tx_crcl, THR(dev->base_addr));
 675                 yp->tx_state = TX_CRC2;
 676                 break;
 677         case TX_CRC2:
 678                 outb(chktabh[yp->tx_crch] ^ 0xFF, THR(dev->base_addr));
 679                 if (skb_queue_empty(&yp->send_queue)) {
 680                         yp->tx_count = (yp->bitrate * yp->txtail) / 8000;
 681                         if (yp->dupmode == 2)
 682                                 yp->tx_count += (yp->bitrate * yp->holdd) / 8;
 683                         if (yp->tx_count == 0)
 684                                 yp->tx_count = 1;
 685                         yp->tx_state = TX_TAIL;
 686                 } else {
 687                         yp->tx_count = 1;
 688                         yp->tx_state = TX_HEAD;
 689                 }
 690                 ++yp->stats.tx_packets;
 691                 break;
 692         case TX_TAIL:
 693                 if (--yp->tx_count <= 0) {
 694                         yp->tx_state = TX_OFF;
 695                         ptt_off(dev);
 696                 }
 697                 break;
 698         }
 699 }
 700
 701 /***********************************************************************************
 702 * ISR routine
 703 ************************************************************************************/
 704
 705 static irqreturn_t yam_interrupt(int irq, void *dev_id, struct pt_regs *regs)
 706 {
 707         struct net_device *dev;
 708         struct yam_port *yp;
 709         unsigned char iir;
 710         int counter = 100;
 711         int i;
 712         int handled = 0;
 713
 714         for (i = 0; i < NR_PORTS; i++) {
 715                 dev = yam_devs[i];
 716                 yp = netdev_priv(dev);
 717
 718                 if (!netif_running(dev))
 719                         continue;
 720
 721                 while ((iir = IIR_MASK & inb(IIR(dev->base_addr))) != IIR_NOPEND) {
 722                         unsigned char msr = inb(MSR(dev->base_addr));
 723                         unsigned char lsr = inb(LSR(dev->base_addr));
 724                         unsigned char rxb;
 725
 726                         handled = 1;
 727
 728                         if (lsr & LSR_OE)
 729                                 ++yp->stats.rx_fifo_errors;
 730
 731                         yp->dcd = (msr & RX_DCD) ? 1 : 0;
 732
 733                         if (--counter <= 0) {
 734                                 printk(KERN_ERR "%s: too many irq iir=%d\n",
 735                                                 dev->name, iir);
 736                                 goto out;
 737                         }
 738                         if (msr & TX_RDY) {
 739                                 ++yp->nb_mdint;
 740                                 yam_tx_byte(dev, yp);
 741                         }
 742                         if (lsr & LSR_RXC) {
 743                                 ++yp->nb_rxint;
 744                                 rxb = inb(RBR(dev->base_addr));
 745                                 if (msr & RX_FLAG)
 746                                         yam_rx_flag(dev, yp);
 747                                 else
 748                                         yam_rx_byte(dev, yp, rxb);
 749                         }
 750                 }
 751         }
 752 out:
 753         return IRQ_RETVAL(handled);
 754 }
 755
 756 #ifdef CONFIG_PROC_FS
 757
 758 static void *yam_seq_start(struct seq_file *seq, loff_t *pos)
 759 {
 760         return (*pos < NR_PORTS) ? yam_devs[*pos] : NULL;
 761 }
 762
 763 static void *yam_seq_next(struct seq_file *seq, void *v, loff_t *pos)
 764 {
 765         ++*pos;
 766         return (*pos < NR_PORTS) ? yam_devs[*pos] : NULL;
 767 }
 768
 769 static void yam_seq_stop(struct seq_file *seq, void *v)
 770 {
 771 }
 772
 773 static int yam_seq_show(struct seq_file *seq, void *v)
 774 {
 775         struct net_device *dev = v;
 776         const struct yam_port *yp = netdev_priv(dev);
 777
 778         seq_printf(seq, "Device %s\n", dev->name);
 779         seq_printf(seq, "  Up       %d\n", netif_running(dev));
 780         seq_printf(seq, "  Speed    %u\n", yp->bitrate);
 781         seq_printf(seq, "  IoBase   0x%x\n", yp->iobase);
 782         seq_printf(seq, "  BaudRate %u\n", yp->baudrate);
 783         seq_printf(seq, "  IRQ      %u\n", yp->irq);
 784         seq_printf(seq, "  TxState  %u\n", yp->tx_state);
 785         seq_printf(seq, "  Duplex   %u\n", yp->dupmode);
 786         seq_printf(seq, "  HoldDly  %u\n", yp->holdd);
 787         seq_printf(seq, "  TxDelay  %u\n", yp->txd);
 788         seq_printf(seq, "  TxTail   %u\n", yp->txtail);
 789         seq_printf(seq, "  SlotTime %u\n", yp->slot);
 790         seq_printf(seq, "  Persist  %u\n", yp->pers);
 791         seq_printf(seq, "  TxFrames %lu\n", yp->stats.tx_packets);
 792         seq_printf(seq, "  RxFrames %lu\n", yp->stats.rx_packets);
 793         seq_printf(seq, "  TxInt    %u\n", yp->nb_mdint);
 794         seq_printf(seq, "  RxInt    %u\n", yp->nb_rxint);
 795         seq_printf(seq, "  RxOver   %lu\n", yp->stats.rx_fifo_errors);
 796         seq_printf(seq, "\n");
 797         return 0;
 798 }
 799
 800 static struct seq_operations yam_seqops = {
 801         .start = yam_seq_start,
 802         .next = yam_seq_next,
 803         .stop = yam_seq_stop,
 804         .show = yam_seq_show,
 805 };
 806
 807 static int yam_info_open(struct inode *inode, struct file *file)
 808 {
 809         return seq_open(file, &yam_seqops);
 810 }
 811
 812 static struct file_operations yam_info_fops = {
 813         .owner = THIS_MODULE,
 814         .open = yam_info_open,
 815         .read = seq_read,
 816         .llseek = seq_lseek,
 817         .release = seq_release,
 818 };
 819
 820 #endif
 821
 822
 823 /* --------------------------------------------------------------------- */
 824
 825 static struct net_device_stats *yam_get_stats(struct net_device *dev)
 826 {
 827         struct yam_port *yp;
 828
 829         if (!dev)
 830                 return NULL;
 831
 832         yp = netdev_priv(dev);
 833         if (yp->magic != YAM_MAGIC)
 834                 return NULL;
 835
 836         /*
 837          * Get the current statistics.  This may be called with the
 838          * card open or closed.
 839          */
 840         return &yp->stats;
 841 }
 842
 843 /* --------------------------------------------------------------------- */
 844
 845 static int yam_open(struct net_device *dev)
 846 {
 847         struct yam_port *yp = netdev_priv(dev);
 848         enum uart u;
 849         int i;
 850         int ret=0;
 851
 852         printk(KERN_INFO "Trying %s at iobase 0x%lx irq %u\n", dev->name, dev->base_addr, dev->irq);
 853
 854         if (!dev || !yp->bitrate)
 855                 return -ENXIO;
 856         if (!dev->base_addr || dev->base_addr > 0x1000 - YAM_EXTENT ||
 857                 dev->irq < 2 || dev->irq > 15) {
 858                 return -ENXIO;
 859         }
 860         if (!request_region(dev->base_addr, YAM_EXTENT, dev->name))
 861         {
 862                 printk(KERN_ERR "%s: cannot 0x%lx busy\n", dev->name, dev->base_addr);
 863                 return -EACCES;
 864         }
 865         if ((u = yam_check_uart(dev->base_addr)) == c_uart_unknown) {
 866                 printk(KERN_ERR "%s: cannot find uart type\n", dev->name);
 867                 ret = -EIO;
 868                 goto out_release_base;
 869         }
 870         if (fpga_download(dev->base_addr, yp->bitrate)) {
 871                 printk(KERN_ERR "%s: cannot init FPGA\n", dev->name);
 872                 ret = -EIO;
 873                 goto out_release_base;
 874         }
 875         outb(0, IER(dev->base_addr));
 876         if (request_irq(dev->irq, yam_interrupt, IRQF_DISABLED | IRQF_SHARED, dev->name, dev)) {
 877                 printk(KERN_ERR "%s: irq %d busy\n", dev->name, dev->irq);
 878                 ret = -EBUSY;
 879                 goto out_release_base;
 880         }
 881
 882         yam_set_uart(dev);
 883
 884         netif_start_queue(dev);
 885
 886         yp->slotcnt = yp->slot / 10;
 887
 888         /* Reset overruns for all ports - FPGA programming makes overruns */
 889         for (i = 0; i < NR_PORTS; i++) {
 890                 struct net_device *dev = yam_devs[i];
 891                 struct yam_port *yp = netdev_priv(dev);
 892                 inb(LSR(dev->base_addr));
 893                 yp->stats.rx_fifo_errors = 0;
 894         }
 895
 896         printk(KERN_INFO "%s at iobase 0x%lx irq %u uart %s\n", dev->name, dev->base_addr, dev->irq,
 897                    uart_str[u]);
 898         return 0;
 899
 900 out_release_base:
 901         release_region(dev->base_addr, YAM_EXTENT);
 902         return ret;
 903 }
 904
 905 /* --------------------------------------------------------------------- */
 906
 907 static int yam_close(struct net_device *dev)
 908 {
 909         struct sk_buff *skb;
 910         struct yam_port *yp = netdev_priv(dev);
 911
 912         if (!dev)
 913                 return -EINVAL;
 914
 915         /*
 916          * disable interrupts
 917          */
 918         outb(0, IER(dev->base_addr));
 919         outb(1, MCR(dev->base_addr));
 920         /* Remove IRQ handler if last */
 921         free_irq(dev->irq,dev);
 922         release_region(dev->base_addr, YAM_EXTENT);
 923         netif_stop_queue(dev);
 924         while ((skb = skb_dequeue(&yp->send_queue)))
 925                 dev_kfree_skb(skb);
 926
 927         printk(KERN_INFO "%s: close yam at iobase 0x%lx irq %u\n",
 928                    yam_drvname, dev->base_addr, dev->irq);
 929         return 0;
 930 }
 931
 932 /* --------------------------------------------------------------------- */
 933
 934 static int yam_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
 935 {
 936         struct yam_port *yp = netdev_priv(dev);
 937         struct yamdrv_ioctl_cfg yi;
 938         struct yamdrv_ioctl_mcs *ym;
 939         int ioctl_cmd;
 940
 941         if (copy_from_user(&ioctl_cmd, ifr->ifr_data, sizeof(int)))
 942                  return -EFAULT;
 943
 944         if (yp->magic != YAM_MAGIC)
 945                 return -EINVAL;
 946
 947         if (!capable(CAP_NET_ADMIN))
 948                 return -EPERM;
 949
 950         if (cmd != SIOCDEVPRIVATE)
 951                 return -EINVAL;
 952
 953         switch (ioctl_cmd) {
 954
 955         case SIOCYAMRESERVED:
 956                 return -EINVAL;                 /* unused */
 957
 958         case SIOCYAMSMCS:
 959                 if (netif_running(dev))
 960                         return -EINVAL;         /* Cannot change this parameter when up */
 961                 if ((ym = kmalloc(sizeof(struct yamdrv_ioctl_mcs), GFP_KERNEL)) == NULL)
 962                         return -ENOBUFS;
 963                 ym->bitrate = 9600;
 964                 if (copy_from_user(ym, ifr->ifr_data, sizeof(struct yamdrv_ioctl_mcs))) {
 965                         kfree(ym);
 966                         return -EFAULT;
 967                 }
 968                 if (ym->bitrate > YAM_MAXBITRATE) {
 969                         kfree(ym);
 970                         return -EINVAL;
 971                 }
 972                 add_mcs(ym->bits, ym->bitrate);
 973                 kfree(ym);
 974                 break;
 975
 976         case SIOCYAMSCFG:
 977                 if (!capable(CAP_SYS_RAWIO))
 978                         return -EPERM;
 979                 if (copy_from_user(&yi, ifr->ifr_data, sizeof(struct yamdrv_ioctl_cfg)))
 980                          return -EFAULT;
 981
 982                 if ((yi.cfg.mask & YAM_IOBASE) && netif_running(dev))
 983                         return -EINVAL;         /* Cannot change this parameter when up */
 984                 if ((yi.cfg.mask & YAM_IRQ) && netif_running(dev))
 985                         return -EINVAL;         /* Cannot change this parameter when up */
 986                 if ((yi.cfg.mask & YAM_BITRATE) && netif_running(dev))
 987                         return -EINVAL;         /* Cannot change this parameter when up */
 988                 if ((yi.cfg.mask & YAM_BAUDRATE) && netif_running(dev))
 989                         return -EINVAL;         /* Cannot change this parameter when up */
 990
 991                 if (yi.cfg.mask & YAM_IOBASE) {
 992                         yp->iobase = yi.cfg.iobase;
 993                         dev->base_addr = yi.cfg.iobase;
 994                 }
 995                 if (yi.cfg.mask & YAM_IRQ) {
 996                         if (yi.cfg.irq > 15)
 997                                 return -EINVAL;
 998                         yp->irq = yi.cfg.irq;
 999                         dev->irq = yi.cfg.irq;
1000                 }
1001                 if (yi.cfg.mask & YAM_BITRATE) {
1002                         if (yi.cfg.bitrate > YAM_MAXBITRATE)
1003                                 return -EINVAL;
1004                         yp->bitrate = yi.cfg.bitrate;
1005                 }
1006                 if (yi.cfg.mask & YAM_BAUDRATE) {
1007                         if (yi.cfg.baudrate > YAM_MAXBAUDRATE)
1008                                 return -EINVAL;
1009                         yp->baudrate = yi.cfg.baudrate;
1010                 }
1011                 if (yi.cfg.mask & YAM_MODE) {
1012                         if (yi.cfg.mode > YAM_MAXMODE)
1013                                 return -EINVAL;
1014                         yp->dupmode = yi.cfg.mode;
1015                 }
1016                 if (yi.cfg.mask & YAM_HOLDDLY) {
1017                         if (yi.cfg.holddly > YAM_MAXHOLDDLY)
1018                                 return -EINVAL;
1019                         yp->holdd = yi.cfg.holddly;
1020                 }
1021                 if (yi.cfg.mask & YAM_TXDELAY) {
1022                         if (yi.cfg.txdelay > YAM_MAXTXDELAY)
1023                                 return -EINVAL;
1024                         yp->txd = yi.cfg.txdelay;
1025                 }
1026                 if (yi.cfg.mask & YAM_TXTAIL) {
1027                         if (yi.cfg.txtail > YAM_MAXTXTAIL)
1028                                 return -EINVAL;
1029                         yp->txtail = yi.cfg.txtail;
1030                 }
1031                 if (yi.cfg.mask & YAM_PERSIST) {
1032                         if (yi.cfg.persist > YAM_MAXPERSIST)
1033                                 return -EINVAL;
1034                         yp->pers = yi.cfg.persist;
1035                 }
1036                 if (yi.cfg.mask & YAM_SLOTTIME) {
1037                         if (yi.cfg.slottime > YAM_MAXSLOTTIME)
1038                                 return -EINVAL;
1039                         yp->slot = yi.cfg.slottime;
1040                         yp->slotcnt = yp->slot / 10;
1041                 }
1042                 break;
1043
1044         case SIOCYAMGCFG:
1045                 yi.cfg.mask = 0xffffffff;
1046                 yi.cfg.iobase = yp->iobase;
1047                 yi.cfg.irq = yp->irq;
1048                 yi.cfg.bitrate = yp->bitrate;
1049                 yi.cfg.baudrate = yp->baudrate;
1050                 yi.cfg.mode = yp->dupmode;
1051                 yi.cfg.txdelay = yp->txd;
1052                 yi.cfg.holddly = yp->holdd;
1053                 yi.cfg.txtail = yp->txtail;
1054                 yi.cfg.persist = yp->pers;
1055                 yi.cfg.slottime = yp->slot;
1056                 if (copy_to_user(ifr->ifr_data, &yi, sizeof(struct yamdrv_ioctl_cfg)))
1057                          return -EFAULT;
1058                 break;
1059
1060         default:
1061                 return -EINVAL;
1062
1063         }
1064
1065         return 0;
1066 }
1067
1068 /* --------------------------------------------------------------------- */
1069
1070 static int yam_set_mac_address(struct net_device *dev, void *addr)
1071 {
1072         struct sockaddr *sa = (struct sockaddr *) addr;
1073
1074         /* addr is an AX.25 shifted ASCII mac address */
1075         memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
1076         return 0;
1077 }
1078
1079 /* --------------------------------------------------------------------- */
1080
1081 static void yam_setup(struct net_device *dev)
1082 {
1083         struct yam_port *yp = netdev_priv(dev);
1084
1085         yp->magic = YAM_MAGIC;
1086         yp->bitrate = DEFAULT_BITRATE;
1087         yp->baudrate = DEFAULT_BITRATE * 2;
1088         yp->iobase = 0;
1089         yp->irq = 0;
1090         yp->dupmode = 0;
1091         yp->holdd = DEFAULT_HOLDD;
1092         yp->txd = DEFAULT_TXD;
1093         yp->txtail = DEFAULT_TXTAIL;
1094         yp->slot = DEFAULT_SLOT;
1095         yp->pers = DEFAULT_PERS;
1096         yp->dev = dev;
1097
1098         dev->base_addr = yp->iobase;
1099         dev->irq = yp->irq;
1100
1101         dev->open = yam_open;
1102         dev->stop = yam_close;
1103         dev->do_ioctl = yam_ioctl;
1104         dev->hard_start_xmit = yam_send_packet;
1105         dev->get_stats = yam_get_stats;
1106
1107         skb_queue_head_init(&yp->send_queue);
1108
1109         dev->hard_header = ax25_hard_header;
1110         dev->rebuild_header = ax25_rebuild_header;
1111
1112         dev->set_mac_address = yam_set_mac_address;
1113
1114         dev->type = ARPHRD_AX25;
1115         dev->hard_header_len = AX25_MAX_HEADER_LEN;
1116         dev->mtu = AX25_MTU;
1117         dev->addr_len = AX25_ADDR_LEN;
1118         memcpy(dev->broadcast, ax25_bcast, AX25_ADDR_LEN);
1119         memcpy(dev->dev_addr, ax25_test, AX25_ADDR_LEN);
1120 }
1121
1122 static int __init yam_init_driver(void)
1123 {
1124         struct net_device *dev;
1125         int i, err;
1126         char name[IFNAMSIZ];
1127
1128         printk(yam_drvinfo);
1129
1130         for (i = 0; i < NR_PORTS; i++) {
1131                 sprintf(name, "yam%d", i);
1132
1133                 dev = alloc_netdev(sizeof(struct yam_port), name,
1134                                    yam_setup);
1135                 if (!dev) {
1136                         printk(KERN_ERR "yam: cannot allocate net device %s\n",
1137                                dev->name);
1138                         err = -ENOMEM;
1139                         goto error;
1140                 }
1141
1142                 err = register_netdev(dev);
1143                 if (err) {
1144                         printk(KERN_WARNING "yam: cannot register net device %s\n", dev->name);
1145                         goto error;
1146                 }
1147                 yam_devs[i] = dev;
1148
1149         }
1150
1151         yam_timer.function = yam_dotimer;
1152         yam_timer.expires = jiffies + HZ / 100;
1153         add_timer(&yam_timer);
1154
1155         proc_net_fops_create("yam", S_IRUGO, &yam_info_fops);
1156         return 0;
1157  error:
1158         while (--i >= 0) {
1159                 unregister_netdev(yam_devs[i]);
1160                 free_netdev(yam_devs[i]);
1161         }
1162         return err;
1163 }
1164
1165 /* --------------------------------------------------------------------- */
1166
1167 static void __exit yam_cleanup_driver(void)
1168 {
1169         struct yam_mcs *p;
1170         int i;
1171
1172         del_timer(&yam_timer);
1173         for (i = 0; i < NR_PORTS; i++) {
1174                 struct net_device *dev = yam_devs[i];
1175                 if (dev) {
1176                         unregister_netdev(dev);
1177                         free_netdev(dev);
1178                 }
1179         }
1180
1181         while (yam_data) {
1182                 p = yam_data;
1183                 yam_data = yam_data->next;
1184                 kfree(p);
1185         }
1186
1187         proc_net_remove("yam");
1188 }
1189
1190 /* --------------------------------------------------------------------- */
1191
1192 MODULE_AUTHOR("Frederic Rible F1OAT frible@teaser.fr");
1193 MODULE_DESCRIPTION("Yam amateur radio modem driver");
1194 MODULE_LICENSE("GPL");
1195
1196 module_init(yam_init_driver);
1197 module_exit(yam_cleanup_driver);
1198
1199 /* --------------------------------------------------------------------- */
1200