ax25_ds_subr.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:5k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * AX.25 release 037
  3.  *
  4.  * This code REQUIRES 2.1.15 or higher/ NET3.038
  5.  *
  6.  * This module:
  7.  * This module is free software; you can redistribute it and/or
  8.  * modify it under the terms of the GNU General Public License
  9.  * as published by the Free Software Foundation; either version
  10.  * 2 of the License, or (at your option) any later version.
  11.  *
  12.  * Most of this code is based on the SDL diagrams published in the 7th
  13.  * ARRL Computer Networking Conference papers. The diagrams have mistakes
  14.  * in them, but are mostly correct. Before you modify the code could you
  15.  * read the SDL diagrams as the code is not obvious and probably very
  16.  * easy to break;
  17.  *
  18.  * History
  19.  * AX.25 036 Jonathan(G4KLX) Cloned from ax25_out.c and ax25_subr.c.
  20.  * Joerg(DL1BKE) Changed ax25_ds_enquiry_response(),
  21.  * fixed ax25_dama_on() and ax25_dama_off().
  22.  * AX.25 037 Jonathan(G4KLX) New timer architecture.
  23.  */
  24. #include <linux/errno.h>
  25. #include <linux/types.h>
  26. #include <linux/socket.h>
  27. #include <linux/in.h>
  28. #include <linux/kernel.h>
  29. #include <linux/sched.h>
  30. #include <linux/timer.h>
  31. #include <linux/string.h>
  32. #include <linux/sockios.h>
  33. #include <linux/net.h>
  34. #include <net/ax25.h>
  35. #include <linux/inet.h>
  36. #include <linux/netdevice.h>
  37. #include <linux/skbuff.h>
  38. #include <net/sock.h>
  39. #include <asm/uaccess.h>
  40. #include <asm/system.h>
  41. #include <linux/fcntl.h>
  42. #include <linux/mm.h>
  43. #include <linux/interrupt.h>
  44. void ax25_ds_nr_error_recovery(ax25_cb *ax25)
  45. {
  46. ax25_ds_establish_data_link(ax25);
  47. }
  48. /*
  49.  * dl1bke 960114: transmit I frames on DAMA poll
  50.  */
  51. void ax25_ds_enquiry_response(ax25_cb *ax25)
  52. {
  53. ax25_cb *ax25o;
  54. /* Please note that neither DK4EG磗 nor DG2FEF磗
  55.  * DAMA spec mention the following behaviour as seen
  56.  * with TheFirmware:
  57.  *
  58.  *  DB0ACH->DL1BKE <RR C P R0> [DAMA]
  59.  * DL1BKE->DB0ACH <I NR=0 NS=0>
  60.  * DL1BKE-7->DB0PRA-6 DB0ACH <I C S3 R5>
  61.  * DL1BKE->DB0ACH <RR R F R0>
  62.  *
  63.  * The Flexnet DAMA Master implementation apparently
  64.  * insists on the "proper" AX.25 behaviour:
  65.  *
  66.  *  DB0ACH->DL1BKE <RR C P R0> [DAMA]
  67.  * DL1BKE->DB0ACH <RR R F R0>
  68.  * DL1BKE->DB0ACH <I NR=0 NS=0>
  69.  * DL1BKE-7->DB0PRA-6 DB0ACH <I C S3 R5>
  70.  *
  71.  * Flexnet refuses to send us *any* I frame if we send
  72.  * a REJ in case AX25_COND_REJECT is set. It is superfluous in 
  73.  * this mode anyway (a RR or RNR invokes the retransmission).
  74.  * Is this a Flexnet bug?
  75.  */
  76. ax25_std_enquiry_response(ax25);
  77. if (!(ax25->condition & AX25_COND_PEER_RX_BUSY)) {
  78. ax25_requeue_frames(ax25);
  79. ax25_kick(ax25);
  80. }
  81. if (ax25->state == AX25_STATE_1 || ax25->state == AX25_STATE_2 || skb_peek(&ax25->ack_queue) != NULL)
  82. ax25_ds_t1_timeout(ax25);
  83. else
  84. ax25->n2count = 0;
  85. ax25_start_t3timer(ax25);
  86. ax25_ds_set_timer(ax25->ax25_dev);
  87. for (ax25o = ax25_list; ax25o != NULL; ax25o = ax25o->next) {
  88. if (ax25o == ax25)
  89. continue;
  90. if (ax25o->ax25_dev != ax25->ax25_dev)
  91. continue;
  92. if (ax25o->state == AX25_STATE_1 || ax25o->state == AX25_STATE_2) {
  93. ax25_ds_t1_timeout(ax25o);
  94. continue;
  95. }
  96. if (!(ax25o->condition & AX25_COND_PEER_RX_BUSY) && ax25o->state == AX25_STATE_3) {
  97. ax25_requeue_frames(ax25o);
  98. ax25_kick(ax25o);
  99. }
  100. if (ax25o->state == AX25_STATE_1 || ax25o->state == AX25_STATE_2 || skb_peek(&ax25o->ack_queue) != NULL)
  101. ax25_ds_t1_timeout(ax25o);
  102. /* do not start T3 for listening sockets (tnx DD8NE) */
  103. if (ax25o->state != AX25_STATE_0)
  104. ax25_start_t3timer(ax25o);
  105. }
  106. }
  107. void ax25_ds_establish_data_link(ax25_cb *ax25)
  108. {
  109. ax25->condition &= AX25_COND_DAMA_MODE;
  110. ax25->n2count    = 0;
  111. ax25_calculate_t1(ax25);
  112. ax25_start_t1timer(ax25);
  113. ax25_stop_t2timer(ax25);
  114. ax25_start_t3timer(ax25);
  115. }
  116. /*
  117.  * :::FIXME:::
  118.  * This is a kludge. Not all drivers recognize kiss commands. 
  119.  * We need a driver level  request to switch duplex mode, that does 
  120.  * either SCC changing, PI config or KISS as required. Currently
  121.  * this request isn't reliable.
  122.  */
  123. static void ax25_kiss_cmd(ax25_dev *ax25_dev, unsigned char cmd, unsigned char param)
  124. {
  125. struct sk_buff *skb;
  126. unsigned char *p;
  127. if (ax25_dev->dev == NULL)
  128. return;
  129. if ((skb = alloc_skb(2, GFP_ATOMIC)) == NULL)
  130. return;
  131. skb->nh.raw = skb->data;
  132. p = skb_put(skb, 2);
  133. *p++ = cmd;
  134. *p++ = param;
  135. skb->dev      = ax25_dev->dev;
  136. skb->protocol = htons(ETH_P_AX25);
  137. dev_queue_xmit(skb);
  138. }
  139. /*
  140.  * A nasty problem arises if we count the number of DAMA connections
  141.  * wrong, especially when connections on the device already existed
  142.  * and our network node (or the sysop) decides to turn on DAMA Master
  143.  * mode. We thus flag the 'real' slave connections with 
  144.  * ax25->dama_slave=1 and look on every disconnect if still slave
  145.  * connections exist.
  146.  */
  147. static int ax25_check_dama_slave(ax25_dev *ax25_dev)
  148. {
  149. ax25_cb *ax25;
  150. for (ax25 = ax25_list; ax25 != NULL ; ax25 = ax25->next)
  151. if (ax25->ax25_dev == ax25_dev && (ax25->condition & AX25_COND_DAMA_MODE) && ax25->state > AX25_STATE_1)
  152. return 1;
  153. return 0;
  154. }
  155. void ax25_dev_dama_on(ax25_dev *ax25_dev)
  156. {
  157. if (ax25_dev == NULL)
  158. return;
  159. if (ax25_dev->dama.slave == 0)
  160. ax25_kiss_cmd(ax25_dev, 5, 1);
  161. ax25_dev->dama.slave = 1;
  162. ax25_ds_set_timer(ax25_dev);
  163. }
  164. void ax25_dev_dama_off(ax25_dev *ax25_dev)
  165. {
  166. if (ax25_dev == NULL)
  167. return;
  168. if (ax25_dev->dama.slave && !ax25_check_dama_slave(ax25_dev)) {
  169. ax25_kiss_cmd(ax25_dev, 5, 0);
  170. ax25_dev->dama.slave = 0;
  171. ax25_ds_del_timer(ax25_dev);
  172. }
  173. }
  174. void ax25_dama_on(ax25_cb *ax25)
  175. {
  176. ax25_dev_dama_on(ax25->ax25_dev);
  177. ax25->condition |= AX25_COND_DAMA_MODE;
  178. }
  179. void ax25_dama_off(ax25_cb *ax25)
  180. {
  181. ax25->condition &= ~AX25_COND_DAMA_MODE;
  182. ax25_dev_dama_off(ax25->ax25_dev);
  183. }