1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /*****************************************************************************/ 3 4 /* 5 * hdlcdrv.c -- HDLC packet radio network driver. 6 * 7 * Copyright (C) 1996-2000 Thomas Sailer (sailer@ife.ee.ethz.ch) 8 * 9 * Please note that the GPL allows you to use the driver, NOT the radio. 10 * In order to use the radio, you need a license from the communications 11 * authority of your country. 12 * 13 * The driver was derived from Donald Beckers skeleton.c 14 * Written 1993-94 by Donald Becker. 15 * 16 * History: 17 * 0.1 21.09.1996 Started 18 * 18.10.1996 Changed to new user space access routines 19 * (copy_{to,from}_user) 20 * 0.2 21.11.1996 various small changes 21 * 0.3 03.03.1997 fixed (hopefully) IP not working with ax.25 as a module 22 * 0.4 16.04.1997 init code/data tagged 23 * 0.5 30.07.1997 made HDLC buffers bigger (solves a problem with the 24 * soundmodem driver) 25 * 0.6 05.04.1998 add spinlocks 26 * 0.7 03.08.1999 removed some old compatibility cruft 27 * 0.8 12.02.2000 adapted to softnet driver interface 28 */ 29 30 /*****************************************************************************/ 31 32 #include <linux/capability.h> 33 #include <linux/module.h> 34 #include <linux/types.h> 35 #include <linux/net.h> 36 #include <linux/in.h> 37 #include <linux/if.h> 38 #include <linux/errno.h> 39 #include <linux/init.h> 40 #include <linux/bitops.h> 41 42 #include <linux/netdevice.h> 43 #include <linux/if_arp.h> 44 #include <linux/skbuff.h> 45 #include <linux/hdlcdrv.h> 46 #include <linux/random.h> 47 #include <net/ax25.h> 48 #include <linux/uaccess.h> 49 50 #include <linux/crc-ccitt.h> 51 52 /* --------------------------------------------------------------------- */ 53 54 #define KISS_VERBOSE 55 56 /* --------------------------------------------------------------------- */ 57 58 #define PARAM_TXDELAY 1 59 #define PARAM_PERSIST 2 60 #define PARAM_SLOTTIME 3 61 #define PARAM_TXTAIL 4 62 #define PARAM_FULLDUP 5 63 #define PARAM_HARDWARE 6 64 #define PARAM_RETURN 255 65 66 /* --------------------------------------------------------------------- */ 67 /* 68 * the CRC routines are stolen from WAMPES 69 * by Dieter Deyke 70 */ 71 72 73 /*---------------------------------------------------------------------------*/ 74 75 static inline void append_crc_ccitt(unsigned char *buffer, int len) 76 { 77 unsigned int crc = crc_ccitt(0xffff, buffer, len) ^ 0xffff; 78 buffer += len; 79 *buffer++ = crc; 80 *buffer++ = crc >> 8; 81 } 82 83 /*---------------------------------------------------------------------------*/ 84 85 static inline int check_crc_ccitt(const unsigned char *buf, int cnt) 86 { 87 return (crc_ccitt(0xffff, buf, cnt) & 0xffff) == 0xf0b8; 88 } 89 90 /*---------------------------------------------------------------------------*/ 91 92 #if 0 93 static int calc_crc_ccitt(const unsigned char *buf, int cnt) 94 { 95 unsigned int crc = 0xffff; 96 97 for (; cnt > 0; cnt--) 98 crc = (crc >> 8) ^ crc_ccitt_table[(crc ^ *buf++) & 0xff]; 99 crc ^= 0xffff; 100 return crc & 0xffff; 101 } 102 #endif 103 104 /* ---------------------------------------------------------------------- */ 105 106 #define tenms_to_2flags(s,tenms) ((tenms * s->par.bitrate) / 100 / 16) 107 108 /* ---------------------------------------------------------------------- */ 109 /* 110 * The HDLC routines 111 */ 112 113 static int hdlc_rx_add_bytes(struct hdlcdrv_state *s, unsigned int bits, 114 int num) 115 { 116 int added = 0; 117 118 while (s->hdlcrx.rx_state && num >= 8) { 119 if (s->hdlcrx.len >= sizeof(s->hdlcrx.buffer)) { 120 s->hdlcrx.rx_state = 0; 121 return 0; 122 } 123 *s->hdlcrx.bp++ = bits >> (32-num); 124 s->hdlcrx.len++; 125 num -= 8; 126 added += 8; 127 } 128 return added; 129 } 130 131 static void hdlc_rx_flag(struct net_device *dev, struct hdlcdrv_state *s) 132 { 133 struct sk_buff *skb; 134 int pkt_len; 135 unsigned char *cp; 136 137 if (s->hdlcrx.len < 4) 138 return; 139 if (!check_crc_ccitt(s->hdlcrx.buffer, s->hdlcrx.len)) 140 return; 141 pkt_len = s->hdlcrx.len - 2 + 1; /* KISS kludge */ 142 if (!(skb = dev_alloc_skb(pkt_len))) { 143 printk("%s: memory squeeze, dropping packet\n", dev->name); 144 dev->stats.rx_dropped++; 145 return; 146 } 147 cp = skb_put(skb, pkt_len); 148 *cp++ = 0; /* KISS kludge */ 149 memcpy(cp, s->hdlcrx.buffer, pkt_len - 1); 150 skb->protocol = ax25_type_trans(skb, dev); 151 netif_rx(skb); 152 dev->stats.rx_packets++; 153 } 154 155 void hdlcdrv_receiver(struct net_device *dev, struct hdlcdrv_state *s) 156 { 157 int i; 158 unsigned int mask1, mask2, mask3, mask4, mask5, mask6, word; 159 160 if (!s || s->magic != HDLCDRV_MAGIC) 161 return; 162 if (test_and_set_bit(0, &s->hdlcrx.in_hdlc_rx)) 163 return; 164 165 while (!hdlcdrv_hbuf_empty(&s->hdlcrx.hbuf)) { 166 word = hdlcdrv_hbuf_get(&s->hdlcrx.hbuf); 167 168 #ifdef HDLCDRV_DEBUG 169 hdlcdrv_add_bitbuffer_word(&s->bitbuf_hdlc, word); 170 #endif /* HDLCDRV_DEBUG */ 171 s->hdlcrx.bitstream >>= 16; 172 s->hdlcrx.bitstream |= word << 16; 173 s->hdlcrx.bitbuf >>= 16; 174 s->hdlcrx.bitbuf |= word << 16; 175 s->hdlcrx.numbits += 16; 176 for(i = 15, mask1 = 0x1fc00, mask2 = 0x1fe00, mask3 = 0x0fc00, 177 mask4 = 0x1f800, mask5 = 0xf800, mask6 = 0xffff; 178 i >= 0; 179 i--, mask1 <<= 1, mask2 <<= 1, mask3 <<= 1, mask4 <<= 1, 180 mask5 <<= 1, mask6 = (mask6 << 1) | 1) { 181 if ((s->hdlcrx.bitstream & mask1) == mask1) 182 s->hdlcrx.rx_state = 0; /* abort received */ 183 else if ((s->hdlcrx.bitstream & mask2) == mask3) { 184 /* flag received */ 185 if (s->hdlcrx.rx_state) { 186 hdlc_rx_add_bytes(s, s->hdlcrx.bitbuf 187 << (8+i), 188 s->hdlcrx.numbits 189 -8-i); 190 hdlc_rx_flag(dev, s); 191 } 192 s->hdlcrx.len = 0; 193 s->hdlcrx.bp = s->hdlcrx.buffer; 194 s->hdlcrx.rx_state = 1; 195 s->hdlcrx.numbits = i; 196 } else if ((s->hdlcrx.bitstream & mask4) == mask5) { 197 /* stuffed bit */ 198 s->hdlcrx.numbits--; 199 s->hdlcrx.bitbuf = (s->hdlcrx.bitbuf & (~mask6)) | 200 ((s->hdlcrx.bitbuf & mask6) << 1); 201 } 202 } 203 s->hdlcrx.numbits -= hdlc_rx_add_bytes(s, s->hdlcrx.bitbuf, 204 s->hdlcrx.numbits); 205 } 206 clear_bit(0, &s->hdlcrx.in_hdlc_rx); 207 } 208 209 /* ---------------------------------------------------------------------- */ 210 211 static inline void do_kiss_params(struct hdlcdrv_state *s, 212 unsigned char *data, unsigned long len) 213 { 214 215 #ifdef KISS_VERBOSE 216 #define PKP(a,b) printk(KERN_INFO "hdlcdrv.c: channel params: " a "\n", b) 217 #else /* KISS_VERBOSE */ 218 #define PKP(a,b) 219 #endif /* KISS_VERBOSE */ 220 221 if (len < 2) 222 return; 223 switch(data[0]) { 224 case PARAM_TXDELAY: 225 s->ch_params.tx_delay = data[1]; 226 PKP("TX delay = %ums", 10 * s->ch_params.tx_delay); 227 break; 228 case PARAM_PERSIST: 229 s->ch_params.ppersist = data[1]; 230 PKP("p persistence = %u", s->ch_params.ppersist); 231 break; 232 case PARAM_SLOTTIME: 233 s->ch_params.slottime = data[1]; 234 PKP("slot time = %ums", s->ch_params.slottime); 235 break; 236 case PARAM_TXTAIL: 237 s->ch_params.tx_tail = data[1]; 238 PKP("TX tail = %ums", s->ch_params.tx_tail); 239 break; 240 case PARAM_FULLDUP: 241 s->ch_params.fulldup = !!data[1]; 242 PKP("%s duplex", s->ch_params.fulldup ? "full" : "half"); 243 break; 244 default: 245 break; 246 } 247 #undef PKP 248 } 249 250 /* ---------------------------------------------------------------------- */ 251 252 void hdlcdrv_transmitter(struct net_device *dev, struct hdlcdrv_state *s) 253 { 254 unsigned int mask1, mask2, mask3; 255 int i; 256 struct sk_buff *skb; 257 int pkt_len; 258 259 if (!s || s->magic != HDLCDRV_MAGIC) 260 return; 261 if (test_and_set_bit(0, &s->hdlctx.in_hdlc_tx)) 262 return; 263 for (;;) { 264 if (s->hdlctx.numbits >= 16) { 265 if (hdlcdrv_hbuf_full(&s->hdlctx.hbuf)) { 266 clear_bit(0, &s->hdlctx.in_hdlc_tx); 267 return; 268 } 269 hdlcdrv_hbuf_put(&s->hdlctx.hbuf, s->hdlctx.bitbuf); 270 s->hdlctx.bitbuf >>= 16; 271 s->hdlctx.numbits -= 16; 272 } 273 switch (s->hdlctx.tx_state) { 274 default: 275 clear_bit(0, &s->hdlctx.in_hdlc_tx); 276 return; 277 case 0: 278 case 1: 279 if (s->hdlctx.numflags) { 280 s->hdlctx.numflags--; 281 s->hdlctx.bitbuf |= 282 0x7e7e << s->hdlctx.numbits; 283 s->hdlctx.numbits += 16; 284 break; 285 } 286 if (s->hdlctx.tx_state == 1) { 287 clear_bit(0, &s->hdlctx.in_hdlc_tx); 288 return; 289 } 290 if (!(skb = s->skb)) { 291 int flgs = tenms_to_2flags(s, s->ch_params.tx_tail); 292 if (flgs < 2) 293 flgs = 2; 294 s->hdlctx.tx_state = 1; 295 s->hdlctx.numflags = flgs; 296 break; 297 } 298 s->skb = NULL; 299 netif_wake_queue(dev); 300 pkt_len = skb->len-1; /* strip KISS byte */ 301 if (pkt_len >= HDLCDRV_MAXFLEN || pkt_len < 2) { 302 s->hdlctx.tx_state = 0; 303 s->hdlctx.numflags = 1; 304 dev_kfree_skb_irq(skb); 305 break; 306 } 307 skb_copy_from_linear_data_offset(skb, 1, 308 s->hdlctx.buffer, 309 pkt_len); 310 dev_kfree_skb_irq(skb); 311 s->hdlctx.bp = s->hdlctx.buffer; 312 append_crc_ccitt(s->hdlctx.buffer, pkt_len); 313 s->hdlctx.len = pkt_len+2; /* the appended CRC */ 314 s->hdlctx.tx_state = 2; 315 s->hdlctx.bitstream = 0; 316 dev->stats.tx_packets++; 317 break; 318 case 2: 319 if (!s->hdlctx.len) { 320 s->hdlctx.tx_state = 0; 321 s->hdlctx.numflags = 1; 322 break; 323 } 324 s->hdlctx.len--; 325 s->hdlctx.bitbuf |= *s->hdlctx.bp << 326 s->hdlctx.numbits; 327 s->hdlctx.bitstream >>= 8; 328 s->hdlctx.bitstream |= (*s->hdlctx.bp++) << 16; 329 mask1 = 0x1f000; 330 mask2 = 0x10000; 331 mask3 = 0xffffffff >> (31-s->hdlctx.numbits); 332 s->hdlctx.numbits += 8; 333 for(i = 0; i < 8; i++, mask1 <<= 1, mask2 <<= 1, 334 mask3 = (mask3 << 1) | 1) { 335 if ((s->hdlctx.bitstream & mask1) != mask1) 336 continue; 337 s->hdlctx.bitstream &= ~mask2; 338 s->hdlctx.bitbuf = 339 (s->hdlctx.bitbuf & mask3) | 340 ((s->hdlctx.bitbuf & 341 (~mask3)) << 1); 342 s->hdlctx.numbits++; 343 mask3 = (mask3 << 1) | 1; 344 } 345 break; 346 } 347 } 348 } 349 350 /* ---------------------------------------------------------------------- */ 351 352 static void start_tx(struct net_device *dev, struct hdlcdrv_state *s) 353 { 354 s->hdlctx.tx_state = 0; 355 s->hdlctx.numflags = tenms_to_2flags(s, s->ch_params.tx_delay); 356 s->hdlctx.bitbuf = s->hdlctx.bitstream = s->hdlctx.numbits = 0; 357 hdlcdrv_transmitter(dev, s); 358 s->hdlctx.ptt = 1; 359 s->ptt_keyed++; 360 } 361 362 /* ---------------------------------------------------------------------- */ 363 364 void hdlcdrv_arbitrate(struct net_device *dev, struct hdlcdrv_state *s) 365 { 366 if (!s || s->magic != HDLCDRV_MAGIC || s->hdlctx.ptt || !s->skb) 367 return; 368 if (s->ch_params.fulldup) { 369 start_tx(dev, s); 370 return; 371 } 372 if (s->hdlcrx.dcd) { 373 s->hdlctx.slotcnt = s->ch_params.slottime; 374 return; 375 } 376 if ((--s->hdlctx.slotcnt) > 0) 377 return; 378 s->hdlctx.slotcnt = s->ch_params.slottime; 379 if ((prandom_u32() % 256) > s->ch_params.ppersist) 380 return; 381 start_tx(dev, s); 382 } 383 384 /* --------------------------------------------------------------------- */ 385 /* 386 * ===================== network driver interface ========================= 387 */ 388 389 static netdev_tx_t hdlcdrv_send_packet(struct sk_buff *skb, 390 struct net_device *dev) 391 { 392 struct hdlcdrv_state *sm = netdev_priv(dev); 393 394 if (skb->protocol == htons(ETH_P_IP)) 395 return ax25_ip_xmit(skb); 396 397 if (skb->data[0] != 0) { 398 do_kiss_params(sm, skb->data, skb->len); 399 dev_kfree_skb(skb); 400 return NETDEV_TX_OK; 401 } 402 if (sm->skb) { 403 dev_kfree_skb(skb); 404 return NETDEV_TX_OK; 405 } 406 netif_stop_queue(dev); 407 sm->skb = skb; 408 return NETDEV_TX_OK; 409 } 410 411 /* --------------------------------------------------------------------- */ 412 413 static int hdlcdrv_set_mac_address(struct net_device *dev, void *addr) 414 { 415 struct sockaddr *sa = (struct sockaddr *)addr; 416 417 /* addr is an AX.25 shifted ASCII mac address */ 418 dev_addr_set(dev, sa->sa_data); 419 return 0; 420 } 421 422 /* --------------------------------------------------------------------- */ 423 /* 424 * Open/initialize the board. This is called (in the current kernel) 425 * sometime after booting when the 'ifconfig' program is run. 426 * 427 * This routine should set everything up anew at each open, even 428 * registers that "should" only need to be set once at boot, so that 429 * there is non-reboot way to recover if something goes wrong. 430 */ 431 432 static int hdlcdrv_open(struct net_device *dev) 433 { 434 struct hdlcdrv_state *s = netdev_priv(dev); 435 int i; 436 437 if (!s->ops || !s->ops->open) 438 return -ENODEV; 439 440 /* 441 * initialise some variables 442 */ 443 s->opened = 1; 444 s->hdlcrx.hbuf.rd = s->hdlcrx.hbuf.wr = 0; 445 s->hdlcrx.in_hdlc_rx = 0; 446 s->hdlcrx.rx_state = 0; 447 448 s->hdlctx.hbuf.rd = s->hdlctx.hbuf.wr = 0; 449 s->hdlctx.in_hdlc_tx = 0; 450 s->hdlctx.tx_state = 1; 451 s->hdlctx.numflags = 0; 452 s->hdlctx.bitstream = s->hdlctx.bitbuf = s->hdlctx.numbits = 0; 453 s->hdlctx.ptt = 0; 454 s->hdlctx.slotcnt = s->ch_params.slottime; 455 s->hdlctx.calibrate = 0; 456 457 i = s->ops->open(dev); 458 if (i) 459 return i; 460 netif_start_queue(dev); 461 return 0; 462 } 463 464 /* --------------------------------------------------------------------- */ 465 /* 466 * The inverse routine to hdlcdrv_open(). 467 */ 468 469 static int hdlcdrv_close(struct net_device *dev) 470 { 471 struct hdlcdrv_state *s = netdev_priv(dev); 472 int i = 0; 473 474 netif_stop_queue(dev); 475 476 if (s->ops && s->ops->close) 477 i = s->ops->close(dev); 478 dev_kfree_skb(s->skb); 479 s->skb = NULL; 480 s->opened = 0; 481 return i; 482 } 483 484 /* --------------------------------------------------------------------- */ 485 486 static int hdlcdrv_siocdevprivate(struct net_device *dev, struct ifreq *ifr, 487 void __user *data, int cmd) 488 { 489 struct hdlcdrv_state *s = netdev_priv(dev); 490 struct hdlcdrv_ioctl bi; 491 492 if (cmd != SIOCDEVPRIVATE) 493 return -ENOIOCTLCMD; 494 495 if (in_compat_syscall()) /* to be implemented */ 496 return -ENOIOCTLCMD; 497 498 if (copy_from_user(&bi, data, sizeof(bi))) 499 return -EFAULT; 500 501 switch (bi.cmd) { 502 default: 503 if (s->ops && s->ops->ioctl) 504 return s->ops->ioctl(dev, data, &bi, cmd); 505 return -ENOIOCTLCMD; 506 507 case HDLCDRVCTL_GETCHANNELPAR: 508 bi.data.cp.tx_delay = s->ch_params.tx_delay; 509 bi.data.cp.tx_tail = s->ch_params.tx_tail; 510 bi.data.cp.slottime = s->ch_params.slottime; 511 bi.data.cp.ppersist = s->ch_params.ppersist; 512 bi.data.cp.fulldup = s->ch_params.fulldup; 513 break; 514 515 case HDLCDRVCTL_SETCHANNELPAR: 516 if (!capable(CAP_NET_ADMIN)) 517 return -EACCES; 518 s->ch_params.tx_delay = bi.data.cp.tx_delay; 519 s->ch_params.tx_tail = bi.data.cp.tx_tail; 520 s->ch_params.slottime = bi.data.cp.slottime; 521 s->ch_params.ppersist = bi.data.cp.ppersist; 522 s->ch_params.fulldup = bi.data.cp.fulldup; 523 s->hdlctx.slotcnt = 1; 524 return 0; 525 526 case HDLCDRVCTL_GETMODEMPAR: 527 bi.data.mp.iobase = dev->base_addr; 528 bi.data.mp.irq = dev->irq; 529 bi.data.mp.dma = dev->dma; 530 bi.data.mp.dma2 = s->ptt_out.dma2; 531 bi.data.mp.seriobase = s->ptt_out.seriobase; 532 bi.data.mp.pariobase = s->ptt_out.pariobase; 533 bi.data.mp.midiiobase = s->ptt_out.midiiobase; 534 break; 535 536 case HDLCDRVCTL_SETMODEMPAR: 537 if ((!capable(CAP_SYS_RAWIO)) || netif_running(dev)) 538 return -EACCES; 539 dev->base_addr = bi.data.mp.iobase; 540 dev->irq = bi.data.mp.irq; 541 dev->dma = bi.data.mp.dma; 542 s->ptt_out.dma2 = bi.data.mp.dma2; 543 s->ptt_out.seriobase = bi.data.mp.seriobase; 544 s->ptt_out.pariobase = bi.data.mp.pariobase; 545 s->ptt_out.midiiobase = bi.data.mp.midiiobase; 546 return 0; 547 548 case HDLCDRVCTL_GETSTAT: 549 bi.data.cs.ptt = hdlcdrv_ptt(s); 550 bi.data.cs.dcd = s->hdlcrx.dcd; 551 bi.data.cs.ptt_keyed = s->ptt_keyed; 552 bi.data.cs.tx_packets = dev->stats.tx_packets; 553 bi.data.cs.tx_errors = dev->stats.tx_errors; 554 bi.data.cs.rx_packets = dev->stats.rx_packets; 555 bi.data.cs.rx_errors = dev->stats.rx_errors; 556 break; 557 558 case HDLCDRVCTL_OLDGETSTAT: 559 bi.data.ocs.ptt = hdlcdrv_ptt(s); 560 bi.data.ocs.dcd = s->hdlcrx.dcd; 561 bi.data.ocs.ptt_keyed = s->ptt_keyed; 562 break; 563 564 case HDLCDRVCTL_CALIBRATE: 565 if(!capable(CAP_SYS_RAWIO)) 566 return -EPERM; 567 if (s->par.bitrate <= 0) 568 return -EINVAL; 569 if (bi.data.calibrate > INT_MAX / s->par.bitrate) 570 return -EINVAL; 571 s->hdlctx.calibrate = bi.data.calibrate * s->par.bitrate / 16; 572 return 0; 573 574 case HDLCDRVCTL_GETSAMPLES: 575 #ifndef HDLCDRV_DEBUG 576 return -EPERM; 577 #else /* HDLCDRV_DEBUG */ 578 if (s->bitbuf_channel.rd == s->bitbuf_channel.wr) 579 return -EAGAIN; 580 bi.data.bits = 581 s->bitbuf_channel.buffer[s->bitbuf_channel.rd]; 582 s->bitbuf_channel.rd = (s->bitbuf_channel.rd+1) % 583 sizeof(s->bitbuf_channel.buffer); 584 break; 585 #endif /* HDLCDRV_DEBUG */ 586 587 case HDLCDRVCTL_GETBITS: 588 #ifndef HDLCDRV_DEBUG 589 return -EPERM; 590 #else /* HDLCDRV_DEBUG */ 591 if (s->bitbuf_hdlc.rd == s->bitbuf_hdlc.wr) 592 return -EAGAIN; 593 bi.data.bits = 594 s->bitbuf_hdlc.buffer[s->bitbuf_hdlc.rd]; 595 s->bitbuf_hdlc.rd = (s->bitbuf_hdlc.rd+1) % 596 sizeof(s->bitbuf_hdlc.buffer); 597 break; 598 #endif /* HDLCDRV_DEBUG */ 599 600 case HDLCDRVCTL_DRIVERNAME: 601 if (s->ops && s->ops->drvname) { 602 strlcpy(bi.data.drivername, s->ops->drvname, 603 sizeof(bi.data.drivername)); 604 break; 605 } 606 bi.data.drivername[0] = '\0'; 607 break; 608 609 } 610 if (copy_to_user(data, &bi, sizeof(bi))) 611 return -EFAULT; 612 return 0; 613 614 } 615 616 /* --------------------------------------------------------------------- */ 617 618 static const struct net_device_ops hdlcdrv_netdev = { 619 .ndo_open = hdlcdrv_open, 620 .ndo_stop = hdlcdrv_close, 621 .ndo_start_xmit = hdlcdrv_send_packet, 622 .ndo_siocdevprivate = hdlcdrv_siocdevprivate, 623 .ndo_set_mac_address = hdlcdrv_set_mac_address, 624 }; 625 626 /* 627 * Initialize fields in hdlcdrv 628 */ 629 static void hdlcdrv_setup(struct net_device *dev) 630 { 631 static const struct hdlcdrv_channel_params dflt_ch_params = { 632 20, 2, 10, 40, 0 633 }; 634 struct hdlcdrv_state *s = netdev_priv(dev); 635 636 /* 637 * initialize the hdlcdrv_state struct 638 */ 639 s->ch_params = dflt_ch_params; 640 s->ptt_keyed = 0; 641 642 spin_lock_init(&s->hdlcrx.hbuf.lock); 643 s->hdlcrx.hbuf.rd = s->hdlcrx.hbuf.wr = 0; 644 s->hdlcrx.in_hdlc_rx = 0; 645 s->hdlcrx.rx_state = 0; 646 647 spin_lock_init(&s->hdlctx.hbuf.lock); 648 s->hdlctx.hbuf.rd = s->hdlctx.hbuf.wr = 0; 649 s->hdlctx.in_hdlc_tx = 0; 650 s->hdlctx.tx_state = 1; 651 s->hdlctx.numflags = 0; 652 s->hdlctx.bitstream = s->hdlctx.bitbuf = s->hdlctx.numbits = 0; 653 s->hdlctx.ptt = 0; 654 s->hdlctx.slotcnt = s->ch_params.slottime; 655 s->hdlctx.calibrate = 0; 656 657 #ifdef HDLCDRV_DEBUG 658 s->bitbuf_channel.rd = s->bitbuf_channel.wr = 0; 659 s->bitbuf_channel.shreg = 0x80; 660 661 s->bitbuf_hdlc.rd = s->bitbuf_hdlc.wr = 0; 662 s->bitbuf_hdlc.shreg = 0x80; 663 #endif /* HDLCDRV_DEBUG */ 664 665 666 /* Fill in the fields of the device structure */ 667 668 s->skb = NULL; 669 670 dev->netdev_ops = &hdlcdrv_netdev; 671 dev->header_ops = &ax25_header_ops; 672 673 dev->type = ARPHRD_AX25; /* AF_AX25 device */ 674 dev->hard_header_len = AX25_MAX_HEADER_LEN + AX25_BPQ_HEADER_LEN; 675 dev->mtu = AX25_DEF_PACLEN; /* eth_mtu is the default */ 676 dev->addr_len = AX25_ADDR_LEN; /* sizeof an ax.25 address */ 677 memcpy(dev->broadcast, &ax25_bcast, AX25_ADDR_LEN); 678 dev_addr_set(dev, (u8 *)&ax25_defaddr); 679 dev->tx_queue_len = 16; 680 } 681 682 /* --------------------------------------------------------------------- */ 683 struct net_device *hdlcdrv_register(const struct hdlcdrv_ops *ops, 684 unsigned int privsize, const char *ifname, 685 unsigned int baseaddr, unsigned int irq, 686 unsigned int dma) 687 { 688 struct net_device *dev; 689 struct hdlcdrv_state *s; 690 int err; 691 692 if (privsize < sizeof(struct hdlcdrv_state)) 693 privsize = sizeof(struct hdlcdrv_state); 694 695 dev = alloc_netdev(privsize, ifname, NET_NAME_UNKNOWN, hdlcdrv_setup); 696 if (!dev) 697 return ERR_PTR(-ENOMEM); 698 699 /* 700 * initialize part of the hdlcdrv_state struct 701 */ 702 s = netdev_priv(dev); 703 s->magic = HDLCDRV_MAGIC; 704 s->ops = ops; 705 dev->base_addr = baseaddr; 706 dev->irq = irq; 707 dev->dma = dma; 708 709 err = register_netdev(dev); 710 if (err < 0) { 711 printk(KERN_WARNING "hdlcdrv: cannot register net " 712 "device %s\n", dev->name); 713 free_netdev(dev); 714 dev = ERR_PTR(err); 715 } 716 return dev; 717 } 718 719 /* --------------------------------------------------------------------- */ 720 721 void hdlcdrv_unregister(struct net_device *dev) 722 { 723 struct hdlcdrv_state *s = netdev_priv(dev); 724 725 BUG_ON(s->magic != HDLCDRV_MAGIC); 726 727 if (s->opened && s->ops->close) 728 s->ops->close(dev); 729 unregister_netdev(dev); 730 731 free_netdev(dev); 732 } 733 734 /* --------------------------------------------------------------------- */ 735 736 EXPORT_SYMBOL(hdlcdrv_receiver); 737 EXPORT_SYMBOL(hdlcdrv_transmitter); 738 EXPORT_SYMBOL(hdlcdrv_arbitrate); 739 EXPORT_SYMBOL(hdlcdrv_register); 740 EXPORT_SYMBOL(hdlcdrv_unregister); 741 742 /* --------------------------------------------------------------------- */ 743 744 static int __init hdlcdrv_init_driver(void) 745 { 746 printk(KERN_INFO "hdlcdrv: (C) 1996-2000 Thomas Sailer HB9JNX/AE4WA\n"); 747 printk(KERN_INFO "hdlcdrv: version 0.8\n"); 748 return 0; 749 } 750 751 /* --------------------------------------------------------------------- */ 752 753 static void __exit hdlcdrv_cleanup_driver(void) 754 { 755 printk(KERN_INFO "hdlcdrv: cleanup\n"); 756 } 757 758 /* --------------------------------------------------------------------- */ 759 760 MODULE_AUTHOR("Thomas M. Sailer, sailer@ife.ee.ethz.ch, hb9jnx@hb9w.che.eu"); 761 MODULE_DESCRIPTION("Packet Radio network interface HDLC encoder/decoder"); 762 MODULE_LICENSE("GPL"); 763 module_init(hdlcdrv_init_driver); 764 module_exit(hdlcdrv_cleanup_driver); 765 766 /* --------------------------------------------------------------------- */ 767