V4L/DVB (10707): zoran: set bytesperline to 0 when using MJPEG.
[linux-2.6] / net / llc / llc_c_ac.c
1 /*
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
31 static int llc_conn_ac_inc_vs_by_1(struct sock *sk, struct sk_buff *skb);
32 static void llc_process_tmr_ev(struct sock *sk, struct sk_buff *skb);
33 static int llc_conn_ac_data_confirm(struct sock *sk, struct sk_buff *ev);
34
35 static int llc_conn_ac_inc_npta_value(struct sock *sk, struct sk_buff *skb);
36
37 static int llc_conn_ac_send_rr_rsp_f_set_ackpf(struct sock *sk,
38                                                struct sk_buff *skb);
39
40 static int llc_conn_ac_set_p_flag_1(struct sock *sk, struct sk_buff *skb);
41
42 #define INCORRECT 0
43
44 int llc_conn_ac_clear_remote_busy(struct sock *sk, struct sk_buff *skb)
45 {
46         struct llc_sock *llc = llc_sk(sk);
47
48         if (llc->remote_busy_flag) {
49                 u8 nr;
50                 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
51
52                 llc->remote_busy_flag = 0;
53                 del_timer(&llc->busy_state_timer.timer);
54                 nr = LLC_I_GET_NR(pdu);
55                 llc_conn_resend_i_pdu_as_cmd(sk, nr, 0);
56         }
57         return 0;
58 }
59
60 int llc_conn_ac_conn_ind(struct sock *sk, struct sk_buff *skb)
61 {
62         struct llc_conn_state_ev *ev = llc_conn_ev(skb);
63
64         ev->ind_prim = LLC_CONN_PRIM;
65         return 0;
66 }
67
68 int llc_conn_ac_conn_confirm(struct sock *sk, struct sk_buff *skb)
69 {
70         struct llc_conn_state_ev *ev = llc_conn_ev(skb);
71
72         ev->cfm_prim = LLC_CONN_PRIM;
73         return 0;
74 }
75
76 static int llc_conn_ac_data_confirm(struct sock *sk, struct sk_buff *skb)
77 {
78         struct llc_conn_state_ev *ev = llc_conn_ev(skb);
79
80         ev->cfm_prim = LLC_DATA_PRIM;
81         return 0;
82 }
83
84 int llc_conn_ac_data_ind(struct sock *sk, struct sk_buff *skb)
85 {
86         llc_conn_rtn_pdu(sk, skb);
87         return 0;
88 }
89
90 int llc_conn_ac_disc_ind(struct sock *sk, struct sk_buff *skb)
91 {
92         struct llc_conn_state_ev *ev = llc_conn_ev(skb);
93         u8 reason = 0;
94         int rc = 0;
95
96         if (ev->type == LLC_CONN_EV_TYPE_PDU) {
97                 struct llc_pdu_un *pdu = llc_pdu_un_hdr(skb);
98
99                 if (LLC_PDU_IS_RSP(pdu) &&
100                     LLC_PDU_TYPE_IS_U(pdu) &&
101                     LLC_U_PDU_RSP(pdu) == LLC_2_PDU_RSP_DM)
102                         reason = LLC_DISC_REASON_RX_DM_RSP_PDU;
103                 else if (LLC_PDU_IS_CMD(pdu) &&
104                            LLC_PDU_TYPE_IS_U(pdu) &&
105                            LLC_U_PDU_CMD(pdu) == LLC_2_PDU_CMD_DISC)
106                         reason = LLC_DISC_REASON_RX_DISC_CMD_PDU;
107         } else if (ev->type == LLC_CONN_EV_TYPE_ACK_TMR)
108                 reason = LLC_DISC_REASON_ACK_TMR_EXP;
109         else
110                 rc = -EINVAL;
111         if (!rc) {
112                 ev->reason   = reason;
113                 ev->ind_prim = LLC_DISC_PRIM;
114         }
115         return rc;
116 }
117
118 int llc_conn_ac_disc_confirm(struct sock *sk, struct sk_buff *skb)
119 {
120         struct llc_conn_state_ev *ev = llc_conn_ev(skb);
121
122         ev->reason   = ev->status;
123         ev->cfm_prim = LLC_DISC_PRIM;
124         return 0;
125 }
126
127 int llc_conn_ac_rst_ind(struct sock *sk, struct sk_buff *skb)
128 {
129         u8 reason = 0;
130         int rc = 1;
131         struct llc_conn_state_ev *ev = llc_conn_ev(skb);
132         struct llc_pdu_un *pdu = llc_pdu_un_hdr(skb);
133         struct llc_sock *llc = llc_sk(sk);
134
135         switch (ev->type) {
136         case LLC_CONN_EV_TYPE_PDU:
137                 if (LLC_PDU_IS_RSP(pdu) &&
138                     LLC_PDU_TYPE_IS_U(pdu) &&
139                     LLC_U_PDU_RSP(pdu) == LLC_2_PDU_RSP_FRMR) {
140                         reason = LLC_RESET_REASON_LOCAL;
141                         rc = 0;
142                 } else if (LLC_PDU_IS_CMD(pdu) &&
143                            LLC_PDU_TYPE_IS_U(pdu) &&
144                            LLC_U_PDU_CMD(pdu) == LLC_2_PDU_CMD_SABME) {
145                         reason = LLC_RESET_REASON_REMOTE;
146                         rc = 0;
147                 }
148                 break;
149         case LLC_CONN_EV_TYPE_ACK_TMR:
150         case LLC_CONN_EV_TYPE_P_TMR:
151         case LLC_CONN_EV_TYPE_REJ_TMR:
152         case LLC_CONN_EV_TYPE_BUSY_TMR:
153                 if (llc->retry_count > llc->n2) {
154                         reason = LLC_RESET_REASON_LOCAL;
155                         rc = 0;
156                 }
157                 break;
158         }
159         if (!rc) {
160                 ev->reason   = reason;
161                 ev->ind_prim = LLC_RESET_PRIM;
162         }
163         return rc;
164 }
165
166 int llc_conn_ac_rst_confirm(struct sock *sk, struct sk_buff *skb)
167 {
168         struct llc_conn_state_ev *ev = llc_conn_ev(skb);
169
170         ev->reason   = 0;
171         ev->cfm_prim = LLC_RESET_PRIM;
172         return 0;
173 }
174
175 int llc_conn_ac_clear_remote_busy_if_f_eq_1(struct sock *sk,
176                                             struct sk_buff *skb)
177 {
178         struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
179
180         if (LLC_PDU_IS_RSP(pdu) &&
181             LLC_PDU_TYPE_IS_I(pdu) &&
182             LLC_I_PF_IS_1(pdu) && llc_sk(sk)->ack_pf)
183                 llc_conn_ac_clear_remote_busy(sk, skb);
184         return 0;
185 }
186
187 int llc_conn_ac_stop_rej_tmr_if_data_flag_eq_2(struct sock *sk,
188                                                struct sk_buff *skb)
189 {
190         struct llc_sock *llc = llc_sk(sk);
191
192         if (llc->data_flag == 2)
193                 del_timer(&llc->rej_sent_timer.timer);
194         return 0;
195 }
196
197 int llc_conn_ac_send_disc_cmd_p_set_x(struct sock *sk, struct sk_buff *skb)
198 {
199         int rc = -ENOBUFS;
200         struct llc_sock *llc = llc_sk(sk);
201         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_U, 0);
202
203         if (nskb) {
204                 struct llc_sap *sap = llc->sap;
205
206                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
207                                     llc->daddr.lsap, LLC_PDU_CMD);
208                 llc_pdu_init_as_disc_cmd(nskb, 1);
209                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
210                 if (unlikely(rc))
211                         goto free;
212                 llc_conn_send_pdu(sk, nskb);
213                 llc_conn_ac_set_p_flag_1(sk, skb);
214         }
215 out:
216         return rc;
217 free:
218         kfree_skb(nskb);
219         goto out;
220 }
221
222 int llc_conn_ac_send_dm_rsp_f_set_p(struct sock *sk, struct sk_buff *skb)
223 {
224         int rc = -ENOBUFS;
225         struct llc_sock *llc = llc_sk(sk);
226         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_U, 0);
227
228         if (nskb) {
229                 struct llc_sap *sap = llc->sap;
230                 u8 f_bit;
231
232                 llc_pdu_decode_pf_bit(skb, &f_bit);
233                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
234                                     llc->daddr.lsap, LLC_PDU_RSP);
235                 llc_pdu_init_as_dm_rsp(nskb, f_bit);
236                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
237                 if (unlikely(rc))
238                         goto free;
239                 llc_conn_send_pdu(sk, nskb);
240         }
241 out:
242         return rc;
243 free:
244         kfree_skb(nskb);
245         goto out;
246 }
247
248 int llc_conn_ac_send_dm_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
249 {
250         int rc = -ENOBUFS;
251         struct llc_sock *llc = llc_sk(sk);
252         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_U, 0);
253
254         if (nskb) {
255                 struct llc_sap *sap = llc->sap;
256
257                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
258                                     llc->daddr.lsap, LLC_PDU_RSP);
259                 llc_pdu_init_as_dm_rsp(nskb, 1);
260                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
261                 if (unlikely(rc))
262                         goto free;
263                 llc_conn_send_pdu(sk, nskb);
264         }
265 out:
266         return rc;
267 free:
268         kfree_skb(nskb);
269         goto out;
270 }
271
272 int llc_conn_ac_send_frmr_rsp_f_set_x(struct sock *sk, struct sk_buff *skb)
273 {
274         u8 f_bit;
275         int rc = -ENOBUFS;
276         struct sk_buff *nskb;
277         struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
278         struct llc_sock *llc = llc_sk(sk);
279
280         llc->rx_pdu_hdr = *((u32 *)pdu);
281         if (LLC_PDU_IS_CMD(pdu))
282                 llc_pdu_decode_pf_bit(skb, &f_bit);
283         else
284                 f_bit = 0;
285         nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_U,
286                                sizeof(struct llc_frmr_info));
287         if (nskb) {
288                 struct llc_sap *sap = llc->sap;
289
290                 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);
295                 if (unlikely(rc))
296                         goto free;
297                 llc_conn_send_pdu(sk, nskb);
298         }
299 out:
300         return rc;
301 free:
302         kfree_skb(nskb);
303         goto out;
304 }
305
306 int llc_conn_ac_resend_frmr_rsp_f_set_0(struct sock *sk, struct sk_buff *skb)
307 {
308         int rc = -ENOBUFS;
309         struct llc_sock *llc = llc_sk(sk);
310         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_U,
311                                                sizeof(struct llc_frmr_info));
312
313         if (nskb) {
314                 struct llc_sap *sap = llc->sap;
315                 struct llc_pdu_sn *pdu = (struct llc_pdu_sn *)&llc->rx_pdu_hdr;
316
317                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
318                                     llc->daddr.lsap, LLC_PDU_RSP);
319                 llc_pdu_init_as_frmr_rsp(nskb, pdu, 0, llc->vS,
320                                          llc->vR, INCORRECT);
321                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
322                 if (unlikely(rc))
323                         goto free;
324                 llc_conn_send_pdu(sk, nskb);
325         }
326 out:
327         return rc;
328 free:
329         kfree_skb(nskb);
330         goto out;
331 }
332
333 int llc_conn_ac_resend_frmr_rsp_f_set_p(struct sock *sk, struct sk_buff *skb)
334 {
335         u8 f_bit;
336         int rc = -ENOBUFS;
337         struct sk_buff *nskb;
338         struct llc_sock *llc = llc_sk(sk);
339
340         llc_pdu_decode_pf_bit(skb, &f_bit);
341         nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_U,
342                                sizeof(struct llc_frmr_info));
343         if (nskb) {
344                 struct llc_sap *sap = llc->sap;
345                 struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
346
347                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
348                                     llc->daddr.lsap, LLC_PDU_RSP);
349                 llc_pdu_init_as_frmr_rsp(nskb, pdu, f_bit, llc->vS,
350                                          llc->vR, INCORRECT);
351                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
352                 if (unlikely(rc))
353                         goto free;
354                 llc_conn_send_pdu(sk, nskb);
355         }
356 out:
357         return rc;
358 free:
359         kfree_skb(nskb);
360         goto out;
361 }
362
363 int llc_conn_ac_send_i_cmd_p_set_1(struct sock *sk, struct sk_buff *skb)
364 {
365         int rc;
366         struct llc_sock *llc = llc_sk(sk);
367         struct llc_sap *sap = llc->sap;
368
369         llc_pdu_header_init(skb, LLC_PDU_TYPE_I, sap->laddr.lsap,
370                             llc->daddr.lsap, LLC_PDU_CMD);
371         llc_pdu_init_as_i_cmd(skb, 1, llc->vS, llc->vR);
372         rc = llc_mac_hdr_init(skb, llc->dev->dev_addr, llc->daddr.mac);
373         if (likely(!rc)) {
374                 llc_conn_send_pdu(sk, skb);
375                 llc_conn_ac_inc_vs_by_1(sk, skb);
376         }
377         return rc;
378 }
379
380 static int llc_conn_ac_send_i_cmd_p_set_0(struct sock *sk, struct sk_buff *skb)
381 {
382         int rc;
383         struct llc_sock *llc = llc_sk(sk);
384         struct llc_sap *sap = llc->sap;
385
386         llc_pdu_header_init(skb, LLC_PDU_TYPE_I, sap->laddr.lsap,
387                             llc->daddr.lsap, LLC_PDU_CMD);
388         llc_pdu_init_as_i_cmd(skb, 0, llc->vS, llc->vR);
389         rc = llc_mac_hdr_init(skb, llc->dev->dev_addr, llc->daddr.mac);
390         if (likely(!rc)) {
391                 llc_conn_send_pdu(sk, skb);
392                 llc_conn_ac_inc_vs_by_1(sk, skb);
393         }
394         return rc;
395 }
396
397 int llc_conn_ac_send_i_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
398 {
399         int rc;
400         struct llc_sock *llc = llc_sk(sk);
401         struct llc_sap *sap = llc->sap;
402
403         llc_pdu_header_init(skb, LLC_PDU_TYPE_I, sap->laddr.lsap,
404                             llc->daddr.lsap, LLC_PDU_CMD);
405         llc_pdu_init_as_i_cmd(skb, 0, llc->vS, llc->vR);
406         rc = llc_mac_hdr_init(skb, llc->dev->dev_addr, llc->daddr.mac);
407         if (likely(!rc)) {
408                 llc_conn_send_pdu(sk, skb);
409                 llc_conn_ac_inc_vs_by_1(sk, skb);
410         }
411         return 0;
412 }
413
414 int llc_conn_ac_resend_i_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
415 {
416         struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
417         u8 nr = LLC_I_GET_NR(pdu);
418
419         llc_conn_resend_i_pdu_as_cmd(sk, nr, 0);
420         return 0;
421 }
422
423 int llc_conn_ac_resend_i_xxx_x_set_0_or_send_rr(struct sock *sk,
424                                                 struct sk_buff *skb)
425 {
426         u8 nr;
427         struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
428         int rc = -ENOBUFS;
429         struct llc_sock *llc = llc_sk(sk);
430         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_U, 0);
431
432         if (nskb) {
433                 struct llc_sap *sap = llc->sap;
434
435                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
436                                     llc->daddr.lsap, LLC_PDU_RSP);
437                 llc_pdu_init_as_rr_rsp(nskb, 0, llc->vR);
438                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
439                 if (likely(!rc))
440                         llc_conn_send_pdu(sk, nskb);
441                 else
442                         kfree_skb(skb);
443         }
444         if (rc) {
445                 nr = LLC_I_GET_NR(pdu);
446                 rc = 0;
447                 llc_conn_resend_i_pdu_as_cmd(sk, nr, 0);
448         }
449         return rc;
450 }
451
452 int llc_conn_ac_resend_i_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
453 {
454         struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
455         u8 nr = LLC_I_GET_NR(pdu);
456
457         llc_conn_resend_i_pdu_as_rsp(sk, nr, 1);
458         return 0;
459 }
460
461 int llc_conn_ac_send_rej_cmd_p_set_1(struct sock *sk, struct sk_buff *skb)
462 {
463         int rc = -ENOBUFS;
464         struct llc_sock *llc = llc_sk(sk);
465         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
466
467         if (nskb) {
468                 struct llc_sap *sap = llc->sap;
469
470                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
471                                     llc->daddr.lsap, LLC_PDU_CMD);
472                 llc_pdu_init_as_rej_cmd(nskb, 1, llc->vR);
473                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
474                 if (unlikely(rc))
475                         goto free;
476                 llc_conn_send_pdu(sk, nskb);
477         }
478 out:
479         return rc;
480 free:
481         kfree_skb(nskb);
482         goto out;
483 }
484
485 int llc_conn_ac_send_rej_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
486 {
487         int rc = -ENOBUFS;
488         struct llc_sock *llc = llc_sk(sk);
489         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
490
491         if (nskb) {
492                 struct llc_sap *sap = llc->sap;
493
494                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
495                                     llc->daddr.lsap, LLC_PDU_RSP);
496                 llc_pdu_init_as_rej_rsp(nskb, 1, llc->vR);
497                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
498                 if (unlikely(rc))
499                         goto free;
500                 llc_conn_send_pdu(sk, nskb);
501         }
502 out:
503         return rc;
504 free:
505         kfree_skb(nskb);
506         goto out;
507 }
508
509 int llc_conn_ac_send_rej_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
510 {
511         int rc = -ENOBUFS;
512         struct llc_sock *llc = llc_sk(sk);
513         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
514
515         if (nskb) {
516                 struct llc_sap *sap = llc->sap;
517
518                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
519                                     llc->daddr.lsap, LLC_PDU_RSP);
520                 llc_pdu_init_as_rej_rsp(nskb, 0, llc->vR);
521                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
522                 if (unlikely(rc))
523                         goto free;
524                 llc_conn_send_pdu(sk, nskb);
525         }
526 out:
527         return rc;
528 free:
529         kfree_skb(nskb);
530         goto out;
531 }
532
533 int llc_conn_ac_send_rnr_cmd_p_set_1(struct sock *sk, struct sk_buff *skb)
534 {
535         int rc = -ENOBUFS;
536         struct llc_sock *llc = llc_sk(sk);
537         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
538
539         if (nskb) {
540                 struct llc_sap *sap = llc->sap;
541
542                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
543                                     llc->daddr.lsap, LLC_PDU_CMD);
544                 llc_pdu_init_as_rnr_cmd(nskb, 1, llc->vR);
545                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
546                 if (unlikely(rc))
547                         goto free;
548                 llc_conn_send_pdu(sk, nskb);
549         }
550 out:
551         return rc;
552 free:
553         kfree_skb(nskb);
554         goto out;
555 }
556
557 int llc_conn_ac_send_rnr_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
558 {
559         int rc = -ENOBUFS;
560         struct llc_sock *llc = llc_sk(sk);
561         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
562
563         if (nskb) {
564                 struct llc_sap *sap = llc->sap;
565
566                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
567                                     llc->daddr.lsap, LLC_PDU_RSP);
568                 llc_pdu_init_as_rnr_rsp(nskb, 1, llc->vR);
569                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
570                 if (unlikely(rc))
571                         goto free;
572                 llc_conn_send_pdu(sk, nskb);
573         }
574 out:
575         return rc;
576 free:
577         kfree_skb(nskb);
578         goto out;
579 }
580
581 int llc_conn_ac_send_rnr_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
582 {
583         int rc = -ENOBUFS;
584         struct llc_sock *llc = llc_sk(sk);
585         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
586
587         if (nskb) {
588                 struct llc_sap *sap = llc->sap;
589
590                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
591                                     llc->daddr.lsap, LLC_PDU_RSP);
592                 llc_pdu_init_as_rnr_rsp(nskb, 0, llc->vR);
593                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
594                 if (unlikely(rc))
595                         goto free;
596                 llc_conn_send_pdu(sk, nskb);
597         }
598 out:
599         return rc;
600 free:
601         kfree_skb(nskb);
602         goto out;
603 }
604
605 int llc_conn_ac_set_remote_busy(struct sock *sk, struct sk_buff *skb)
606 {
607         struct llc_sock *llc = llc_sk(sk);
608
609         if (!llc->remote_busy_flag) {
610                 llc->remote_busy_flag = 1;
611                 mod_timer(&llc->busy_state_timer.timer,
612                          jiffies + llc->busy_state_timer.expire);
613         }
614         return 0;
615 }
616
617 int llc_conn_ac_opt_send_rnr_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
618 {
619         int rc = -ENOBUFS;
620         struct llc_sock *llc = llc_sk(sk);
621         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
622
623         if (nskb) {
624                 struct llc_sap *sap = llc->sap;
625
626                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
627                                     llc->daddr.lsap, LLC_PDU_RSP);
628                 llc_pdu_init_as_rnr_rsp(nskb, 0, llc->vR);
629                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
630                 if (unlikely(rc))
631                         goto free;
632                 llc_conn_send_pdu(sk, nskb);
633         }
634 out:
635         return rc;
636 free:
637         kfree_skb(nskb);
638         goto out;
639 }
640
641 int llc_conn_ac_send_rr_cmd_p_set_1(struct sock *sk, struct sk_buff *skb)
642 {
643         int rc = -ENOBUFS;
644         struct llc_sock *llc = llc_sk(sk);
645         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
646
647         if (nskb) {
648                 struct llc_sap *sap = llc->sap;
649
650                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
651                                     llc->daddr.lsap, LLC_PDU_CMD);
652                 llc_pdu_init_as_rr_cmd(nskb, 1, llc->vR);
653                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
654                 if (unlikely(rc))
655                         goto free;
656                 llc_conn_send_pdu(sk, nskb);
657         }
658 out:
659         return rc;
660 free:
661         kfree_skb(nskb);
662         goto out;
663 }
664
665 int llc_conn_ac_send_rr_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
666 {
667         int rc = -ENOBUFS;
668         struct llc_sock *llc = llc_sk(sk);
669         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
670
671         if (nskb) {
672                 struct llc_sap *sap = llc->sap;
673                 u8 f_bit = 1;
674
675                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
676                                     llc->daddr.lsap, LLC_PDU_RSP);
677                 llc_pdu_init_as_rr_rsp(nskb, f_bit, llc->vR);
678                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
679                 if (unlikely(rc))
680                         goto free;
681                 llc_conn_send_pdu(sk, nskb);
682         }
683 out:
684         return rc;
685 free:
686         kfree_skb(nskb);
687         goto out;
688 }
689
690 int llc_conn_ac_send_ack_rsp_f_set_1(struct sock *sk, struct sk_buff *skb)
691 {
692         int rc = -ENOBUFS;
693         struct llc_sock *llc = llc_sk(sk);
694         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
695
696         if (nskb) {
697                 struct llc_sap *sap = llc->sap;
698
699                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
700                                     llc->daddr.lsap, LLC_PDU_RSP);
701                 llc_pdu_init_as_rr_rsp(nskb, 1, llc->vR);
702                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
703                 if (unlikely(rc))
704                         goto free;
705                 llc_conn_send_pdu(sk, nskb);
706         }
707 out:
708         return rc;
709 free:
710         kfree_skb(nskb);
711         goto out;
712 }
713
714 int llc_conn_ac_send_rr_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
715 {
716         int rc = -ENOBUFS;
717         struct llc_sock *llc = llc_sk(sk);
718         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
719
720         if (nskb) {
721                 struct llc_sap *sap = llc->sap;
722
723                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
724                                     llc->daddr.lsap, LLC_PDU_RSP);
725                 llc_pdu_init_as_rr_rsp(nskb, 0, llc->vR);
726                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
727                 if (unlikely(rc))
728                         goto free;
729                 llc_conn_send_pdu(sk, nskb);
730         }
731 out:
732         return rc;
733 free:
734         kfree_skb(nskb);
735         goto out;
736 }
737
738 int llc_conn_ac_send_ack_xxx_x_set_0(struct sock *sk, struct sk_buff *skb)
739 {
740         int rc = -ENOBUFS;
741         struct llc_sock *llc = llc_sk(sk);
742         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
743
744         if (nskb) {
745                 struct llc_sap *sap = llc->sap;
746
747                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
748                                     llc->daddr.lsap, LLC_PDU_RSP);
749                 llc_pdu_init_as_rr_rsp(nskb, 0, llc->vR);
750                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
751                 if (unlikely(rc))
752                         goto free;
753                 llc_conn_send_pdu(sk, nskb);
754         }
755 out:
756         return rc;
757 free:
758         kfree_skb(nskb);
759         goto out;
760 }
761
762 void llc_conn_set_p_flag(struct sock *sk, u8 value)
763 {
764         int state_changed = llc_sk(sk)->p_flag && !value;
765
766         llc_sk(sk)->p_flag = value;
767
768         if (state_changed)
769                 sk->sk_state_change(sk);
770 }
771
772 int llc_conn_ac_send_sabme_cmd_p_set_x(struct sock *sk, struct sk_buff *skb)
773 {
774         int rc = -ENOBUFS;
775         struct llc_sock *llc = llc_sk(sk);
776         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_U, 0);
777
778         if (nskb) {
779                 struct llc_sap *sap = llc->sap;
780                 u8 *dmac = llc->daddr.mac;
781
782                 if (llc->dev->flags & IFF_LOOPBACK)
783                         dmac = llc->dev->dev_addr;
784                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
785                                     llc->daddr.lsap, LLC_PDU_CMD);
786                 llc_pdu_init_as_sabme_cmd(nskb, 1);
787                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, dmac);
788                 if (unlikely(rc))
789                         goto free;
790                 llc_conn_send_pdu(sk, nskb);
791                 llc_conn_set_p_flag(sk, 1);
792         }
793 out:
794         return rc;
795 free:
796         kfree_skb(nskb);
797         goto out;
798 }
799
800 int llc_conn_ac_send_ua_rsp_f_set_p(struct sock *sk, struct sk_buff *skb)
801 {
802         u8 f_bit;
803         int rc = -ENOBUFS;
804         struct llc_sock *llc = llc_sk(sk);
805         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_U, 0);
806
807         llc_pdu_decode_pf_bit(skb, &f_bit);
808         if (nskb) {
809                 struct llc_sap *sap = llc->sap;
810
811                 nskb->dev = llc->dev;
812                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_U, sap->laddr.lsap,
813                                     llc->daddr.lsap, LLC_PDU_RSP);
814                 llc_pdu_init_as_ua_rsp(nskb, f_bit);
815                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
816                 if (unlikely(rc))
817                         goto free;
818                 llc_conn_send_pdu(sk, nskb);
819         }
820 out:
821         return rc;
822 free:
823         kfree_skb(nskb);
824         goto out;
825 }
826
827 int llc_conn_ac_set_s_flag_0(struct sock *sk, struct sk_buff *skb)
828 {
829         llc_sk(sk)->s_flag = 0;
830         return 0;
831 }
832
833 int llc_conn_ac_set_s_flag_1(struct sock *sk, struct sk_buff *skb)
834 {
835         llc_sk(sk)->s_flag = 1;
836         return 0;
837 }
838
839 int llc_conn_ac_start_p_timer(struct sock *sk, struct sk_buff *skb)
840 {
841         struct llc_sock *llc = llc_sk(sk);
842
843         llc_conn_set_p_flag(sk, 1);
844         mod_timer(&llc->pf_cycle_timer.timer,
845                   jiffies + llc->pf_cycle_timer.expire);
846         return 0;
847 }
848
849 /**
850  *      llc_conn_ac_send_ack_if_needed - check if ack is needed
851  *      @sk: current connection structure
852  *      @skb: current event
853  *
854  *      Checks number of received PDUs which have not been acknowledged, yet,
855  *      If number of them reaches to "npta"(Number of PDUs To Acknowledge) then
856  *      sends an RR response as acknowledgement for them.  Returns 0 for
857  *      success, 1 otherwise.
858  */
859 int llc_conn_ac_send_ack_if_needed(struct sock *sk, struct sk_buff *skb)
860 {
861         u8 pf_bit;
862         struct llc_sock *llc = llc_sk(sk);
863
864         llc_pdu_decode_pf_bit(skb, &pf_bit);
865         llc->ack_pf |= pf_bit & 1;
866         if (!llc->ack_must_be_send) {
867                 llc->first_pdu_Ns = llc->vR;
868                 llc->ack_must_be_send = 1;
869                 llc->ack_pf = pf_bit & 1;
870         }
871         if (((llc->vR - llc->first_pdu_Ns + 1 + LLC_2_SEQ_NBR_MODULO)
872                         % LLC_2_SEQ_NBR_MODULO) >= llc->npta) {
873                 llc_conn_ac_send_rr_rsp_f_set_ackpf(sk, skb);
874                 llc->ack_must_be_send   = 0;
875                 llc->ack_pf             = 0;
876                 llc_conn_ac_inc_npta_value(sk, skb);
877         }
878         return 0;
879 }
880
881 /**
882  *      llc_conn_ac_rst_sendack_flag - resets ack_must_be_send flag
883  *      @sk: current connection structure
884  *      @skb: current event
885  *
886  *      This action resets ack_must_be_send flag of given connection, this flag
887  *      indicates if there is any PDU which has not been acknowledged yet.
888  *      Returns 0 for success, 1 otherwise.
889  */
890 int llc_conn_ac_rst_sendack_flag(struct sock *sk, struct sk_buff *skb)
891 {
892         llc_sk(sk)->ack_must_be_send = llc_sk(sk)->ack_pf = 0;
893         return 0;
894 }
895
896 /**
897  *      llc_conn_ac_send_i_rsp_f_set_ackpf - acknowledge received PDUs
898  *      @sk: current connection structure
899  *      @skb: current event
900  *
901  *      Sends an I response PDU with f-bit set to ack_pf flag as acknowledge to
902  *      all received PDUs which have not been acknowledged, yet. ack_pf flag is
903  *      set to one if one PDU with p-bit set to one is received.  Returns 0 for
904  *      success, 1 otherwise.
905  */
906 static int llc_conn_ac_send_i_rsp_f_set_ackpf(struct sock *sk,
907                                               struct sk_buff *skb)
908 {
909         int rc;
910         struct llc_sock *llc = llc_sk(sk);
911         struct llc_sap *sap = llc->sap;
912
913         llc_pdu_header_init(skb, LLC_PDU_TYPE_I, sap->laddr.lsap,
914                             llc->daddr.lsap, LLC_PDU_RSP);
915         llc_pdu_init_as_i_cmd(skb, llc->ack_pf, llc->vS, llc->vR);
916         rc = llc_mac_hdr_init(skb, llc->dev->dev_addr, llc->daddr.mac);
917         if (likely(!rc)) {
918                 llc_conn_send_pdu(sk, skb);
919                 llc_conn_ac_inc_vs_by_1(sk, skb);
920         }
921         return rc;
922 }
923
924 /**
925  *      llc_conn_ac_send_i_as_ack - sends an I-format PDU to acknowledge rx PDUs
926  *      @sk: current connection structure.
927  *      @skb: current event.
928  *
929  *      This action sends an I-format PDU as acknowledge to received PDUs which
930  *      have not been acknowledged, yet, if there is any. By using of this
931  *      action number of acknowledgements decreases, this technic is called
932  *      piggy backing. Returns 0 for success, 1 otherwise.
933  */
934 int llc_conn_ac_send_i_as_ack(struct sock *sk, struct sk_buff *skb)
935 {
936         struct llc_sock *llc = llc_sk(sk);
937
938         if (llc->ack_must_be_send) {
939                 llc_conn_ac_send_i_rsp_f_set_ackpf(sk, skb);
940                 llc->ack_must_be_send = 0 ;
941                 llc->ack_pf = 0;
942         } else
943                 llc_conn_ac_send_i_cmd_p_set_0(sk, skb);
944         return 0;
945 }
946
947 /**
948  *      llc_conn_ac_send_rr_rsp_f_set_ackpf - ack all rx PDUs not yet acked
949  *      @sk: current connection structure.
950  *      @skb: current event.
951  *
952  *      This action sends an RR response with f-bit set to ack_pf flag as
953  *      acknowledge to all received PDUs which have not been acknowledged, yet,
954  *      if there is any. ack_pf flag indicates if a PDU has been received with
955  *      p-bit set to one. Returns 0 for success, 1 otherwise.
956  */
957 static int llc_conn_ac_send_rr_rsp_f_set_ackpf(struct sock *sk,
958                                                struct sk_buff *skb)
959 {
960         int rc = -ENOBUFS;
961         struct llc_sock *llc = llc_sk(sk);
962         struct sk_buff *nskb = llc_alloc_frame(sk, llc->dev, LLC_PDU_TYPE_S, 0);
963
964         if (nskb) {
965                 struct llc_sap *sap = llc->sap;
966
967                 llc_pdu_header_init(nskb, LLC_PDU_TYPE_S, sap->laddr.lsap,
968                                     llc->daddr.lsap, LLC_PDU_RSP);
969                 llc_pdu_init_as_rr_rsp(nskb, llc->ack_pf, llc->vR);
970                 rc = llc_mac_hdr_init(nskb, llc->dev->dev_addr, llc->daddr.mac);
971                 if (unlikely(rc))
972                         goto free;
973                 llc_conn_send_pdu(sk, nskb);
974         }
975 out:
976         return rc;
977 free:
978         kfree_skb(nskb);
979         goto out;
980 }
981
982 /**
983  *      llc_conn_ac_inc_npta_value - tries to make value of npta greater
984  *      @sk: current connection structure.
985  *      @skb: current event.
986  *
987  *      After "inc_cntr" times calling of this action, "npta" increase by one.
988  *      this action tries to make vale of "npta" greater as possible; number of
989  *      acknowledgements decreases by increasing of "npta". Returns 0 for
990  *      success, 1 otherwise.
991  */
992 static int llc_conn_ac_inc_npta_value(struct sock *sk, struct sk_buff *skb)
993 {
994         struct llc_sock *llc = llc_sk(sk);
995
996         if (!llc->inc_cntr) {
997                 llc->dec_step = 0;
998                 llc->dec_cntr = llc->inc_cntr = 2;
999                 ++llc->npta;
1000                 if (llc->npta > (u8) ~LLC_2_SEQ_NBR_MODULO)
1001                         llc->npta = (u8) ~LLC_2_SEQ_NBR_MODULO;
1002         } else
1003                 --llc->inc_cntr;
1004         return 0;
1005 }
1006
1007 /**
1008  *      llc_conn_ac_adjust_npta_by_rr - decreases "npta" by one
1009  *      @sk: current connection structure.
1010  *      @skb: current event.
1011  *
1012  *      After receiving "dec_cntr" times RR command, this action decreases
1013  *      "npta" by one. Returns 0 for success, 1 otherwise.
1014  */
1015 int llc_conn_ac_adjust_npta_by_rr(struct sock *sk, struct sk_buff *skb)
1016 {
1017         struct llc_sock *llc = llc_sk(sk);
1018
1019         if (!llc->connect_step && !llc->remote_busy_flag) {
1020                 if (!llc->dec_step) {
1021                         if (!llc->dec_cntr) {
1022                                 llc->inc_cntr = llc->dec_cntr = 2;
1023                                 if (llc->npta > 0)
1024                                         llc->npta = llc->npta - 1;
1025                         } else
1026                                 llc->dec_cntr -=1;
1027                 }
1028         } else
1029                 llc->connect_step = 0 ;
1030         return 0;
1031 }
1032
1033 /**
1034  *      llc_conn_ac_adjust_npta_by_rnr - decreases "npta" by one
1035  *      @sk: current connection structure.
1036  *      @skb: current event.
1037  *
1038  *      After receiving "dec_cntr" times RNR command, this action decreases
1039  *      "npta" by one. Returns 0 for success, 1 otherwise.
1040  */
1041 int llc_conn_ac_adjust_npta_by_rnr(struct sock *sk, struct sk_buff *skb)
1042 {
1043         struct llc_sock *llc = llc_sk(sk);
1044
1045         if (llc->remote_busy_flag)
1046                 if (!llc->dec_step) {
1047                         if (!llc->dec_cntr) {
1048                                 llc->inc_cntr = llc->dec_cntr = 2;
1049                                 if (llc->npta > 0)
1050                                         --llc->npta;
1051                         } else
1052                                 --llc->dec_cntr;
1053                 }
1054         return 0;
1055 }
1056
1057 /**
1058  *      llc_conn_ac_dec_tx_win_size - decreases tx window size
1059  *      @sk: current connection structure.
1060  *      @skb: current event.
1061  *
1062  *      After receiving of a REJ command or response, transmit window size is
1063  *      decreased by number of PDUs which are outstanding yet. Returns 0 for
1064  *      success, 1 otherwise.
1065  */
1066 int llc_conn_ac_dec_tx_win_size(struct sock *sk, struct sk_buff *skb)
1067 {
1068         struct llc_sock *llc = llc_sk(sk);
1069         u8 unacked_pdu = skb_queue_len(&llc->pdu_unack_q);
1070
1071         if (llc->k - unacked_pdu < 1)
1072                 llc->k = 1;
1073         else
1074                 llc->k -= unacked_pdu;
1075         return 0;
1076 }
1077
1078 /**
1079  *      llc_conn_ac_inc_tx_win_size - tx window size is inc by 1
1080  *      @sk: current connection structure.
1081  *      @skb: current event.
1082  *
1083  *      After receiving an RR response with f-bit set to one, transmit window
1084  *      size is increased by one. Returns 0 for success, 1 otherwise.
1085  */
1086 int llc_conn_ac_inc_tx_win_size(struct sock *sk, struct sk_buff *skb)
1087 {
1088         struct llc_sock *llc = llc_sk(sk);
1089
1090         llc->k += 1;
1091         if (llc->k > (u8) ~LLC_2_SEQ_NBR_MODULO)
1092                 llc->k = (u8) ~LLC_2_SEQ_NBR_MODULO;
1093         return 0;
1094 }
1095
1096 int llc_conn_ac_stop_all_timers(struct sock *sk, struct sk_buff *skb)
1097 {
1098         struct llc_sock *llc = llc_sk(sk);
1099
1100         del_timer(&llc->pf_cycle_timer.timer);
1101         del_timer(&llc->ack_timer.timer);
1102         del_timer(&llc->rej_sent_timer.timer);
1103         del_timer(&llc->busy_state_timer.timer);
1104         llc->ack_must_be_send = 0;
1105         llc->ack_pf = 0;
1106         return 0;
1107 }
1108
1109 int llc_conn_ac_stop_other_timers(struct sock *sk, struct sk_buff *skb)
1110 {
1111         struct llc_sock *llc = llc_sk(sk);
1112
1113         del_timer(&llc->rej_sent_timer.timer);
1114         del_timer(&llc->pf_cycle_timer.timer);
1115         del_timer(&llc->busy_state_timer.timer);
1116         llc->ack_must_be_send = 0;
1117         llc->ack_pf = 0;
1118         return 0;
1119 }
1120
1121 int llc_conn_ac_start_ack_timer(struct sock *sk, struct sk_buff *skb)
1122 {
1123         struct llc_sock *llc = llc_sk(sk);
1124
1125         mod_timer(&llc->ack_timer.timer, jiffies + llc->ack_timer.expire);
1126         return 0;
1127 }
1128
1129 int llc_conn_ac_start_rej_timer(struct sock *sk, struct sk_buff *skb)
1130 {
1131         struct llc_sock *llc = llc_sk(sk);
1132
1133         mod_timer(&llc->rej_sent_timer.timer,
1134                   jiffies + llc->rej_sent_timer.expire);
1135         return 0;
1136 }
1137
1138 int llc_conn_ac_start_ack_tmr_if_not_running(struct sock *sk,
1139                                              struct sk_buff *skb)
1140 {
1141         struct llc_sock *llc = llc_sk(sk);
1142
1143         if (!timer_pending(&llc->ack_timer.timer))
1144                 mod_timer(&llc->ack_timer.timer,
1145                           jiffies + llc->ack_timer.expire);
1146         return 0;
1147 }
1148
1149 int llc_conn_ac_stop_ack_timer(struct sock *sk, struct sk_buff *skb)
1150 {
1151         del_timer(&llc_sk(sk)->ack_timer.timer);
1152         return 0;
1153 }
1154
1155 int llc_conn_ac_stop_p_timer(struct sock *sk, struct sk_buff *skb)
1156 {
1157         struct llc_sock *llc = llc_sk(sk);
1158
1159         del_timer(&llc->pf_cycle_timer.timer);
1160         llc_conn_set_p_flag(sk, 0);
1161         return 0;
1162 }
1163
1164 int llc_conn_ac_stop_rej_timer(struct sock *sk, struct sk_buff *skb)
1165 {
1166         del_timer(&llc_sk(sk)->rej_sent_timer.timer);
1167         return 0;
1168 }
1169
1170 int llc_conn_ac_upd_nr_received(struct sock *sk, struct sk_buff *skb)
1171 {
1172         int acked;
1173         u16 unacked = 0;
1174         struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
1175         struct llc_sock *llc = llc_sk(sk);
1176
1177         llc->last_nr = PDU_SUPV_GET_Nr(pdu);
1178         acked = llc_conn_remove_acked_pdus(sk, llc->last_nr, &unacked);
1179         /* On loopback we don't queue I frames in unack_pdu_q queue. */
1180         if (acked > 0 || (llc->dev->flags & IFF_LOOPBACK)) {
1181                 llc->retry_count = 0;
1182                 del_timer(&llc->ack_timer.timer);
1183                 if (llc->failed_data_req) {
1184                         /* already, we did not accept data from upper layer
1185                          * (tx_window full or unacceptable state). Now, we
1186                          * can send data and must inform to upper layer.
1187                          */
1188                         llc->failed_data_req = 0;
1189                         llc_conn_ac_data_confirm(sk, skb);
1190                 }
1191                 if (unacked)
1192                         mod_timer(&llc->ack_timer.timer,
1193                                   jiffies + llc->ack_timer.expire);
1194         } else if (llc->failed_data_req) {
1195                 u8 f_bit;
1196
1197                 llc_pdu_decode_pf_bit(skb, &f_bit);
1198                 if (f_bit == 1) {
1199                         llc->failed_data_req = 0;
1200                         llc_conn_ac_data_confirm(sk, skb);
1201                 }
1202         }
1203         return 0;
1204 }
1205
1206 int llc_conn_ac_upd_p_flag(struct sock *sk, struct sk_buff *skb)
1207 {
1208         struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
1209
1210         if (LLC_PDU_IS_RSP(pdu)) {
1211                 u8 f_bit;
1212
1213                 llc_pdu_decode_pf_bit(skb, &f_bit);
1214                 if (f_bit) {
1215                         llc_conn_set_p_flag(sk, 0);
1216                         llc_conn_ac_stop_p_timer(sk, skb);
1217                 }
1218         }
1219         return 0;
1220 }
1221
1222 int llc_conn_ac_set_data_flag_2(struct sock *sk, struct sk_buff *skb)
1223 {
1224         llc_sk(sk)->data_flag = 2;
1225         return 0;
1226 }
1227
1228 int llc_conn_ac_set_data_flag_0(struct sock *sk, struct sk_buff *skb)
1229 {
1230         llc_sk(sk)->data_flag = 0;
1231         return 0;
1232 }
1233
1234 int llc_conn_ac_set_data_flag_1(struct sock *sk, struct sk_buff *skb)
1235 {
1236         llc_sk(sk)->data_flag = 1;
1237         return 0;
1238 }
1239
1240 int llc_conn_ac_set_data_flag_1_if_data_flag_eq_0(struct sock *sk,
1241                                                   struct sk_buff *skb)
1242 {
1243         if (!llc_sk(sk)->data_flag)
1244                 llc_sk(sk)->data_flag = 1;
1245         return 0;
1246 }
1247
1248 int llc_conn_ac_set_p_flag_0(struct sock *sk, struct sk_buff *skb)
1249 {
1250         llc_conn_set_p_flag(sk, 0);
1251         return 0;
1252 }
1253
1254 static int llc_conn_ac_set_p_flag_1(struct sock *sk, struct sk_buff *skb)
1255 {
1256         llc_conn_set_p_flag(sk, 1);
1257         return 0;
1258 }
1259
1260 int llc_conn_ac_set_remote_busy_0(struct sock *sk, struct sk_buff *skb)
1261 {
1262         llc_sk(sk)->remote_busy_flag = 0;
1263         return 0;
1264 }
1265
1266 int llc_conn_ac_set_cause_flag_0(struct sock *sk, struct sk_buff *skb)
1267 {
1268         llc_sk(sk)->cause_flag = 0;
1269         return 0;
1270 }
1271
1272 int llc_conn_ac_set_cause_flag_1(struct sock *sk, struct sk_buff *skb)
1273 {
1274         llc_sk(sk)->cause_flag = 1;
1275         return 0;
1276 }
1277
1278 int llc_conn_ac_set_retry_cnt_0(struct sock *sk, struct sk_buff *skb)
1279 {
1280         llc_sk(sk)->retry_count = 0;
1281         return 0;
1282 }
1283
1284 int llc_conn_ac_inc_retry_cnt_by_1(struct sock *sk, struct sk_buff *skb)
1285 {
1286         llc_sk(sk)->retry_count++;
1287         return 0;
1288 }
1289
1290 int llc_conn_ac_set_vr_0(struct sock *sk, struct sk_buff *skb)
1291 {
1292         llc_sk(sk)->vR = 0;
1293         return 0;
1294 }
1295
1296 int llc_conn_ac_inc_vr_by_1(struct sock *sk, struct sk_buff *skb)
1297 {
1298         llc_sk(sk)->vR = PDU_GET_NEXT_Vr(llc_sk(sk)->vR);
1299         return 0;
1300 }
1301
1302 int llc_conn_ac_set_vs_0(struct sock *sk, struct sk_buff *skb)
1303 {
1304         llc_sk(sk)->vS = 0;
1305         return 0;
1306 }
1307
1308 int llc_conn_ac_set_vs_nr(struct sock *sk, struct sk_buff *skb)
1309 {
1310         llc_sk(sk)->vS = llc_sk(sk)->last_nr;
1311         return 0;
1312 }
1313
1314 static int llc_conn_ac_inc_vs_by_1(struct sock *sk, struct sk_buff *skb)
1315 {
1316         llc_sk(sk)->vS = (llc_sk(sk)->vS + 1) % LLC_2_SEQ_NBR_MODULO;
1317         return 0;
1318 }
1319
1320 static void llc_conn_tmr_common_cb(unsigned long timeout_data, u8 type)
1321 {
1322         struct sock *sk = (struct sock *)timeout_data;
1323         struct sk_buff *skb = alloc_skb(0, GFP_ATOMIC);
1324
1325         bh_lock_sock(sk);
1326         if (skb) {
1327                 struct llc_conn_state_ev *ev = llc_conn_ev(skb);
1328
1329                 skb_set_owner_r(skb, sk);
1330                 ev->type = type;
1331                 llc_process_tmr_ev(sk, skb);
1332         }
1333         bh_unlock_sock(sk);
1334 }
1335
1336 void llc_conn_pf_cycle_tmr_cb(unsigned long timeout_data)
1337 {
1338         llc_conn_tmr_common_cb(timeout_data, LLC_CONN_EV_TYPE_P_TMR);
1339 }
1340
1341 void llc_conn_busy_tmr_cb(unsigned long timeout_data)
1342 {
1343         llc_conn_tmr_common_cb(timeout_data, LLC_CONN_EV_TYPE_BUSY_TMR);
1344 }
1345
1346 void llc_conn_ack_tmr_cb(unsigned long timeout_data)
1347 {
1348         llc_conn_tmr_common_cb(timeout_data, LLC_CONN_EV_TYPE_ACK_TMR);
1349 }
1350
1351 void llc_conn_rej_tmr_cb(unsigned long timeout_data)
1352 {
1353         llc_conn_tmr_common_cb(timeout_data, LLC_CONN_EV_TYPE_REJ_TMR);
1354 }
1355
1356 int llc_conn_ac_rst_vs(struct sock *sk, struct sk_buff *skb)
1357 {
1358         llc_sk(sk)->X = llc_sk(sk)->vS;
1359         llc_conn_ac_set_vs_nr(sk, skb);
1360         return 0;
1361 }
1362
1363 int llc_conn_ac_upd_vs(struct sock *sk, struct sk_buff *skb)
1364 {
1365         struct llc_pdu_sn *pdu = llc_pdu_sn_hdr(skb);
1366         u8 nr = PDU_SUPV_GET_Nr(pdu);
1367
1368         if (llc_circular_between(llc_sk(sk)->vS, nr, llc_sk(sk)->X))
1369                 llc_conn_ac_set_vs_nr(sk, skb);
1370         return 0;
1371 }
1372
1373 /*
1374  * Non-standard actions; these not contained in IEEE specification; for
1375  * our own usage
1376  */
1377 /**
1378  *      llc_conn_disc - removes connection from SAP list and frees it
1379  *      @sk: closed connection
1380  *      @skb: occurred event
1381  */
1382 int llc_conn_disc(struct sock *sk, struct sk_buff *skb)
1383 {
1384         /* FIXME: this thing seems to want to die */
1385         return 0;
1386 }
1387
1388 /**
1389  *      llc_conn_reset - resets connection
1390  *      @sk : reseting connection.
1391  *      @skb: occurred event.
1392  *
1393  *      Stop all timers, empty all queues and reset all flags.
1394  */
1395 int llc_conn_reset(struct sock *sk, struct sk_buff *skb)
1396 {
1397         llc_sk_reset(sk);
1398         return 0;
1399 }
1400
1401 /**
1402  *      llc_circular_between - designates that b is between a and c or not
1403  *      @a: lower bound
1404  *      @b: element to see if is between a and b
1405  *      @c: upper bound
1406  *
1407  *      This function designates that b is between a and c or not (for example,
1408  *      0 is between 127 and 1). Returns 1 if b is between a and c, 0
1409  *      otherwise.
1410  */
1411 u8 llc_circular_between(u8 a, u8 b, u8 c)
1412 {
1413         b = b - a;
1414         c = c - a;
1415         return b <= c;
1416 }
1417
1418 /**
1419  *      llc_process_tmr_ev - timer backend
1420  *      @sk: active connection
1421  *      @skb: occurred event
1422  *
1423  *      This function is called from timer callback functions. When connection
1424  *      is busy (during sending a data frame) timer expiration event must be
1425  *      queued. Otherwise this event can be sent to connection state machine.
1426  *      Queued events will process by llc_backlog_rcv function after sending
1427  *      data frame.
1428  */
1429 static void llc_process_tmr_ev(struct sock *sk, struct sk_buff *skb)
1430 {
1431         if (llc_sk(sk)->state == LLC_CONN_OUT_OF_SVC) {
1432                 printk(KERN_WARNING "%s: timer called on closed connection\n",
1433                        __func__);
1434                 kfree_skb(skb);
1435         } else {
1436                 if (!sock_owned_by_user(sk))
1437                         llc_conn_state_process(sk, skb);
1438                 else {
1439                         llc_set_backlog_type(skb, LLC_EVENT);
1440                         sk_add_backlog(sk, skb);
1441                 }
1442         }
1443 }