blob: 8169f24ed33e51649c9c8c80f27f3fa9dc88c3a7 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * llc_c_ac.c - actions performed during connection state transition.
3 *
4 * Description:
5 * Functions in this module are implementation of connection component actions
6 * Details of actions can be found in IEEE-802.2 standard document.
7 * All functions have one connection and one event as input argument. All of
8 * them return 0 On success and 1 otherwise.
9 *
10 * Copyright (c) 1997 by Procom Technology, Inc.
11 * 2001-2003 by Arnaldo Carvalho de Melo <acme@conectiva.com.br>
12 *
13 * This program can be redistributed or modified under the terms of the
14 * GNU General Public License as published by the Free Software Foundation.
15 * This program is distributed without any warranty or implied warranty
16 * of merchantability or fitness for a particular purpose.
17 *
18 * See the GNU General Public License for more details.
19 */
20#include <linux/netdevice.h>
21#include <net/llc_conn.h>
22#include <net/llc_sap.h>
23#include <net/sock.h>
24#include <net/llc_c_ev.h>
25#include <net/llc_c_ac.h>
26#include <net/llc_c_st.h>
27#include <net/llc_pdu.h>
28#include <net/llc.h>
29
30#include "llc_output.h"
31
32static int llc_conn_ac_inc_vs_by_1(struct sock *sk, struct sk_buff *skb);
33static void llc_process_tmr_ev(struct sock *sk, struct sk_buff *skb);
34static int llc_conn_ac_data_confirm(struct sock *sk, struct sk_buff *ev);
35
36static int llc_conn_ac_inc_npta_value(struct sock *sk, struct sk_buff *skb);
37
38static int llc_conn_ac_send_rr_rsp_f_set_ackpf(struct sock *sk,
39 struct sk_buff *skb);
40
41static int llc_conn_ac_set_p_flag_1(struct sock *sk, struct sk_buff *skb);
42
43#define INCORRECT 0
44
45int llc_conn_ac_clear_remote_busy(struct sock *sk, struct sk_buff *skb)
46{
47 struct llc_sock *llc = llc_sk(sk);
48
49 if (llc->remote_busy_flag) {
50 u8 nr;
51 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
52
53 llc->remote_busy_flag = 0;
54 del_timer(&llc->busy_state_timer.timer);
55 nr = LLC_I_GET_NR(pdu);
56 llc_conn_resend_i_pdu_as_cmd(sk, nr, 0);
57 }
58 return 0;
59}
60
61int llc_conn_ac_conn_ind(struct sock *sk, struct sk_buff *skb)
62{
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -030063 struct llc_conn_state_ev *ev = llc_conn_ev(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -070064
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -030065 ev->ind_prim = LLC_CONN_PRIM;
66 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070067}
68
69int llc_conn_ac_conn_confirm(struct sock *sk, struct sk_buff *skb)
70{
71 struct llc_conn_state_ev *ev = llc_conn_ev(skb);
72
73 ev->cfm_prim = LLC_CONN_PRIM;
74 return 0;
75}
76
77static int llc_conn_ac_data_confirm(struct sock *sk, struct sk_buff *skb)
78{
79 struct llc_conn_state_ev *ev = llc_conn_ev(skb);
80
81 ev->cfm_prim = LLC_DATA_PRIM;
82 return 0;
83}
84
85int llc_conn_ac_data_ind(struct sock *sk, struct sk_buff *skb)
86{
87 llc_conn_rtn_pdu(sk, skb);
88 return 0;
89}
90
91int llc_conn_ac_disc_ind(struct sock *sk, struct sk_buff *skb)
92{
93 struct llc_conn_state_ev *ev = llc_conn_ev(skb);
94 u8 reason = 0;
95 int rc = 0;
96
97 if (ev->type == LLC_CONN_EV_TYPE_PDU) {
98 struct llc_pdu_un *pdu = llc_pdu_un_hdr(skb);
99
100 if (LLC_PDU_IS_RSP(pdu) &&
101 LLC_PDU_TYPE_IS_U(pdu) &&
102 LLC_U_PDU_RSP(pdu) == LLC_2_PDU_RSP_DM)
103 reason = LLC_DISC_REASON_RX_DM_RSP_PDU;
104 else if (LLC_PDU_IS_CMD(pdu) &&
105 LLC_PDU_TYPE_IS_U(pdu) &&
106 LLC_U_PDU_CMD(pdu) == LLC_2_PDU_CMD_DISC)
107 reason = LLC_DISC_REASON_RX_DISC_CMD_PDU;
108 } else if (ev->type == LLC_CONN_EV_TYPE_ACK_TMR)
109 reason = LLC_DISC_REASON_ACK_TMR_EXP;
Arnaldo Carvalho de Melobdcc66c2005-09-22 03:38:15 -0300110 else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111 rc = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112 if (!rc) {
113 ev->reason = reason;
114 ev->ind_prim = LLC_DISC_PRIM;
115 }
116 return rc;
117}
118
119int llc_conn_ac_disc_confirm(struct sock *sk, struct sk_buff *skb)
120{
121 struct llc_conn_state_ev *ev = llc_conn_ev(skb);
122
123 ev->reason = ev->status;
124 ev->cfm_prim = LLC_DISC_PRIM;
125 return 0;
126}
127
128int llc_conn_ac_rst_ind(struct sock *sk, struct sk_buff *skb)
129{
130 u8 reason = 0;
131 int rc = 1;
132 struct llc_conn_state_ev *ev = llc_conn_ev(skb);
133 struct llc_pdu_un *pdu = llc_pdu_un_hdr(skb);
134 struct llc_sock *llc = llc_sk(sk);
135
136 switch (ev->type) {
137 case LLC_CONN_EV_TYPE_PDU:
138 if (LLC_PDU_IS_RSP(pdu) &&
139 LLC_PDU_TYPE_IS_U(pdu) &&
140 LLC_U_PDU_RSP(pdu) == LLC_2_PDU_RSP_FRMR) {
141 reason = LLC_RESET_REASON_LOCAL;
142 rc = 0;
143 } else if (LLC_PDU_IS_CMD(pdu) &&
144 LLC_PDU_TYPE_IS_U(pdu) &&
145 LLC_U_PDU_CMD(pdu) == LLC_2_PDU_CMD_SABME) {
146 reason = LLC_RESET_REASON_REMOTE;
147 rc = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148 }
149 break;
150 case LLC_CONN_EV_TYPE_ACK_TMR:
151 case LLC_CONN_EV_TYPE_P_TMR:
152 case LLC_CONN_EV_TYPE_REJ_TMR:
153 case LLC_CONN_EV_TYPE_BUSY_TMR:
154 if (llc->retry_count > llc->n2) {
155 reason = LLC_RESET_REASON_LOCAL;
156 rc = 0;
Arnaldo Carvalho de Melobdcc66c2005-09-22 03:38:15 -0300157 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158 break;
159 }
160 if (!rc) {
161 ev->reason = reason;
162 ev->ind_prim = LLC_RESET_PRIM;
163 }
164 return rc;
165}
166
167int llc_conn_ac_rst_confirm(struct sock *sk, struct sk_buff *skb)
168{
169 struct llc_conn_state_ev *ev = llc_conn_ev(skb);
170
171 ev->reason = 0;
172 ev->cfm_prim = LLC_RESET_PRIM;
173 return 0;
174}
175
176int llc_conn_ac_clear_remote_busy_if_f_eq_1(struct sock *sk,
177 struct sk_buff *skb)
178{
179 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
180
181 if (LLC_PDU_IS_RSP(pdu) &&
182 LLC_PDU_TYPE_IS_I(pdu) &&
183 LLC_I_PF_IS_1(pdu) && llc_sk(sk)->ack_pf)
184 llc_conn_ac_clear_remote_busy(sk, skb);
185 return 0;
186}
187
188int llc_conn_ac_stop_rej_tmr_if_data_flag_eq_2(struct sock *sk,
189 struct sk_buff *skb)
190{
191 struct llc_sock *llc = llc_sk(sk);
192
193 if (llc->data_flag == 2)
194 del_timer(&llc->rej_sent_timer.timer);
195 return 0;
196}
197
198int llc_conn_ac_send_disc_cmd_p_set_x(struct sock *sk, struct sk_buff *skb)
199{
200 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300201 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300202 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203
204 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700205 struct llc_sap *sap = llc->sap;
206
Linus Torvalds1da177e2005-04-16 15:20:36 -0700207 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
208 llc->daddr.lsap, LLC_PDU_CMD);
209 llc_pdu_init_as_disc_cmd(nskb, 1);
210 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300211 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212 goto free;
213 llc_conn_send_pdu(sk, nskb);
214 llc_conn_ac_set_p_flag_1(sk, skb);
215 }
216out:
217 return rc;
218free:
219 kfree_skb(nskb);
220 goto out;
221}
222
223int llc_conn_ac_send_dm_rsp_f_set_p(struct sock *sk, struct sk_buff *skb)
224{
225 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300226 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300227 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228
229 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230 struct llc_sap *sap = llc->sap;
231 u8 f_bit;
232
Linus Torvalds1da177e2005-04-16 15:20:36 -0700233 llc_pdu_decode_pf_bit(skb, &f_bit);
234 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
235 llc->daddr.lsap, LLC_PDU_RSP);
236 llc_pdu_init_as_dm_rsp(nskb, f_bit);
237 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300238 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239 goto free;
240 llc_conn_send_pdu(sk, nskb);
241 }
242out:
243 return rc;
244free:
245 kfree_skb(nskb);
246 goto out;
247}
248
249int llc_conn_ac_send_dm_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
250{
251 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300252 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300253 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700254
255 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256 struct llc_sap *sap = llc->sap;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257
Linus Torvalds1da177e2005-04-16 15:20:36 -0700258 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
259 llc->daddr.lsap, LLC_PDU_RSP);
Arnaldo Carvalho de Melo838a75d2005-09-22 03:44:23 -0300260 llc_pdu_init_as_dm_rsp(nskb, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300262 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700263 goto free;
264 llc_conn_send_pdu(sk, nskb);
265 }
266out:
267 return rc;
268free:
269 kfree_skb(nskb);
270 goto out;
271}
272
273int llc_conn_ac_send_frmr_rsp_f_set_x(struct sock *sk, struct sk_buff *skb)
274{
275 u8 f_bit;
276 int rc = -ENOBUFS;
277 struct sk_buff *nskb;
278 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
279 struct llc_sock *llc = llc_sk(sk);
280
281 llc->rx_pdu_hdr = *((u32 *)pdu);
282 if (LLC_PDU_IS_CMD(pdu))
283 llc_pdu_decode_pf_bit(skb, &f_bit);
284 else
285 f_bit = 0;
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300286 nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 if (nskb) {
288 struct llc_sap *sap = llc->sap;
289
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
291 llc->daddr.lsap, LLC_PDU_RSP);
292 llc_pdu_init_as_frmr_rsp(nskb, pdu, f_bit, llc->vS,
293 llc->vR, INCORRECT);
294 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300295 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700296 goto free;
297 llc_conn_send_pdu(sk, nskb);
298 }
299out:
300 return rc;
301free:
302 kfree_skb(nskb);
303 goto out;
304}
305
306int llc_conn_ac_resend_frmr_rsp_f_set_0(struct sock *sk, struct sk_buff *skb)
307{
308 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300309 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300310 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700311
312 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313 struct llc_sap *sap = llc->sap;
314 struct llc_pdu_sn *pdu = (struct llc_pdu_sn *)&llc->rx_pdu_hdr;
315
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
317 llc->daddr.lsap, LLC_PDU_RSP);
Arnaldo Carvalho de Melo838a75d2005-09-22 03:44:23 -0300318 llc_pdu_init_as_frmr_rsp(nskb, pdu, 0, llc->vS,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319 llc->vR, INCORRECT);
320 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300321 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322 goto free;
323 llc_conn_send_pdu(sk, nskb);
324 }
325out:
326 return rc;
327free:
328 kfree_skb(nskb);
329 goto out;
330}
331
332int llc_conn_ac_resend_frmr_rsp_f_set_p(struct sock *sk, struct sk_buff *skb)
333{
334 u8 f_bit;
335 int rc = -ENOBUFS;
336 struct sk_buff *nskb;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300337 struct llc_sock *llc = llc_sk(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700338
339 llc_pdu_decode_pf_bit(skb, &f_bit);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300340 nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700341 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342 struct llc_sap *sap = llc->sap;
343 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
344
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
346 llc->daddr.lsap, LLC_PDU_RSP);
347 llc_pdu_init_as_frmr_rsp(nskb, pdu, f_bit, llc->vS,
348 llc->vR, INCORRECT);
349 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300350 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351 goto free;
352 llc_conn_send_pdu(sk, nskb);
353 }
354out:
355 return rc;
356free:
357 kfree_skb(nskb);
358 goto out;
359}
360
361int llc_conn_ac_send_i_cmd_p_set_1(struct sock *sk, struct sk_buff *skb)
362{
363 int rc;
364 struct llc_sock *llc = llc_sk(sk);
365 struct llc_sap *sap = llc->sap;
366
367 llc_pdu_header_init(skb, LLC_PDU_TYPE_I, sap->laddr.lsap,
368 llc->daddr.lsap, LLC_PDU_CMD);
369 llc_pdu_init_as_i_cmd(skb, 1, llc->vS, llc->vR);
370 rc = llc_mac_hdr_init(skb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300371 if (likely(!rc)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372 llc_conn_send_pdu(sk, skb);
373 llc_conn_ac_inc_vs_by_1(sk, skb);
374 }
375 return rc;
376}
377
378static int llc_conn_ac_send_i_cmd_p_set_0(struct sock *sk, struct sk_buff *skb)
379{
380 int rc;
381 struct llc_sock *llc = llc_sk(sk);
382 struct llc_sap *sap = llc->sap;
383
384 llc_pdu_header_init(skb, LLC_PDU_TYPE_I, sap->laddr.lsap,
385 llc->daddr.lsap, LLC_PDU_CMD);
386 llc_pdu_init_as_i_cmd(skb, 0, llc->vS, llc->vR);
387 rc = llc_mac_hdr_init(skb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300388 if (likely(!rc)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389 llc_conn_send_pdu(sk, skb);
390 llc_conn_ac_inc_vs_by_1(sk, skb);
391 }
392 return rc;
393}
394
395int llc_conn_ac_send_i_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
396{
397 int rc;
398 struct llc_sock *llc = llc_sk(sk);
399 struct llc_sap *sap = llc->sap;
400
401 llc_pdu_header_init(skb, LLC_PDU_TYPE_I, sap->laddr.lsap,
402 llc->daddr.lsap, LLC_PDU_CMD);
403 llc_pdu_init_as_i_cmd(skb, 0, llc->vS, llc->vR);
404 rc = llc_mac_hdr_init(skb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300405 if (likely(!rc)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700406 llc_conn_send_pdu(sk, skb);
407 llc_conn_ac_inc_vs_by_1(sk, skb);
408 }
409 return 0;
410}
411
412int llc_conn_ac_resend_i_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
413{
414 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
415 u8 nr = LLC_I_GET_NR(pdu);
416
417 llc_conn_resend_i_pdu_as_cmd(sk, nr, 0);
418 return 0;
419}
420
421int llc_conn_ac_resend_i_xxx_x_set_0_or_send_rr(struct sock *sk,
422 struct sk_buff *skb)
423{
424 u8 nr;
425 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
426 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300427 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300428 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700429
430 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700431 struct llc_sap *sap = llc->sap;
432
Linus Torvalds1da177e2005-04-16 15:20:36 -0700433 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
434 llc->daddr.lsap, LLC_PDU_RSP);
435 llc_pdu_init_as_rr_rsp(nskb, 0, llc->vR);
436 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300437 if (likely(!rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700438 llc_conn_send_pdu(sk, nskb);
439 else
440 kfree_skb(skb);
441 }
442 if (rc) {
443 nr = LLC_I_GET_NR(pdu);
444 rc = 0;
445 llc_conn_resend_i_pdu_as_cmd(sk, nr, 0);
446 }
447 return rc;
448}
449
450int llc_conn_ac_resend_i_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
451{
452 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
453 u8 nr = LLC_I_GET_NR(pdu);
454
455 llc_conn_resend_i_pdu_as_rsp(sk, nr, 1);
456 return 0;
457}
458
459int llc_conn_ac_send_rej_cmd_p_set_1(struct sock *sk, struct sk_buff *skb)
460{
461 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300462 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300463 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700464
465 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700466 struct llc_sap *sap = llc->sap;
467
Linus Torvalds1da177e2005-04-16 15:20:36 -0700468 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
469 llc->daddr.lsap, LLC_PDU_CMD);
470 llc_pdu_init_as_rej_cmd(nskb, 1, llc->vR);
471 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300472 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700473 goto free;
474 llc_conn_send_pdu(sk, nskb);
475 }
476out:
477 return rc;
478free:
479 kfree_skb(nskb);
480 goto out;
481}
482
483int llc_conn_ac_send_rej_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
484{
485 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300486 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300487 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488
489 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700490 struct llc_sap *sap = llc->sap;
491
Linus Torvalds1da177e2005-04-16 15:20:36 -0700492 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
493 llc->daddr.lsap, LLC_PDU_RSP);
Arnaldo Carvalho de Melo838a75d2005-09-22 03:44:23 -0300494 llc_pdu_init_as_rej_rsp(nskb, 1, llc->vR);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700495 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300496 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497 goto free;
498 llc_conn_send_pdu(sk, nskb);
499 }
500out:
501 return rc;
502free:
503 kfree_skb(nskb);
504 goto out;
505}
506
507int llc_conn_ac_send_rej_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
508{
509 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300510 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300511 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512
513 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 struct llc_sap *sap = llc->sap;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
517 llc->daddr.lsap, LLC_PDU_RSP);
Arnaldo Carvalho de Melo838a75d2005-09-22 03:44:23 -0300518 llc_pdu_init_as_rej_rsp(nskb, 0, llc->vR);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700519 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300520 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700521 goto free;
522 llc_conn_send_pdu(sk, nskb);
523 }
524out:
525 return rc;
526free:
527 kfree_skb(nskb);
528 goto out;
529}
530
531int llc_conn_ac_send_rnr_cmd_p_set_1(struct sock *sk, struct sk_buff *skb)
532{
533 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300534 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300535 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536
537 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538 struct llc_sap *sap = llc->sap;
539
Linus Torvalds1da177e2005-04-16 15:20:36 -0700540 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
541 llc->daddr.lsap, LLC_PDU_CMD);
542 llc_pdu_init_as_rnr_cmd(nskb, 1, llc->vR);
543 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300544 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545 goto free;
546 llc_conn_send_pdu(sk, nskb);
547 }
548out:
549 return rc;
550free:
551 kfree_skb(nskb);
552 goto out;
553}
554
555int llc_conn_ac_send_rnr_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
556{
557 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300558 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300559 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700560
561 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700562 struct llc_sap *sap = llc->sap;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700563
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
565 llc->daddr.lsap, LLC_PDU_RSP);
Arnaldo Carvalho de Melo838a75d2005-09-22 03:44:23 -0300566 llc_pdu_init_as_rnr_rsp(nskb, 1, llc->vR);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700567 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300568 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700569 goto free;
570 llc_conn_send_pdu(sk, nskb);
571 }
572out:
573 return rc;
574free:
575 kfree_skb(nskb);
576 goto out;
577}
578
579int llc_conn_ac_send_rnr_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
580{
581 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300582 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300583 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584
585 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700586 struct llc_sap *sap = llc->sap;
587
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
589 llc->daddr.lsap, LLC_PDU_RSP);
Arnaldo Carvalho de Melo838a75d2005-09-22 03:44:23 -0300590 llc_pdu_init_as_rnr_rsp(nskb, 0, llc->vR);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300592 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700593 goto free;
594 llc_conn_send_pdu(sk, nskb);
595 }
596out:
597 return rc;
598free:
599 kfree_skb(nskb);
600 goto out;
601}
602
603int llc_conn_ac_set_remote_busy(struct sock *sk, struct sk_buff *skb)
604{
605 struct llc_sock *llc = llc_sk(sk);
606
607 if (!llc->remote_busy_flag) {
608 llc->remote_busy_flag = 1;
609 mod_timer(&llc->busy_state_timer.timer,
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -0300610 jiffies + llc->busy_state_timer.expire);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611 }
612 return 0;
613}
614
615int llc_conn_ac_opt_send_rnr_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
616{
617 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300618 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300619 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700620
621 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700622 struct llc_sap *sap = llc->sap;
623
Linus Torvalds1da177e2005-04-16 15:20:36 -0700624 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
625 llc->daddr.lsap, LLC_PDU_RSP);
626 llc_pdu_init_as_rnr_rsp(nskb, 0, llc->vR);
627 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300628 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629 goto free;
630 llc_conn_send_pdu(sk, nskb);
631 }
632out:
633 return rc;
634free:
635 kfree_skb(nskb);
636 goto out;
637}
638
639int llc_conn_ac_send_rr_cmd_p_set_1(struct sock *sk, struct sk_buff *skb)
640{
641 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300642 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300643 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644
645 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646 struct llc_sap *sap = llc->sap;
647
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
649 llc->daddr.lsap, LLC_PDU_CMD);
650 llc_pdu_init_as_rr_cmd(nskb, 1, llc->vR);
651 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300652 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700653 goto free;
654 llc_conn_send_pdu(sk, nskb);
655 }
656out:
657 return rc;
658free:
659 kfree_skb(nskb);
660 goto out;
661}
662
663int llc_conn_ac_send_rr_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
664{
665 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300666 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300667 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700668
669 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670 struct llc_sap *sap = llc->sap;
671 u8 f_bit = 1;
672
Linus Torvalds1da177e2005-04-16 15:20:36 -0700673 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
674 llc->daddr.lsap, LLC_PDU_RSP);
675 llc_pdu_init_as_rr_rsp(nskb, f_bit, llc->vR);
676 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300677 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700678 goto free;
679 llc_conn_send_pdu(sk, nskb);
680 }
681out:
682 return rc;
683free:
684 kfree_skb(nskb);
685 goto out;
686}
687
688int llc_conn_ac_send_ack_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
689{
690 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300691 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300692 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700693
694 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 struct llc_sap *sap = llc->sap;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696
Linus Torvalds1da177e2005-04-16 15:20:36 -0700697 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
698 llc->daddr.lsap, LLC_PDU_RSP);
Arnaldo Carvalho de Melo838a75d2005-09-22 03:44:23 -0300699 llc_pdu_init_as_rr_rsp(nskb, 1, llc->vR);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300701 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 goto free;
703 llc_conn_send_pdu(sk, nskb);
704 }
705out:
706 return rc;
707free:
708 kfree_skb(nskb);
709 goto out;
710}
711
712int llc_conn_ac_send_rr_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
713{
714 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300715 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300716 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700717
718 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719 struct llc_sap *sap = llc->sap;
720
Linus Torvalds1da177e2005-04-16 15:20:36 -0700721 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
722 llc->daddr.lsap, LLC_PDU_RSP);
723 llc_pdu_init_as_rr_rsp(nskb, 0, llc->vR);
724 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300725 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726 goto free;
727 llc_conn_send_pdu(sk, nskb);
728 }
729out:
730 return rc;
731free:
732 kfree_skb(nskb);
733 goto out;
734}
735
736int llc_conn_ac_send_ack_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
737{
738 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300739 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300740 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700741
742 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700743 struct llc_sap *sap = llc->sap;
744
Linus Torvalds1da177e2005-04-16 15:20:36 -0700745 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
746 llc->daddr.lsap, LLC_PDU_RSP);
747 llc_pdu_init_as_rr_rsp(nskb, 0, llc->vR);
748 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300749 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700750 goto free;
751 llc_conn_send_pdu(sk, nskb);
752 }
753out:
754 return rc;
755free:
756 kfree_skb(nskb);
757 goto out;
758}
759
760void llc_conn_set_p_flag(struct sock *sk, u8 value)
761{
762 int state_changed = llc_sk(sk)->p_flag && !value;
763
764 llc_sk(sk)->p_flag = value;
765
766 if (state_changed)
767 sk->sk_state_change(sk);
768}
769
770int llc_conn_ac_send_sabme_cmd_p_set_x(struct sock *sk, struct sk_buff *skb)
771{
772 int rc = -ENOBUFS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700773 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300774 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700775
776 if (nskb) {
777 struct llc_sap *sap = llc->sap;
778 u8 *dmac = llc->daddr.mac;
779
780 if (llc->dev->flags & IFF_LOOPBACK)
781 dmac = llc->dev->dev_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700782 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
783 llc->daddr.lsap, LLC_PDU_CMD);
784 llc_pdu_init_as_sabme_cmd(nskb, 1);
785 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, dmac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300786 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700787 goto free;
788 llc_conn_send_pdu(sk, nskb);
789 llc_conn_set_p_flag(sk, 1);
790 }
791out:
792 return rc;
793free:
794 kfree_skb(nskb);
795 goto out;
796}
797
798int llc_conn_ac_send_ua_rsp_f_set_p(struct sock *sk, struct sk_buff *skb)
799{
800 u8 f_bit;
801 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300802 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300803 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700804
805 llc_pdu_decode_pf_bit(skb, &f_bit);
806 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700807 struct llc_sap *sap = llc->sap;
808
809 nskb->dev = llc->dev;
810 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
811 llc->daddr.lsap, LLC_PDU_RSP);
812 llc_pdu_init_as_ua_rsp(nskb, f_bit);
813 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300814 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700815 goto free;
816 llc_conn_send_pdu(sk, nskb);
817 }
818out:
819 return rc;
820free:
821 kfree_skb(nskb);
822 goto out;
823}
824
825int llc_conn_ac_set_s_flag_0(struct sock *sk, struct sk_buff *skb)
826{
827 llc_sk(sk)->s_flag = 0;
828 return 0;
829}
830
831int llc_conn_ac_set_s_flag_1(struct sock *sk, struct sk_buff *skb)
832{
833 llc_sk(sk)->s_flag = 1;
834 return 0;
835}
836
837int llc_conn_ac_start_p_timer(struct sock *sk, struct sk_buff *skb)
838{
839 struct llc_sock *llc = llc_sk(sk);
840
841 llc_conn_set_p_flag(sk, 1);
842 mod_timer(&llc->pf_cycle_timer.timer,
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -0300843 jiffies + llc->pf_cycle_timer.expire);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844 return 0;
845}
846
847/**
848 * llc_conn_ac_send_ack_if_needed - check if ack is needed
849 * @sk: current connection structure
850 * @skb: current event
851 *
852 * Checks number of received PDUs which have not been acknowledged, yet,
853 * If number of them reaches to "npta"(Number of PDUs To Acknowledge) then
854 * sends an RR response as acknowledgement for them. Returns 0 for
855 * success, 1 otherwise.
856 */
857int llc_conn_ac_send_ack_if_needed(struct sock *sk, struct sk_buff *skb)
858{
859 u8 pf_bit;
860 struct llc_sock *llc = llc_sk(sk);
861
862 llc_pdu_decode_pf_bit(skb, &pf_bit);
863 llc->ack_pf |= pf_bit & 1;
864 if (!llc->ack_must_be_send) {
865 llc->first_pdu_Ns = llc->vR;
866 llc->ack_must_be_send = 1;
867 llc->ack_pf = pf_bit & 1;
868 }
Jochen Friedrich59c61962005-11-14 21:57:15 -0800869 if (((llc->vR - llc->first_pdu_Ns + 1 + LLC_2_SEQ_NBR_MODULO)
870 % LLC_2_SEQ_NBR_MODULO) >= llc->npta) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700871 llc_conn_ac_send_rr_rsp_f_set_ackpf(sk, skb);
872 llc->ack_must_be_send = 0;
873 llc->ack_pf = 0;
874 llc_conn_ac_inc_npta_value(sk, skb);
875 }
876 return 0;
877}
878
879/**
880 * llc_conn_ac_rst_sendack_flag - resets ack_must_be_send flag
881 * @sk: current connection structure
882 * @skb: current event
883 *
884 * This action resets ack_must_be_send flag of given connection, this flag
885 * indicates if there is any PDU which has not been acknowledged yet.
886 * Returns 0 for success, 1 otherwise.
887 */
888int llc_conn_ac_rst_sendack_flag(struct sock *sk, struct sk_buff *skb)
889{
890 llc_sk(sk)->ack_must_be_send = llc_sk(sk)->ack_pf = 0;
891 return 0;
892}
893
894/**
895 * llc_conn_ac_send_i_rsp_f_set_ackpf - acknowledge received PDUs
896 * @sk: current connection structure
897 * @skb: current event
898 *
899 * Sends an I response PDU with f-bit set to ack_pf flag as acknowledge to
900 * all received PDUs which have not been acknowledged, yet. ack_pf flag is
901 * set to one if one PDU with p-bit set to one is received. Returns 0 for
902 * success, 1 otherwise.
903 */
904static int llc_conn_ac_send_i_rsp_f_set_ackpf(struct sock *sk,
905 struct sk_buff *skb)
906{
907 int rc;
908 struct llc_sock *llc = llc_sk(sk);
909 struct llc_sap *sap = llc->sap;
910
911 llc_pdu_header_init(skb, LLC_PDU_TYPE_I, sap->laddr.lsap,
912 llc->daddr.lsap, LLC_PDU_RSP);
913 llc_pdu_init_as_i_cmd(skb, llc->ack_pf, llc->vS, llc->vR);
914 rc = llc_mac_hdr_init(skb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300915 if (likely(!rc)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700916 llc_conn_send_pdu(sk, skb);
917 llc_conn_ac_inc_vs_by_1(sk, skb);
918 }
919 return rc;
920}
921
922/**
923 * llc_conn_ac_send_i_as_ack - sends an I-format PDU to acknowledge rx PDUs
924 * @sk: current connection structure.
925 * @skb: current event.
926 *
927 * This action sends an I-format PDU as acknowledge to received PDUs which
928 * have not been acknowledged, yet, if there is any. By using of this
929 * action number of acknowledgements decreases, this technic is called
930 * piggy backing. Returns 0 for success, 1 otherwise.
931 */
932int llc_conn_ac_send_i_as_ack(struct sock *sk, struct sk_buff *skb)
933{
934 struct llc_sock *llc = llc_sk(sk);
935
936 if (llc->ack_must_be_send) {
937 llc_conn_ac_send_i_rsp_f_set_ackpf(sk, skb);
938 llc->ack_must_be_send = 0 ;
939 llc->ack_pf = 0;
940 } else
941 llc_conn_ac_send_i_cmd_p_set_0(sk, skb);
942 return 0;
943}
944
945/**
946 * llc_conn_ac_send_rr_rsp_f_set_ackpf - ack all rx PDUs not yet acked
947 * @sk: current connection structure.
948 * @skb: current event.
949 *
950 * This action sends an RR response with f-bit set to ack_pf flag as
951 * acknowledge to all received PDUs which have not been acknowledged, yet,
952 * if there is any. ack_pf flag indicates if a PDU has been received with
953 * p-bit set to one. Returns 0 for success, 1 otherwise.
954 */
955static int llc_conn_ac_send_rr_rsp_f_set_ackpf(struct sock *sk,
956 struct sk_buff *skb)
957{
958 int rc = -ENOBUFS;
Arnaldo Carvalho de Melo1d67e652005-09-22 03:27:56 -0300959 struct llc_sock *llc = llc_sk(sk);
Arnaldo Carvalho de Melod3894242005-09-22 07:57:21 -0300960 struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700961
962 if (nskb) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700963 struct llc_sap *sap = llc->sap;
964
Linus Torvalds1da177e2005-04-16 15:20:36 -0700965 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
966 llc->daddr.lsap, LLC_PDU_RSP);
967 llc_pdu_init_as_rr_rsp(nskb, llc->ack_pf, llc->vR);
968 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300969 if (unlikely(rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700970 goto free;
971 llc_conn_send_pdu(sk, nskb);
972 }
973out:
974 return rc;
975free:
976 kfree_skb(nskb);
977 goto out;
978}
979
980/**
981 * llc_conn_ac_inc_npta_value - tries to make value of npta greater
982 * @sk: current connection structure.
983 * @skb: current event.
984 *
985 * After "inc_cntr" times calling of this action, "npta" increase by one.
986 * this action tries to make vale of "npta" greater as possible; number of
987 * acknowledgements decreases by increasing of "npta". Returns 0 for
988 * success, 1 otherwise.
989 */
990static int llc_conn_ac_inc_npta_value(struct sock *sk, struct sk_buff *skb)
991{
992 struct llc_sock *llc = llc_sk(sk);
993
994 if (!llc->inc_cntr) {
995 llc->dec_step = 0;
996 llc->dec_cntr = llc->inc_cntr = 2;
997 ++llc->npta;
David S. Miller38199822005-11-17 15:17:42 -0800998 if (llc->npta > (u8) ~LLC_2_SEQ_NBR_MODULO)
999 llc->npta = (u8) ~LLC_2_SEQ_NBR_MODULO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001000 } else
1001 --llc->inc_cntr;
1002 return 0;
1003}
1004
1005/**
1006 * llc_conn_ac_adjust_npta_by_rr - decreases "npta" by one
1007 * @sk: current connection structure.
1008 * @skb: current event.
1009 *
1010 * After receiving "dec_cntr" times RR command, this action decreases
1011 * "npta" by one. Returns 0 for success, 1 otherwise.
1012 */
1013int llc_conn_ac_adjust_npta_by_rr(struct sock *sk, struct sk_buff *skb)
1014{
1015 struct llc_sock *llc = llc_sk(sk);
1016
1017 if (!llc->connect_step && !llc->remote_busy_flag) {
1018 if (!llc->dec_step) {
1019 if (!llc->dec_cntr) {
1020 llc->inc_cntr = llc->dec_cntr = 2;
1021 if (llc->npta > 0)
1022 llc->npta = llc->npta - 1;
1023 } else
1024 llc->dec_cntr -=1;
1025 }
1026 } else
1027 llc->connect_step = 0 ;
1028 return 0;
1029}
1030
1031/**
1032 * llc_conn_ac_adjust_npta_by_rnr - decreases "npta" by one
1033 * @sk: current connection structure.
1034 * @skb: current event.
1035 *
1036 * After receiving "dec_cntr" times RNR command, this action decreases
1037 * "npta" by one. Returns 0 for success, 1 otherwise.
1038 */
1039int llc_conn_ac_adjust_npta_by_rnr(struct sock *sk, struct sk_buff *skb)
1040{
1041 struct llc_sock *llc = llc_sk(sk);
1042
1043 if (llc->remote_busy_flag)
1044 if (!llc->dec_step) {
1045 if (!llc->dec_cntr) {
1046 llc->inc_cntr = llc->dec_cntr = 2;
1047 if (llc->npta > 0)
1048 --llc->npta;
1049 } else
1050 --llc->dec_cntr;
1051 }
1052 return 0;
1053}
1054
1055/**
1056 * llc_conn_ac_dec_tx_win_size - decreases tx window size
1057 * @sk: current connection structure.
1058 * @skb: current event.
1059 *
1060 * After receiving of a REJ command or response, transmit window size is
1061 * decreased by number of PDUs which are outstanding yet. Returns 0 for
1062 * success, 1 otherwise.
1063 */
1064int llc_conn_ac_dec_tx_win_size(struct sock *sk, struct sk_buff *skb)
1065{
1066 struct llc_sock *llc = llc_sk(sk);
1067 u8 unacked_pdu = skb_queue_len(&llc->pdu_unack_q);
1068
Jochen Friedrich59c61962005-11-14 21:57:15 -08001069 if (llc->k - unacked_pdu < 1)
1070 llc->k = 1;
1071 else
1072 llc->k -= unacked_pdu;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001073 return 0;
1074}
1075
1076/**
1077 * llc_conn_ac_inc_tx_win_size - tx window size is inc by 1
1078 * @sk: current connection structure.
1079 * @skb: current event.
1080 *
1081 * After receiving an RR response with f-bit set to one, transmit window
1082 * size is increased by one. Returns 0 for success, 1 otherwise.
1083 */
1084int llc_conn_ac_inc_tx_win_size(struct sock *sk, struct sk_buff *skb)
1085{
1086 struct llc_sock *llc = llc_sk(sk);
1087
1088 llc->k += 1;
David S. Miller38199822005-11-17 15:17:42 -08001089 if (llc->k > (u8) ~LLC_2_SEQ_NBR_MODULO)
1090 llc->k = (u8) ~LLC_2_SEQ_NBR_MODULO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001091 return 0;
1092}
1093
1094int llc_conn_ac_stop_all_timers(struct sock *sk, struct sk_buff *skb)
1095{
1096 struct llc_sock *llc = llc_sk(sk);
1097
1098 del_timer(&llc->pf_cycle_timer.timer);
1099 del_timer(&llc->ack_timer.timer);
1100 del_timer(&llc->rej_sent_timer.timer);
1101 del_timer(&llc->busy_state_timer.timer);
1102 llc->ack_must_be_send = 0;
1103 llc->ack_pf = 0;
1104 return 0;
1105}
1106
1107int llc_conn_ac_stop_other_timers(struct sock *sk, struct sk_buff *skb)
1108{
1109 struct llc_sock *llc = llc_sk(sk);
1110
1111 del_timer(&llc->rej_sent_timer.timer);
1112 del_timer(&llc->pf_cycle_timer.timer);
1113 del_timer(&llc->busy_state_timer.timer);
1114 llc->ack_must_be_send = 0;
1115 llc->ack_pf = 0;
1116 return 0;
1117}
1118
1119int llc_conn_ac_start_ack_timer(struct sock *sk, struct sk_buff *skb)
1120{
1121 struct llc_sock *llc = llc_sk(sk);
1122
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001123 mod_timer(&llc->ack_timer.timer, jiffies + llc->ack_timer.expire);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001124 return 0;
1125}
1126
1127int llc_conn_ac_start_rej_timer(struct sock *sk, struct sk_buff *skb)
1128{
1129 struct llc_sock *llc = llc_sk(sk);
1130
1131 mod_timer(&llc->rej_sent_timer.timer,
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001132 jiffies + llc->rej_sent_timer.expire);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001133 return 0;
1134}
1135
1136int llc_conn_ac_start_ack_tmr_if_not_running(struct sock *sk,
1137 struct sk_buff *skb)
1138{
1139 struct llc_sock *llc = llc_sk(sk);
1140
1141 if (!timer_pending(&llc->ack_timer.timer))
1142 mod_timer(&llc->ack_timer.timer,
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001143 jiffies + llc->ack_timer.expire);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001144 return 0;
1145}
1146
1147int llc_conn_ac_stop_ack_timer(struct sock *sk, struct sk_buff *skb)
1148{
1149 del_timer(&llc_sk(sk)->ack_timer.timer);
1150 return 0;
1151}
1152
1153int llc_conn_ac_stop_p_timer(struct sock *sk, struct sk_buff *skb)
1154{
1155 struct llc_sock *llc = llc_sk(sk);
1156
1157 del_timer(&llc->pf_cycle_timer.timer);
1158 llc_conn_set_p_flag(sk, 0);
1159 return 0;
1160}
1161
1162int llc_conn_ac_stop_rej_timer(struct sock *sk, struct sk_buff *skb)
1163{
1164 del_timer(&llc_sk(sk)->rej_sent_timer.timer);
1165 return 0;
1166}
1167
1168int llc_conn_ac_upd_nr_received(struct sock *sk, struct sk_buff *skb)
1169{
1170 int acked;
1171 u16 unacked = 0;
1172 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
1173 struct llc_sock *llc = llc_sk(sk);
1174
1175 llc->last_nr = PDU_SUPV_GET_Nr(pdu);
1176 acked = llc_conn_remove_acked_pdus(sk, llc->last_nr, &unacked);
1177 /* On loopback we don't queue I frames in unack_pdu_q queue. */
1178 if (acked > 0 || (llc->dev->flags & IFF_LOOPBACK)) {
1179 llc->retry_count = 0;
1180 del_timer(&llc->ack_timer.timer);
1181 if (llc->failed_data_req) {
1182 /* already, we did not accept data from upper layer
1183 * (tx_window full or unacceptable state). Now, we
1184 * can send data and must inform to upper layer.
1185 */
1186 llc->failed_data_req = 0;
1187 llc_conn_ac_data_confirm(sk, skb);
1188 }
1189 if (unacked)
1190 mod_timer(&llc->ack_timer.timer,
Arnaldo Carvalho de Melo590232a2005-09-22 04:30:44 -03001191 jiffies + llc->ack_timer.expire);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001192 } else if (llc->failed_data_req) {
1193 u8 f_bit;
1194
1195 llc_pdu_decode_pf_bit(skb, &f_bit);
1196 if (f_bit == 1) {
1197 llc->failed_data_req = 0;
1198 llc_conn_ac_data_confirm(sk, skb);
1199 }
1200 }
1201 return 0;
1202}
1203
1204int llc_conn_ac_upd_p_flag(struct sock *sk, struct sk_buff *skb)
1205{
1206 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
1207
1208 if (LLC_PDU_IS_RSP(pdu)) {
1209 u8 f_bit;
1210
1211 llc_pdu_decode_pf_bit(skb, &f_bit);
1212 if (f_bit) {
1213 llc_conn_set_p_flag(sk, 0);
1214 llc_conn_ac_stop_p_timer(sk, skb);
1215 }
1216 }
1217 return 0;
1218}
1219
1220int llc_conn_ac_set_data_flag_2(struct sock *sk, struct sk_buff *skb)
1221{
1222 llc_sk(sk)->data_flag = 2;
1223 return 0;
1224}
1225
1226int llc_conn_ac_set_data_flag_0(struct sock *sk, struct sk_buff *skb)
1227{
1228 llc_sk(sk)->data_flag = 0;
1229 return 0;
1230}
1231
1232int llc_conn_ac_set_data_flag_1(struct sock *sk, struct sk_buff *skb)
1233{
1234 llc_sk(sk)->data_flag = 1;
1235 return 0;
1236}
1237
1238int llc_conn_ac_set_data_flag_1_if_data_flag_eq_0(struct sock *sk,
1239 struct sk_buff *skb)
1240{
1241 if (!llc_sk(sk)->data_flag)
1242 llc_sk(sk)->data_flag = 1;
1243 return 0;
1244}
1245
1246int llc_conn_ac_set_p_flag_0(struct sock *sk, struct sk_buff *skb)
1247{
1248 llc_conn_set_p_flag(sk, 0);
1249 return 0;
1250}
1251
1252static int llc_conn_ac_set_p_flag_1(struct sock *sk, struct sk_buff *skb)
1253{
1254 llc_conn_set_p_flag(sk, 1);
1255 return 0;
1256}
1257
1258int llc_conn_ac_set_remote_busy_0(struct sock *sk, struct sk_buff *skb)
1259{
1260 llc_sk(sk)->remote_busy_flag = 0;
1261 return 0;
1262}
1263
1264int llc_conn_ac_set_cause_flag_0(struct sock *sk, struct sk_buff *skb)
1265{
1266 llc_sk(sk)->cause_flag = 0;
1267 return 0;
1268}
1269
1270int llc_conn_ac_set_cause_flag_1(struct sock *sk, struct sk_buff *skb)
1271{
1272 llc_sk(sk)->cause_flag = 1;
1273 return 0;
1274}
1275
1276int llc_conn_ac_set_retry_cnt_0(struct sock *sk, struct sk_buff *skb)
1277{
1278 llc_sk(sk)->retry_count = 0;
1279 return 0;
1280}
1281
1282int llc_conn_ac_inc_retry_cnt_by_1(struct sock *sk, struct sk_buff *skb)
1283{
1284 llc_sk(sk)->retry_count++;
1285 return 0;
1286}
1287
1288int llc_conn_ac_set_vr_0(struct sock *sk, struct sk_buff *skb)
1289{
1290 llc_sk(sk)->vR = 0;
1291 return 0;
1292}
1293
1294int llc_conn_ac_inc_vr_by_1(struct sock *sk, struct sk_buff *skb)
1295{
1296 llc_sk(sk)->vR = PDU_GET_NEXT_Vr(llc_sk(sk)->vR);
1297 return 0;
1298}
1299
1300int llc_conn_ac_set_vs_0(struct sock *sk, struct sk_buff *skb)
1301{
1302 llc_sk(sk)->vS = 0;
1303 return 0;
1304}
1305
1306int llc_conn_ac_set_vs_nr(struct sock *sk, struct sk_buff *skb)
1307{
1308 llc_sk(sk)->vS = llc_sk(sk)->last_nr;
1309 return 0;
1310}
1311
Arnaldo Carvalho de Melo2928c192005-09-22 05:14:33 -03001312static int llc_conn_ac_inc_vs_by_1(struct sock *sk, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001313{
Jochen Friedrich59c61962005-11-14 21:57:15 -08001314 llc_sk(sk)->vS = (llc_sk(sk)->vS + 1) % LLC_2_SEQ_NBR_MODULO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001315 return 0;
1316}
1317
Arnaldo Carvalho de Meloe0dd5512005-09-22 03:50:15 -03001318static void llc_conn_tmr_common_cb(unsigned long timeout_data, u8 type)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001319{
1320 struct sock *sk = (struct sock *)timeout_data;
1321 struct sk_buff *skb = alloc_skb(0, GFP_ATOMIC);
1322
1323 bh_lock_sock(sk);
1324 if (skb) {
1325 struct llc_conn_state_ev *ev = llc_conn_ev(skb);
1326
Arnaldo Carvalho de Melo04e42232005-09-22 04:40:59 -03001327 skb_set_owner_r(skb, sk);
Arnaldo Carvalho de Meloe0dd5512005-09-22 03:50:15 -03001328 ev->type = type;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001329 llc_process_tmr_ev(sk, skb);
1330 }
1331 bh_unlock_sock(sk);
1332}
1333
Arnaldo Carvalho de Meloe0dd5512005-09-22 03:50:15 -03001334void llc_conn_pf_cycle_tmr_cb(unsigned long timeout_data)
1335{
1336 llc_conn_tmr_common_cb(timeout_data, LLC_CONN_EV_TYPE_P_TMR);
1337}
1338
Linus Torvalds1da177e2005-04-16 15:20:36 -07001339void llc_conn_busy_tmr_cb(unsigned long timeout_data)
1340{
Arnaldo Carvalho de Meloe0dd5512005-09-22 03:50:15 -03001341 llc_conn_tmr_common_cb(timeout_data, LLC_CONN_EV_TYPE_BUSY_TMR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001342}
1343
1344void llc_conn_ack_tmr_cb(unsigned long timeout_data)
1345{
Arnaldo Carvalho de Meloe0dd5512005-09-22 03:50:15 -03001346 llc_conn_tmr_common_cb(timeout_data, LLC_CONN_EV_TYPE_ACK_TMR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001347}
1348
1349void llc_conn_rej_tmr_cb(unsigned long timeout_data)
1350{
Arnaldo Carvalho de Meloe0dd5512005-09-22 03:50:15 -03001351 llc_conn_tmr_common_cb(timeout_data, LLC_CONN_EV_TYPE_REJ_TMR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352}
1353
1354int llc_conn_ac_rst_vs(struct sock *sk, struct sk_buff *skb)
1355{
1356 llc_sk(sk)->X = llc_sk(sk)->vS;
1357 llc_conn_ac_set_vs_nr(sk, skb);
1358 return 0;
1359}
1360
1361int llc_conn_ac_upd_vs(struct sock *sk, struct sk_buff *skb)
1362{
1363 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
1364 u8 nr = PDU_SUPV_GET_Nr(pdu);
1365
1366 if (llc_circular_between(llc_sk(sk)->vS, nr, llc_sk(sk)->X))
1367 llc_conn_ac_set_vs_nr(sk, skb);
1368 return 0;
1369}
1370
1371/*
1372 * Non-standard actions; these not contained in IEEE specification; for
1373 * our own usage
1374 */
1375/**
1376 * llc_conn_disc - removes connection from SAP list and frees it
1377 * @sk: closed connection
1378 * @skb: occurred event
1379 */
1380int llc_conn_disc(struct sock *sk, struct sk_buff *skb)
1381{
1382 /* FIXME: this thing seems to want to die */
1383 return 0;
1384}
1385
1386/**
1387 * llc_conn_reset - resets connection
1388 * @sk : reseting connection.
1389 * @skb: occurred event.
1390 *
1391 * Stop all timers, empty all queues and reset all flags.
1392 */
1393int llc_conn_reset(struct sock *sk, struct sk_buff *skb)
1394{
1395 llc_sk_reset(sk);
1396 return 0;
1397}
1398
1399/**
1400 * llc_circular_between - designates that b is between a and c or not
1401 * @a: lower bound
1402 * @b: element to see if is between a and b
1403 * @c: upper bound
1404 *
1405 * This function designates that b is between a and c or not (for example,
1406 * 0 is between 127 and 1). Returns 1 if b is between a and c, 0
1407 * otherwise.
1408 */
1409u8 llc_circular_between(u8 a, u8 b, u8 c)
1410{
1411 b = b - a;
1412 c = c - a;
1413 return b <= c;
1414}
1415
1416/**
1417 * llc_process_tmr_ev - timer backend
1418 * @sk: active connection
1419 * @skb: occurred event
1420 *
1421 * This function is called from timer callback functions. When connection
1422 * is busy (during sending a data frame) timer expiration event must be
1423 * queued. Otherwise this event can be sent to connection state machine.
1424 * Queued events will process by llc_backlog_rcv function after sending
1425 * data frame.
1426 */
1427static void llc_process_tmr_ev(struct sock *sk, struct sk_buff *skb)
1428{
1429 if (llc_sk(sk)->state == LLC_CONN_OUT_OF_SVC) {
1430 printk(KERN_WARNING "%s: timer called on closed connection\n",
1431 __FUNCTION__);
1432 kfree_skb(skb);
1433 } else {
1434 if (!sock_owned_by_user(sk))
1435 llc_conn_state_process(sk, skb);
1436 else {
1437 llc_set_backlog_type(skb, LLC_EVENT);
1438 sk_add_backlog(sk, skb);
1439 }
1440 }
1441}