rose_in.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:8k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * ROSE release 003
  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.  * ROSE 001 Jonathan(G4KLX) Cloned from nr_in.c
  20.  * ROSE 002 Jonathan(G4KLX) Return cause and diagnostic codes from Clear Requests.
  21.  * ROSE 003 Jonathan(G4KLX) New timer architecture.
  22.  * Removed M bit processing.
  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 <net/ip.h> /* For ip_rcv */
  40. #include <asm/segment.h>
  41. #include <asm/system.h>
  42. #include <linux/fcntl.h>
  43. #include <linux/mm.h>
  44. #include <linux/interrupt.h>
  45. #include <net/rose.h>
  46. /*
  47.  * State machine for state 1, Awaiting Call Accepted State.
  48.  * The handling of the timer(s) is in file rose_timer.c.
  49.  * Handling of state 0 and connection release is in af_rose.c.
  50.  */
  51. static int rose_state1_machine(struct sock *sk, struct sk_buff *skb, int frametype)
  52. {
  53. switch (frametype) {
  54. case ROSE_CALL_ACCEPTED:
  55. rose_stop_timer(sk);
  56. rose_start_idletimer(sk);
  57. sk->protinfo.rose->condition = 0x00;
  58. sk->protinfo.rose->vs        = 0;
  59. sk->protinfo.rose->va        = 0;
  60. sk->protinfo.rose->vr        = 0;
  61. sk->protinfo.rose->vl        = 0;
  62. sk->protinfo.rose->state     = ROSE_STATE_3;
  63. sk->state                    = TCP_ESTABLISHED;
  64. if (!sk->dead)
  65. sk->state_change(sk);
  66. break;
  67. case ROSE_CLEAR_REQUEST:
  68. rose_write_internal(sk, ROSE_CLEAR_CONFIRMATION);
  69. rose_disconnect(sk, ECONNREFUSED, skb->data[3], skb->data[4]);
  70. sk->protinfo.rose->neighbour->use--;
  71. break;
  72. default:
  73. break;
  74. }
  75. return 0;
  76. }
  77. /*
  78.  * State machine for state 2, Awaiting Clear Confirmation State.
  79.  * The handling of the timer(s) is in file rose_timer.c
  80.  * Handling of state 0 and connection release is in af_rose.c.
  81.  */
  82. static int rose_state2_machine(struct sock *sk, struct sk_buff *skb, int frametype)
  83. {
  84. switch (frametype) {
  85. case ROSE_CLEAR_REQUEST:
  86. rose_write_internal(sk, ROSE_CLEAR_CONFIRMATION);
  87. rose_disconnect(sk, 0, skb->data[3], skb->data[4]);
  88. sk->protinfo.rose->neighbour->use--;
  89. break;
  90. case ROSE_CLEAR_CONFIRMATION:
  91. rose_disconnect(sk, 0, -1, -1);
  92. sk->protinfo.rose->neighbour->use--;
  93. break;
  94. default:
  95. break;
  96. }
  97. return 0;
  98. }
  99. /*
  100.  * State machine for state 3, Connected State.
  101.  * The handling of the timer(s) is in file rose_timer.c
  102.  * Handling of state 0 and connection release is in af_rose.c.
  103.  */
  104. static int rose_state3_machine(struct sock *sk, struct sk_buff *skb, int frametype, int ns, int nr, int q, int d, int m)
  105. {
  106. int queued = 0;
  107. switch (frametype) {
  108. case ROSE_RESET_REQUEST:
  109. rose_stop_timer(sk);
  110. rose_start_idletimer(sk);
  111. rose_write_internal(sk, ROSE_RESET_CONFIRMATION);
  112. sk->protinfo.rose->condition = 0x00;
  113. sk->protinfo.rose->vs        = 0;
  114. sk->protinfo.rose->vr        = 0;
  115. sk->protinfo.rose->va        = 0;
  116. sk->protinfo.rose->vl        = 0;
  117. rose_requeue_frames(sk);
  118. break;
  119. case ROSE_CLEAR_REQUEST:
  120. rose_write_internal(sk, ROSE_CLEAR_CONFIRMATION);
  121. rose_disconnect(sk, 0, skb->data[3], skb->data[4]);
  122. sk->protinfo.rose->neighbour->use--;
  123. break;
  124. case ROSE_RR:
  125. case ROSE_RNR:
  126. if (!rose_validate_nr(sk, nr)) {
  127. rose_write_internal(sk, ROSE_RESET_REQUEST);
  128. sk->protinfo.rose->condition = 0x00;
  129. sk->protinfo.rose->vs        = 0;
  130. sk->protinfo.rose->vr        = 0;
  131. sk->protinfo.rose->va        = 0;
  132. sk->protinfo.rose->vl        = 0;
  133. sk->protinfo.rose->state     = ROSE_STATE_4;
  134. rose_start_t2timer(sk);
  135. rose_stop_idletimer(sk);
  136. } else {
  137. rose_frames_acked(sk, nr);
  138. if (frametype == ROSE_RNR) {
  139. sk->protinfo.rose->condition |= ROSE_COND_PEER_RX_BUSY;
  140. } else {
  141. sk->protinfo.rose->condition &= ~ROSE_COND_PEER_RX_BUSY;
  142. }
  143. }
  144. break;
  145. case ROSE_DATA: /* XXX */
  146. sk->protinfo.rose->condition &= ~ROSE_COND_PEER_RX_BUSY;
  147. if (!rose_validate_nr(sk, nr)) {
  148. rose_write_internal(sk, ROSE_RESET_REQUEST);
  149. sk->protinfo.rose->condition = 0x00;
  150. sk->protinfo.rose->vs        = 0;
  151. sk->protinfo.rose->vr        = 0;
  152. sk->protinfo.rose->va        = 0;
  153. sk->protinfo.rose->vl        = 0;
  154. sk->protinfo.rose->state     = ROSE_STATE_4;
  155. rose_start_t2timer(sk);
  156. rose_stop_idletimer(sk);
  157. break;
  158. }
  159. rose_frames_acked(sk, nr);
  160. if (ns == sk->protinfo.rose->vr) {
  161. rose_start_idletimer(sk);
  162. if (sock_queue_rcv_skb(sk, skb) == 0) {
  163. sk->protinfo.rose->vr = (sk->protinfo.rose->vr + 1) % ROSE_MODULUS;
  164. queued = 1;
  165. } else {
  166. /* Should never happen ! */
  167. rose_write_internal(sk, ROSE_RESET_REQUEST);
  168. sk->protinfo.rose->condition = 0x00;
  169. sk->protinfo.rose->vs        = 0;
  170. sk->protinfo.rose->vr        = 0;
  171. sk->protinfo.rose->va        = 0;
  172. sk->protinfo.rose->vl        = 0;
  173. sk->protinfo.rose->state     = ROSE_STATE_4;
  174. rose_start_t2timer(sk);
  175. rose_stop_idletimer(sk);
  176. break;
  177. }
  178. if (atomic_read(&sk->rmem_alloc) > (sk->rcvbuf / 2))
  179. sk->protinfo.rose->condition |= ROSE_COND_OWN_RX_BUSY;
  180. }
  181. /*
  182.  * If the window is full, ack the frame, else start the
  183.  * acknowledge hold back timer.
  184.  */
  185. if (((sk->protinfo.rose->vl + sysctl_rose_window_size) % ROSE_MODULUS) == sk->protinfo.rose->vr) {
  186. sk->protinfo.rose->condition &= ~ROSE_COND_ACK_PENDING;
  187. rose_stop_timer(sk);
  188. rose_enquiry_response(sk);
  189. } else {
  190. sk->protinfo.rose->condition |= ROSE_COND_ACK_PENDING;
  191. rose_start_hbtimer(sk);
  192. }
  193. break;
  194. default:
  195. printk(KERN_WARNING "ROSE: unknown %02X in state 3n", frametype);
  196. break;
  197. }
  198. return queued;
  199. }
  200. /*
  201.  * State machine for state 4, Awaiting Reset Confirmation State.
  202.  * The handling of the timer(s) is in file rose_timer.c
  203.  * Handling of state 0 and connection release is in af_rose.c.
  204.  */
  205. static int rose_state4_machine(struct sock *sk, struct sk_buff *skb, int frametype)
  206. {
  207. switch (frametype) {
  208. case ROSE_RESET_REQUEST:
  209. rose_write_internal(sk, ROSE_RESET_CONFIRMATION);
  210. case ROSE_RESET_CONFIRMATION:
  211. rose_stop_timer(sk);
  212. rose_start_idletimer(sk);
  213. sk->protinfo.rose->condition = 0x00;
  214. sk->protinfo.rose->va        = 0;
  215. sk->protinfo.rose->vr        = 0;
  216. sk->protinfo.rose->vs        = 0;
  217. sk->protinfo.rose->vl        = 0;
  218. sk->protinfo.rose->state     = ROSE_STATE_3;
  219. rose_requeue_frames(sk);
  220. break;
  221. case ROSE_CLEAR_REQUEST:
  222. rose_write_internal(sk, ROSE_CLEAR_CONFIRMATION);
  223. rose_disconnect(sk, 0, skb->data[3], skb->data[4]);
  224. sk->protinfo.rose->neighbour->use--;
  225. break;
  226. default:
  227. break;
  228. }
  229. return 0;
  230. }
  231. /*
  232.  * State machine for state 5, Awaiting Call Acceptance State.
  233.  * The handling of the timer(s) is in file rose_timer.c
  234.  * Handling of state 0 and connection release is in af_rose.c.
  235.  */
  236. static int rose_state5_machine(struct sock *sk, struct sk_buff *skb, int frametype)
  237. {
  238. if (frametype == ROSE_CLEAR_REQUEST) {
  239. rose_write_internal(sk, ROSE_CLEAR_CONFIRMATION);
  240. rose_disconnect(sk, 0, skb->data[3], skb->data[4]);
  241. sk->protinfo.rose->neighbour->use--;
  242. }
  243. return 0;
  244. }
  245. /* Higher level upcall for a LAPB frame */
  246. int rose_process_rx_frame(struct sock *sk, struct sk_buff *skb)
  247. {
  248. int queued = 0, frametype, ns, nr, q, d, m;
  249. if (sk->protinfo.rose->state == ROSE_STATE_0)
  250. return 0;
  251. frametype = rose_decode(skb, &ns, &nr, &q, &d, &m);
  252. switch (sk->protinfo.rose->state) {
  253. case ROSE_STATE_1:
  254. queued = rose_state1_machine(sk, skb, frametype);
  255. break;
  256. case ROSE_STATE_2:
  257. queued = rose_state2_machine(sk, skb, frametype);
  258. break;
  259. case ROSE_STATE_3:
  260. queued = rose_state3_machine(sk, skb, frametype, ns, nr, q, d, m);
  261. break;
  262. case ROSE_STATE_4:
  263. queued = rose_state4_machine(sk, skb, frametype);
  264. break;
  265. case ROSE_STATE_5:
  266. queued = rose_state5_machine(sk, skb, frametype);
  267. break;
  268. }
  269. rose_kick(sk);
  270. return queued;
  271. }