rose_dev.c 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. *
  4. * Copyright (C) Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
  5. */
  6. #include <linux/module.h>
  7. #include <linux/proc_fs.h>
  8. #include <linux/kernel.h>
  9. #include <linux/interrupt.h>
  10. #include <linux/fs.h>
  11. #include <linux/types.h>
  12. #include <linux/sysctl.h>
  13. #include <linux/string.h>
  14. #include <linux/socket.h>
  15. #include <linux/errno.h>
  16. #include <linux/fcntl.h>
  17. #include <linux/in.h>
  18. #include <linux/if_ether.h>
  19. #include <linux/slab.h>
  20. #include <asm/io.h>
  21. #include <linux/inet.h>
  22. #include <linux/netdevice.h>
  23. #include <linux/etherdevice.h>
  24. #include <linux/if_arp.h>
  25. #include <linux/skbuff.h>
  26. #include <net/ip.h>
  27. #include <net/arp.h>
  28. #include <net/ax25.h>
  29. #include <net/rose.h>
  30. static int rose_header(struct sk_buff *skb, struct net_device *dev,
  31. unsigned short type,
  32. const void *daddr, const void *saddr, unsigned int len)
  33. {
  34. unsigned char *buff = skb_push(skb, ROSE_MIN_LEN + 2);
  35. if (daddr)
  36. memcpy(buff + 7, daddr, dev->addr_len);
  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_set_mac_address(struct net_device *dev, void *addr)
  47. {
  48. struct sockaddr *sa = addr;
  49. int err;
  50. if (!memcmp(dev->dev_addr, sa->sa_data, dev->addr_len))
  51. return 0;
  52. if (dev->flags & IFF_UP) {
  53. err = rose_add_loopback_node((rose_address *)sa->sa_data);
  54. if (err)
  55. return err;
  56. rose_del_loopback_node((rose_address *)dev->dev_addr);
  57. }
  58. memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
  59. return 0;
  60. }
  61. static int rose_open(struct net_device *dev)
  62. {
  63. int err;
  64. err = rose_add_loopback_node((rose_address *)dev->dev_addr);
  65. if (err)
  66. return err;
  67. netif_start_queue(dev);
  68. return 0;
  69. }
  70. static int rose_close(struct net_device *dev)
  71. {
  72. netif_stop_queue(dev);
  73. rose_del_loopback_node((rose_address *)dev->dev_addr);
  74. return 0;
  75. }
  76. static netdev_tx_t rose_xmit(struct sk_buff *skb, struct net_device *dev)
  77. {
  78. struct net_device_stats *stats = &dev->stats;
  79. unsigned int len = skb->len;
  80. if (!netif_running(dev)) {
  81. printk(KERN_ERR "ROSE: rose_xmit - called when iface is down\n");
  82. return NETDEV_TX_BUSY;
  83. }
  84. if (!rose_route_frame(skb, NULL)) {
  85. dev_kfree_skb(skb);
  86. stats->tx_errors++;
  87. return NETDEV_TX_OK;
  88. }
  89. stats->tx_packets++;
  90. stats->tx_bytes += len;
  91. return NETDEV_TX_OK;
  92. }
  93. static const struct header_ops rose_header_ops = {
  94. .create = rose_header,
  95. };
  96. static const struct net_device_ops rose_netdev_ops = {
  97. .ndo_open = rose_open,
  98. .ndo_stop = rose_close,
  99. .ndo_start_xmit = rose_xmit,
  100. .ndo_set_mac_address = rose_set_mac_address,
  101. };
  102. void rose_setup(struct net_device *dev)
  103. {
  104. dev->mtu = ROSE_MAX_PACKET_SIZE - 2;
  105. dev->netdev_ops = &rose_netdev_ops;
  106. dev->header_ops = &rose_header_ops;
  107. dev->hard_header_len = AX25_BPQ_HEADER_LEN + AX25_MAX_HEADER_LEN + ROSE_MIN_LEN;
  108. dev->addr_len = ROSE_ADDR_LEN;
  109. dev->type = ARPHRD_ROSE;
  110. /* New-style flags. */
  111. dev->flags = IFF_NOARP;
  112. }