ax25_dev.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204
  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/errno.h>
  10. #include <linux/types.h>
  11. #include <linux/socket.h>
  12. #include <linux/in.h>
  13. #include <linux/kernel.h>
  14. #include <linux/timer.h>
  15. #include <linux/string.h>
  16. #include <linux/sockios.h>
  17. #include <linux/net.h>
  18. #include <linux/spinlock.h>
  19. #include <net/ax25.h>
  20. #include <linux/inet.h>
  21. #include <linux/netdevice.h>
  22. #include <linux/if_arp.h>
  23. #include <linux/skbuff.h>
  24. #include <net/sock.h>
  25. #include <asm/uaccess.h>
  26. #include <asm/system.h>
  27. #include <linux/fcntl.h>
  28. #include <linux/mm.h>
  29. #include <linux/interrupt.h>
  30. #include <linux/init.h>
  31. ax25_dev *ax25_dev_list;
  32. DEFINE_SPINLOCK(ax25_dev_lock);
  33. ax25_dev *ax25_addr_ax25dev(ax25_address *addr)
  34. {
  35. ax25_dev *ax25_dev, *res = NULL;
  36. spin_lock_bh(&ax25_dev_lock);
  37. for (ax25_dev = ax25_dev_list; ax25_dev != NULL; ax25_dev = ax25_dev->next)
  38. if (ax25cmp(addr, (ax25_address *)ax25_dev->dev->dev_addr) == 0) {
  39. res = ax25_dev;
  40. }
  41. spin_unlock_bh(&ax25_dev_lock);
  42. return res;
  43. }
  44. /*
  45. * This is called when an interface is brought up. These are
  46. * reasonable defaults.
  47. */
  48. void ax25_dev_device_up(struct net_device *dev)
  49. {
  50. ax25_dev *ax25_dev;
  51. if ((ax25_dev = kzalloc(sizeof(*ax25_dev), GFP_ATOMIC)) == NULL) {
  52. printk(KERN_ERR "AX.25: ax25_dev_device_up - out of memory\n");
  53. return;
  54. }
  55. ax25_unregister_sysctl();
  56. dev->ax25_ptr = ax25_dev;
  57. ax25_dev->dev = dev;
  58. dev_hold(dev);
  59. ax25_dev->forward = NULL;
  60. ax25_dev->values[AX25_VALUES_IPDEFMODE] = AX25_DEF_IPDEFMODE;
  61. ax25_dev->values[AX25_VALUES_AXDEFMODE] = AX25_DEF_AXDEFMODE;
  62. ax25_dev->values[AX25_VALUES_BACKOFF] = AX25_DEF_BACKOFF;
  63. ax25_dev->values[AX25_VALUES_CONMODE] = AX25_DEF_CONMODE;
  64. ax25_dev->values[AX25_VALUES_WINDOW] = AX25_DEF_WINDOW;
  65. ax25_dev->values[AX25_VALUES_EWINDOW] = AX25_DEF_EWINDOW;
  66. ax25_dev->values[AX25_VALUES_T1] = AX25_DEF_T1;
  67. ax25_dev->values[AX25_VALUES_T2] = AX25_DEF_T2;
  68. ax25_dev->values[AX25_VALUES_T3] = AX25_DEF_T3;
  69. ax25_dev->values[AX25_VALUES_IDLE] = AX25_DEF_IDLE;
  70. ax25_dev->values[AX25_VALUES_N2] = AX25_DEF_N2;
  71. ax25_dev->values[AX25_VALUES_PACLEN] = AX25_DEF_PACLEN;
  72. ax25_dev->values[AX25_VALUES_PROTOCOL] = AX25_DEF_PROTOCOL;
  73. ax25_dev->values[AX25_VALUES_DS_TIMEOUT]= AX25_DEF_DS_TIMEOUT;
  74. #if defined(CONFIG_AX25_DAMA_SLAVE) || defined(CONFIG_AX25_DAMA_MASTER)
  75. init_timer(&ax25_dev->dama.slave_timer);
  76. #endif
  77. spin_lock_bh(&ax25_dev_lock);
  78. ax25_dev->next = ax25_dev_list;
  79. ax25_dev_list = ax25_dev;
  80. spin_unlock_bh(&ax25_dev_lock);
  81. ax25_register_sysctl();
  82. }
  83. void ax25_dev_device_down(struct net_device *dev)
  84. {
  85. ax25_dev *s, *ax25_dev;
  86. if ((ax25_dev = ax25_dev_ax25dev(dev)) == NULL)
  87. return;
  88. ax25_unregister_sysctl();
  89. spin_lock_bh(&ax25_dev_lock);
  90. #ifdef CONFIG_AX25_DAMA_SLAVE
  91. ax25_ds_del_timer(ax25_dev);
  92. #endif
  93. /*
  94. * Remove any packet forwarding that points to this device.
  95. */
  96. for (s = ax25_dev_list; s != NULL; s = s->next)
  97. if (s->forward == dev)
  98. s->forward = NULL;
  99. if ((s = ax25_dev_list) == ax25_dev) {
  100. ax25_dev_list = s->next;
  101. spin_unlock_bh(&ax25_dev_lock);
  102. dev_put(dev);
  103. kfree(ax25_dev);
  104. ax25_register_sysctl();
  105. return;
  106. }
  107. while (s != NULL && s->next != NULL) {
  108. if (s->next == ax25_dev) {
  109. s->next = ax25_dev->next;
  110. spin_unlock_bh(&ax25_dev_lock);
  111. dev_put(dev);
  112. kfree(ax25_dev);
  113. ax25_register_sysctl();
  114. return;
  115. }
  116. s = s->next;
  117. }
  118. spin_unlock_bh(&ax25_dev_lock);
  119. dev->ax25_ptr = NULL;
  120. ax25_register_sysctl();
  121. }
  122. int ax25_fwd_ioctl(unsigned int cmd, struct ax25_fwd_struct *fwd)
  123. {
  124. ax25_dev *ax25_dev, *fwd_dev;
  125. if ((ax25_dev = ax25_addr_ax25dev(&fwd->port_from)) == NULL)
  126. return -EINVAL;
  127. switch (cmd) {
  128. case SIOCAX25ADDFWD:
  129. if ((fwd_dev = ax25_addr_ax25dev(&fwd->port_to)) == NULL)
  130. return -EINVAL;
  131. if (ax25_dev->forward != NULL)
  132. return -EINVAL;
  133. ax25_dev->forward = fwd_dev->dev;
  134. break;
  135. case SIOCAX25DELFWD:
  136. if (ax25_dev->forward == NULL)
  137. return -EINVAL;
  138. ax25_dev->forward = NULL;
  139. break;
  140. default:
  141. return -EINVAL;
  142. }
  143. return 0;
  144. }
  145. struct net_device *ax25_fwd_dev(struct net_device *dev)
  146. {
  147. ax25_dev *ax25_dev;
  148. if ((ax25_dev = ax25_dev_ax25dev(dev)) == NULL)
  149. return dev;
  150. if (ax25_dev->forward == NULL)
  151. return dev;
  152. return ax25_dev->forward;
  153. }
  154. /*
  155. * Free all memory associated with device structures.
  156. */
  157. void __exit ax25_dev_free(void)
  158. {
  159. ax25_dev *s, *ax25_dev;
  160. spin_lock_bh(&ax25_dev_lock);
  161. ax25_dev = ax25_dev_list;
  162. while (ax25_dev != NULL) {
  163. s = ax25_dev;
  164. dev_put(ax25_dev->dev);
  165. ax25_dev = ax25_dev->next;
  166. kfree(s);
  167. }
  168. ax25_dev_list = NULL;
  169. spin_unlock_bh(&ax25_dev_lock);
  170. }