rose_dev.c 3.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168
  1. /*
  2. * This program is free software; you can redistribute it and/or modify
  3. * it under the terms of the GNU General Public License as published by
  4. * the Free Software Foundation; either version 2 of the License, or
  5. * (at your option) any later version.
  6. *
  7. * Copyright (C) Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
  8. */
  9. #include <linux/module.h>
  10. #include <linux/proc_fs.h>
  11. #include <linux/kernel.h>
  12. #include <linux/interrupt.h>
  13. #include <linux/fs.h>
  14. #include <linux/types.h>
  15. #include <linux/sysctl.h>
  16. #include <linux/string.h>
  17. #include <linux/socket.h>
  18. #include <linux/errno.h>
  19. #include <linux/fcntl.h>
  20. #include <linux/in.h>
  21. #include <linux/if_ether.h>
  22. #include <asm/system.h>
  23. #include <asm/io.h>
  24. #include <linux/inet.h>
  25. #include <linux/netdevice.h>
  26. #include <linux/etherdevice.h>
  27. #include <linux/if_arp.h>
  28. #include <linux/skbuff.h>
  29. #include <net/ip.h>
  30. #include <net/arp.h>
  31. #include <net/ax25.h>
  32. #include <net/rose.h>
  33. static int rose_header(struct sk_buff *skb, struct net_device *dev, unsigned short type,
  34. void *daddr, void *saddr, unsigned len)
  35. {
  36. unsigned char *buff = skb_push(skb, ROSE_MIN_LEN + 2);
  37. *buff++ = ROSE_GFI | ROSE_Q_BIT;
  38. *buff++ = 0x00;
  39. *buff++ = ROSE_DATA;
  40. *buff++ = 0x7F;
  41. *buff++ = AX25_P_IP;
  42. if (daddr != NULL)
  43. return 37;
  44. return -37;
  45. }
  46. static int rose_rebuild_header(struct sk_buff *skb)
  47. {
  48. struct net_device *dev = skb->dev;
  49. struct net_device_stats *stats = netdev_priv(dev);
  50. unsigned char *bp = (unsigned char *)skb->data;
  51. struct sk_buff *skbn;
  52. unsigned int len;
  53. #ifdef CONFIG_INET
  54. if (arp_find(bp + 7, skb)) {
  55. return 1;
  56. }
  57. if ((skbn = skb_clone(skb, GFP_ATOMIC)) == NULL) {
  58. kfree_skb(skb);
  59. return 1;
  60. }
  61. if (skb->sk != NULL)
  62. skb_set_owner_w(skbn, skb->sk);
  63. kfree_skb(skb);
  64. len = skbn->len;
  65. if (!rose_route_frame(skbn, NULL)) {
  66. kfree_skb(skbn);
  67. stats->tx_errors++;
  68. return 1;
  69. }
  70. stats->tx_packets++;
  71. stats->tx_bytes += len;
  72. #endif
  73. return 1;
  74. }
  75. static int rose_set_mac_address(struct net_device *dev, void *addr)
  76. {
  77. struct sockaddr *sa = addr;
  78. int err;
  79. if (!memcpy(dev->dev_addr, sa->sa_data, dev->addr_len))
  80. return 0;
  81. if (dev->flags & IFF_UP) {
  82. err = rose_add_loopback_node((rose_address *)dev->dev_addr);
  83. if (err)
  84. return err;
  85. rose_del_loopback_node((rose_address *)dev->dev_addr);
  86. }
  87. memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
  88. return 0;
  89. }
  90. static int rose_open(struct net_device *dev)
  91. {
  92. int err;
  93. err = rose_add_loopback_node((rose_address *)dev->dev_addr);
  94. if (err)
  95. return err;
  96. netif_start_queue(dev);
  97. return 0;
  98. }
  99. static int rose_close(struct net_device *dev)
  100. {
  101. netif_stop_queue(dev);
  102. rose_del_loopback_node((rose_address *)dev->dev_addr);
  103. return 0;
  104. }
  105. static int rose_xmit(struct sk_buff *skb, struct net_device *dev)
  106. {
  107. struct net_device_stats *stats = netdev_priv(dev);
  108. if (!netif_running(dev)) {
  109. printk(KERN_ERR "ROSE: rose_xmit - called when iface is down\n");
  110. return 1;
  111. }
  112. dev_kfree_skb(skb);
  113. stats->tx_errors++;
  114. return 0;
  115. }
  116. static struct net_device_stats *rose_get_stats(struct net_device *dev)
  117. {
  118. return netdev_priv(dev);
  119. }
  120. void rose_setup(struct net_device *dev)
  121. {
  122. dev->mtu = ROSE_MAX_PACKET_SIZE - 2;
  123. dev->hard_start_xmit = rose_xmit;
  124. dev->open = rose_open;
  125. dev->stop = rose_close;
  126. dev->hard_header = rose_header;
  127. dev->hard_header_len = AX25_BPQ_HEADER_LEN + AX25_MAX_HEADER_LEN + ROSE_MIN_LEN;
  128. dev->addr_len = ROSE_ADDR_LEN;
  129. dev->type = ARPHRD_ROSE;
  130. dev->rebuild_header = rose_rebuild_header;
  131. dev->set_mac_address = rose_set_mac_address;
  132. /* New-style flags. */
  133. dev->flags = IFF_NOARP;
  134. dev->get_stats = rose_get_stats;
  135. }