Lines Matching refs:l2
101 struct layer2 *l2 = fi->userdata; in l2m_debug() local
114 mISDNDevName4ch(&l2->ch), l2->sapi, l2->tei, &vaf); in l2m_debug()
120 l2headersize(struct layer2 *l2, int ui) in l2headersize() argument
122 return ((test_bit(FLG_MOD128, &l2->flag) && (!ui)) ? 2 : 1) + in l2headersize()
123 (test_bit(FLG_LAPD, &l2->flag) ? 2 : 1); in l2headersize()
127 l2addrsize(struct layer2 *l2) in l2addrsize() argument
129 return test_bit(FLG_LAPD, &l2->flag) ? 2 : 1; in l2addrsize()
133 l2_newid(struct layer2 *l2) in l2_newid() argument
137 id = l2->next_id++; in l2_newid()
139 l2->next_id = 1; in l2_newid()
141 id |= l2->tei << 8; in l2_newid()
142 id |= l2->sapi; in l2_newid()
147 l2up(struct layer2 *l2, u_int prim, struct sk_buff *skb) in l2up() argument
151 if (!l2->up) in l2up()
154 mISDN_HEAD_ID(skb) = (l2->ch.nr << 16) | l2->ch.addr; in l2up()
155 err = l2->up->send(l2->up, skb); in l2up()
158 mISDNDevName4ch(&l2->ch), err); in l2up()
164 l2up_create(struct layer2 *l2, u_int prim, int len, void *arg) in l2up_create() argument
170 if (!l2->up) in l2up_create()
177 hh->id = (l2->ch.nr << 16) | l2->ch.addr; in l2up_create()
180 err = l2->up->send(l2->up, skb); in l2up_create()
183 mISDNDevName4ch(&l2->ch), err); in l2up_create()
189 l2down_skb(struct layer2 *l2, struct sk_buff *skb) { in l2down_skb() argument
192 ret = l2->ch.recv(l2->ch.peer, skb); in l2down_skb()
195 mISDNDevName4ch(&l2->ch), ret); in l2down_skb()
200 l2down_raw(struct layer2 *l2, struct sk_buff *skb) in l2down_raw() argument
205 if (test_and_set_bit(FLG_L1_NOTREADY, &l2->flag)) { in l2down_raw()
206 skb_queue_tail(&l2->down_queue, skb); in l2down_raw()
209 l2->down_id = mISDN_HEAD_ID(skb); in l2down_raw()
211 return l2down_skb(l2, skb); in l2down_raw()
215 l2down(struct layer2 *l2, u_int prim, u_int id, struct sk_buff *skb) in l2down() argument
221 return l2down_raw(l2, skb); in l2down()
225 l2down_create(struct layer2 *l2, u_int prim, u_int id, int len, void *arg) in l2down_create() argument
239 err = l2down_raw(l2, skb); in l2down_create()
246 ph_data_confirm(struct layer2 *l2, struct mISDNhead *hh, struct sk_buff *skb) { in ph_data_confirm() argument
250 if (test_bit(FLG_L1_NOTREADY, &l2->flag)) { in ph_data_confirm()
251 if (hh->id == l2->down_id) { in ph_data_confirm()
252 nskb = skb_dequeue(&l2->down_queue); in ph_data_confirm()
254 l2->down_id = mISDN_HEAD_ID(nskb); in ph_data_confirm()
255 if (l2down_skb(l2, nskb)) { in ph_data_confirm()
257 l2->down_id = MISDN_ID_NONE; in ph_data_confirm()
260 l2->down_id = MISDN_ID_NONE; in ph_data_confirm()
265 if (l2->down_id == MISDN_ID_NONE) { in ph_data_confirm()
266 test_and_clear_bit(FLG_L1_NOTREADY, &l2->flag); in ph_data_confirm()
267 mISDN_FsmEvent(&l2->l2m, EV_L2_ACK_PULL, NULL); in ph_data_confirm()
271 if (!test_and_set_bit(FLG_L1_NOTREADY, &l2->flag)) { in ph_data_confirm()
272 nskb = skb_dequeue(&l2->down_queue); in ph_data_confirm()
274 l2->down_id = mISDN_HEAD_ID(nskb); in ph_data_confirm()
275 if (l2down_skb(l2, nskb)) { in ph_data_confirm()
277 l2->down_id = MISDN_ID_NONE; in ph_data_confirm()
278 test_and_clear_bit(FLG_L1_NOTREADY, &l2->flag); in ph_data_confirm()
281 test_and_clear_bit(FLG_L1_NOTREADY, &l2->flag); in ph_data_confirm()
289 struct layer2 *l2 = fi->userdata; in l2_timeout() local
296 mISDNDevName4ch(&l2->ch), l2->sapi, l2->tei, in l2_timeout()
297 l2->ch.nr, event == EV_L2_T200 ? "T200" : "T203"); in l2_timeout()
302 hh->id = l2->ch.nr; in l2_timeout()
305 mISDNDevName4ch(&l2->ch), l2->sapi, l2->tei, in l2_timeout()
306 l2->ch.nr, event == EV_L2_T200 ? "T200" : "T203"); in l2_timeout()
307 if (l2->ch.st) in l2_timeout()
308 l2->ch.st->own.recv(&l2->ch.st->own, skb); in l2_timeout()
312 l2mgr(struct layer2 *l2, u_int prim, void *arg) { in l2mgr() argument
316 mISDNDevName4ch(&l2->ch), l2->id, prim, (char)c); in l2mgr()
317 if (test_bit(FLG_LAPD, &l2->flag) && in l2mgr()
318 !test_bit(FLG_FIXED_TEI, &l2->flag)) { in l2mgr()
324 l2_tei(l2, prim, (u_long)arg); in l2mgr()
332 set_peer_busy(struct layer2 *l2) { in set_peer_busy() argument
333 test_and_set_bit(FLG_PEER_BUSY, &l2->flag); in set_peer_busy()
334 if (skb_queue_len(&l2->i_queue) || skb_queue_len(&l2->ui_queue)) in set_peer_busy()
335 test_and_set_bit(FLG_L2BLOCK, &l2->flag); in set_peer_busy()
339 clear_peer_busy(struct layer2 *l2) { in clear_peer_busy() argument
340 if (test_and_clear_bit(FLG_PEER_BUSY, &l2->flag)) in clear_peer_busy()
341 test_and_clear_bit(FLG_L2BLOCK, &l2->flag); in clear_peer_busy()
345 InitWin(struct layer2 *l2) in InitWin() argument
350 l2->windowar[i] = NULL; in InitWin()
354 freewin(struct layer2 *l2) in freewin() argument
359 if (l2->windowar[i]) { in freewin()
361 dev_kfree_skb(l2->windowar[i]); in freewin()
362 l2->windowar[i] = NULL; in freewin()
369 ReleaseWin(struct layer2 *l2) in ReleaseWin() argument
371 int cnt = freewin(l2); in ReleaseWin()
379 cansend(struct layer2 *l2) in cansend() argument
383 if (test_bit(FLG_MOD128, &l2->flag)) in cansend()
384 p1 = (l2->vs - l2->va) % 128; in cansend()
386 p1 = (l2->vs - l2->va) % 8; in cansend()
387 return (p1 < l2->window) && !test_bit(FLG_PEER_BUSY, &l2->flag); in cansend()
391 clear_exception(struct layer2 *l2) in clear_exception() argument
393 test_and_clear_bit(FLG_ACK_PEND, &l2->flag); in clear_exception()
394 test_and_clear_bit(FLG_REJEXC, &l2->flag); in clear_exception()
395 test_and_clear_bit(FLG_OWN_BUSY, &l2->flag); in clear_exception()
396 clear_peer_busy(l2); in clear_exception()
400 sethdraddr(struct layer2 *l2, u_char *header, int rsp) in sethdraddr() argument
405 if (test_bit(FLG_LAPD, &l2->flag)) { in sethdraddr()
406 if (test_bit(FLG_LAPD_NET, &l2->flag)) in sethdraddr()
408 *ptr++ = (l2->sapi << 2) | (crbit ? 2 : 0); in sethdraddr()
409 *ptr++ = (l2->tei << 1) | 1; in sethdraddr()
412 if (test_bit(FLG_ORIG, &l2->flag)) in sethdraddr()
415 *ptr++ = l2->addr.B; in sethdraddr()
417 *ptr++ = l2->addr.A; in sethdraddr()
423 enqueue_super(struct layer2 *l2, struct sk_buff *skb) in enqueue_super() argument
425 if (l2down(l2, PH_DATA_REQ, l2_newid(l2), skb)) in enqueue_super()
430 enqueue_ui(struct layer2 *l2, struct sk_buff *skb) in enqueue_ui() argument
432 if (l2->tm) in enqueue_ui()
433 l2_tei(l2, MDL_STATUS_UI_IND, 0); in enqueue_ui()
434 if (l2down(l2, PH_DATA_REQ, l2_newid(l2), skb)) in enqueue_ui()
463 IsRR(u_char *data, struct layer2 *l2) in IsRR() argument
465 if (test_bit(FLG_MOD128, &l2->flag)) in IsRR()
472 IsSFrame(u_char *data, struct layer2 *l2) in IsSFrame() argument
476 if (!test_bit(FLG_MOD128, &l2->flag)) in IsSFrame()
482 IsSABME(u_char *data, struct layer2 *l2) in IsSABME() argument
486 return test_bit(FLG_MOD128, &l2->flag) ? d == SABME : d == SABM; in IsSABME()
490 IsREJ(u_char *data, struct layer2 *l2) in IsREJ() argument
492 return test_bit(FLG_MOD128, &l2->flag) ? in IsREJ()
503 IsRNR(u_char *data, struct layer2 *l2) in IsRNR() argument
505 return test_bit(FLG_MOD128, &l2->flag) ? in IsRNR()
510 iframe_error(struct layer2 *l2, struct sk_buff *skb) in iframe_error() argument
515 i = l2addrsize(l2) + (test_bit(FLG_MOD128, &l2->flag) ? 2 : 1); in iframe_error()
516 if (test_bit(FLG_ORIG, &l2->flag)) in iframe_error()
522 if ((skb->len - i) > l2->maxlen) in iframe_error()
528 super_error(struct layer2 *l2, struct sk_buff *skb) in super_error() argument
530 if (skb->len != l2addrsize(l2) + in super_error()
531 (test_bit(FLG_MOD128, &l2->flag) ? 2 : 1)) in super_error()
537 unnum_error(struct layer2 *l2, struct sk_buff *skb, int wantrsp) in unnum_error() argument
540 if (test_bit(FLG_ORIG, &l2->flag)) in unnum_error()
544 if (skb->len != l2addrsize(l2) + 1) in unnum_error()
550 UI_error(struct layer2 *l2, struct sk_buff *skb) in UI_error() argument
553 if (test_bit(FLG_ORIG, &l2->flag)) in UI_error()
557 if (skb->len > l2->maxlen + l2addrsize(l2) + 1) in UI_error()
563 FRMR_error(struct layer2 *l2, struct sk_buff *skb) in FRMR_error() argument
565 u_int headers = l2addrsize(l2) + 1; in FRMR_error()
569 if (test_bit(FLG_ORIG, &l2->flag)) in FRMR_error()
573 if (test_bit(FLG_MOD128, &l2->flag)) { in FRMR_error()
577 l2m_debug(&l2->l2m, in FRMR_error()
584 l2m_debug(&l2->l2m, in FRMR_error()
592 legalnr(struct layer2 *l2, unsigned int nr) in legalnr() argument
594 if (test_bit(FLG_MOD128, &l2->flag)) in legalnr()
595 return ((nr - l2->va) % 128) <= ((l2->vs - l2->va) % 128); in legalnr()
597 return ((nr - l2->va) % 8) <= ((l2->vs - l2->va) % 8); in legalnr()
601 setva(struct layer2 *l2, unsigned int nr) in setva() argument
605 while (l2->va != nr) { in setva()
606 l2->va++; in setva()
607 if (test_bit(FLG_MOD128, &l2->flag)) in setva()
608 l2->va %= 128; in setva()
610 l2->va %= 8; in setva()
611 if (l2->windowar[l2->sow]) { in setva()
612 skb_trim(l2->windowar[l2->sow], 0); in setva()
613 skb_queue_tail(&l2->tmp_queue, l2->windowar[l2->sow]); in setva()
614 l2->windowar[l2->sow] = NULL; in setva()
616 l2->sow = (l2->sow + 1) % l2->window; in setva()
618 skb = skb_dequeue(&l2->tmp_queue); in setva()
621 skb = skb_dequeue(&l2->tmp_queue); in setva()
626 send_uframe(struct layer2 *l2, struct sk_buff *skb, u_char cmd, u_char cr) in send_uframe() argument
631 i = sethdraddr(l2, tmp, cr); in send_uframe()
639 mISDNDevName4ch(&l2->ch), __func__); in send_uframe()
644 enqueue_super(l2, skb); in send_uframe()
649 get_PollFlag(struct layer2 *l2, struct sk_buff *skb) in get_PollFlag() argument
651 return skb->data[l2addrsize(l2)] & 0x10; in get_PollFlag()
655 get_PollFlagFree(struct layer2 *l2, struct sk_buff *skb) in get_PollFlagFree() argument
659 PF = get_PollFlag(l2, skb); in get_PollFlagFree()
665 start_t200(struct layer2 *l2, int i) in start_t200() argument
667 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, i); in start_t200()
668 test_and_set_bit(FLG_T200_RUN, &l2->flag); in start_t200()
672 restart_t200(struct layer2 *l2, int i) in restart_t200() argument
674 mISDN_FsmRestartTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, i); in restart_t200()
675 test_and_set_bit(FLG_T200_RUN, &l2->flag); in restart_t200()
679 stop_t200(struct layer2 *l2, int i) in stop_t200() argument
681 if (test_and_clear_bit(FLG_T200_RUN, &l2->flag)) in stop_t200()
682 mISDN_FsmDelTimer(&l2->t200, i); in stop_t200()
686 st5_dl_release_l2l3(struct layer2 *l2) in st5_dl_release_l2l3() argument
690 if (test_and_clear_bit(FLG_PEND_REL, &l2->flag)) in st5_dl_release_l2l3()
694 l2up_create(l2, pr, 0, NULL); in st5_dl_release_l2l3()
698 lapb_dl_release_l2l3(struct layer2 *l2, int f) in lapb_dl_release_l2l3() argument
700 if (test_bit(FLG_LAPB, &l2->flag)) in lapb_dl_release_l2l3()
701 l2down_create(l2, PH_DEACTIVATE_REQ, l2_newid(l2), 0, NULL); in lapb_dl_release_l2l3()
702 l2up_create(l2, f, 0, NULL); in lapb_dl_release_l2l3()
708 struct layer2 *l2 = fi->userdata; in establishlink() local
711 clear_exception(l2); in establishlink()
712 l2->rc = 0; in establishlink()
713 cmd = (test_bit(FLG_MOD128, &l2->flag) ? SABME : SABM) | 0x10; in establishlink()
714 send_uframe(l2, NULL, cmd, CMD); in establishlink()
715 mISDN_FsmDelTimer(&l2->t203, 1); in establishlink()
716 restart_t200(l2, 1); in establishlink()
717 test_and_clear_bit(FLG_PEND_REL, &l2->flag); in establishlink()
718 freewin(l2); in establishlink()
726 struct layer2 *l2 = fi->userdata; in l2_mdl_error_ua() local
728 if (get_PollFlagFree(l2, skb)) in l2_mdl_error_ua()
729 l2mgr(l2, MDL_ERROR_IND, (void *) 'C'); in l2_mdl_error_ua()
731 l2mgr(l2, MDL_ERROR_IND, (void *) 'D'); in l2_mdl_error_ua()
739 struct layer2 *l2 = fi->userdata; in l2_mdl_error_dm() local
741 if (get_PollFlagFree(l2, skb)) in l2_mdl_error_dm()
742 l2mgr(l2, MDL_ERROR_IND, (void *) 'B'); in l2_mdl_error_dm()
744 l2mgr(l2, MDL_ERROR_IND, (void *) 'E'); in l2_mdl_error_dm()
746 test_and_clear_bit(FLG_L3_INIT, &l2->flag); in l2_mdl_error_dm()
754 struct layer2 *l2 = fi->userdata; in l2_st8_mdl_error_dm() local
756 if (get_PollFlagFree(l2, skb)) in l2_st8_mdl_error_dm()
757 l2mgr(l2, MDL_ERROR_IND, (void *) 'B'); in l2_st8_mdl_error_dm()
759 l2mgr(l2, MDL_ERROR_IND, (void *) 'E'); in l2_st8_mdl_error_dm()
761 test_and_clear_bit(FLG_L3_INIT, &l2->flag); in l2_st8_mdl_error_dm()
774 struct layer2 *l2 = fi->userdata; in l2_mdl_assign() local
778 l2_tei(l2, MDL_ASSIGN_IND, 0); in l2_mdl_assign()
784 struct layer2 *l2 = fi->userdata; in l2_queue_ui_assign() local
787 skb_queue_tail(&l2->ui_queue, skb); in l2_queue_ui_assign()
789 l2_tei(l2, MDL_ASSIGN_IND, 0); in l2_queue_ui_assign()
795 struct layer2 *l2 = fi->userdata; in l2_queue_ui() local
798 skb_queue_tail(&l2->ui_queue, skb); in l2_queue_ui()
802 tx_ui(struct layer2 *l2) in tx_ui() argument
808 i = sethdraddr(l2, header, CMD); in tx_ui()
809 if (test_bit(FLG_LAPD_NET, &l2->flag)) in tx_ui()
812 while ((skb = skb_dequeue(&l2->ui_queue))) { in tx_ui()
814 enqueue_ui(l2, skb); in tx_ui()
821 struct layer2 *l2 = fi->userdata; in l2_send_ui() local
824 skb_queue_tail(&l2->ui_queue, skb); in l2_send_ui()
825 tx_ui(l2); in l2_send_ui()
831 struct layer2 *l2 = fi->userdata; in l2_got_ui() local
834 skb_pull(skb, l2headersize(l2, 1)); in l2_got_ui()
839 if (l2->tm) in l2_got_ui()
840 l2_tei(l2, MDL_STATUS_UI_IND, 0); in l2_got_ui()
841 l2up(l2, DL_UNITDATA_IND, skb); in l2_got_ui()
848 struct layer2 *l2 = fi->userdata; in l2_establish() local
851 test_and_set_bit(FLG_L3_INIT, &l2->flag); in l2_establish()
859 struct layer2 *l2 = fi->userdata; in l2_discard_i_setl3() local
861 skb_queue_purge(&l2->i_queue); in l2_discard_i_setl3()
862 test_and_set_bit(FLG_L3_INIT, &l2->flag); in l2_discard_i_setl3()
863 test_and_clear_bit(FLG_PEND_REL, &l2->flag); in l2_discard_i_setl3()
871 struct layer2 *l2 = fi->userdata; in l2_l3_reestablish() local
873 skb_queue_purge(&l2->i_queue); in l2_l3_reestablish()
875 test_and_set_bit(FLG_L3_INIT, &l2->flag); in l2_l3_reestablish()
882 struct layer2 *l2 = fi->userdata; in l2_release() local
886 l2up(l2, DL_RELEASE_CNF, skb); in l2_release()
893 struct layer2 *l2 = fi->userdata; in l2_pend_rel() local
895 test_and_set_bit(FLG_PEND_REL, &l2->flag); in l2_pend_rel()
902 struct layer2 *l2 = fi->userdata; in l2_disconnect() local
905 skb_queue_purge(&l2->i_queue); in l2_disconnect()
906 freewin(l2); in l2_disconnect()
908 l2->rc = 0; in l2_disconnect()
909 send_uframe(l2, NULL, DISC | 0x10, CMD); in l2_disconnect()
910 mISDN_FsmDelTimer(&l2->t203, 1); in l2_disconnect()
911 restart_t200(l2, 2); in l2_disconnect()
919 struct layer2 *l2 = fi->userdata; in l2_start_multi() local
922 l2->vs = 0; in l2_start_multi()
923 l2->va = 0; in l2_start_multi()
924 l2->vr = 0; in l2_start_multi()
925 l2->sow = 0; in l2_start_multi()
926 clear_exception(l2); in l2_start_multi()
927 send_uframe(l2, NULL, UA | get_PollFlag(l2, skb), RSP); in l2_start_multi()
929 mISDN_FsmAddTimer(&l2->t203, l2->T203, EV_L2_T203, NULL, 3); in l2_start_multi()
931 l2up(l2, DL_ESTABLISH_IND, skb); in l2_start_multi()
932 if (l2->tm) in l2_start_multi()
933 l2_tei(l2, MDL_STATUS_UP_IND, 0); in l2_start_multi()
939 struct layer2 *l2 = fi->userdata; in l2_send_UA() local
942 send_uframe(l2, skb, UA | get_PollFlag(l2, skb), RSP); in l2_send_UA()
948 struct layer2 *l2 = fi->userdata; in l2_send_DM() local
951 send_uframe(l2, skb, DM | get_PollFlag(l2, skb), RSP); in l2_send_DM()
957 struct layer2 *l2 = fi->userdata; in l2_restart_multi() local
961 send_uframe(l2, skb, UA | get_PollFlag(l2, skb), RSP); in l2_restart_multi()
963 l2mgr(l2, MDL_ERROR_IND, (void *) 'F'); in l2_restart_multi()
965 if (l2->vs != l2->va) { in l2_restart_multi()
966 skb_queue_purge(&l2->i_queue); in l2_restart_multi()
970 clear_exception(l2); in l2_restart_multi()
971 l2->vs = 0; in l2_restart_multi()
972 l2->va = 0; in l2_restart_multi()
973 l2->vr = 0; in l2_restart_multi()
974 l2->sow = 0; in l2_restart_multi()
976 stop_t200(l2, 3); in l2_restart_multi()
977 mISDN_FsmRestartTimer(&l2->t203, l2->T203, EV_L2_T203, NULL, 3); in l2_restart_multi()
980 l2up_create(l2, DL_ESTABLISH_IND, 0, NULL); in l2_restart_multi()
985 if (skb_queue_len(&l2->i_queue) && cansend(l2)) in l2_restart_multi()
992 struct layer2 *l2 = fi->userdata; in l2_stop_multi() local
996 mISDN_FsmDelTimer(&l2->t203, 3); in l2_stop_multi()
997 stop_t200(l2, 4); in l2_stop_multi()
999 send_uframe(l2, skb, UA | get_PollFlag(l2, skb), RSP); in l2_stop_multi()
1000 skb_queue_purge(&l2->i_queue); in l2_stop_multi()
1001 freewin(l2); in l2_stop_multi()
1002 lapb_dl_release_l2l3(l2, DL_RELEASE_IND); in l2_stop_multi()
1003 if (l2->tm) in l2_stop_multi()
1004 l2_tei(l2, MDL_STATUS_DOWN_IND, 0); in l2_stop_multi()
1010 struct layer2 *l2 = fi->userdata; in l2_connected() local
1014 if (!get_PollFlag(l2, skb)) { in l2_connected()
1019 if (test_and_clear_bit(FLG_PEND_REL, &l2->flag)) in l2_connected()
1021 if (test_and_clear_bit(FLG_L3_INIT, &l2->flag)) { in l2_connected()
1023 } else if (l2->vs != l2->va) { in l2_connected()
1024 skb_queue_purge(&l2->i_queue); in l2_connected()
1027 stop_t200(l2, 5); in l2_connected()
1028 l2->vr = 0; in l2_connected()
1029 l2->vs = 0; in l2_connected()
1030 l2->va = 0; in l2_connected()
1031 l2->sow = 0; in l2_connected()
1033 mISDN_FsmAddTimer(&l2->t203, l2->T203, EV_L2_T203, NULL, 4); in l2_connected()
1035 l2up_create(l2, pr, 0, NULL); in l2_connected()
1037 if (skb_queue_len(&l2->i_queue) && cansend(l2)) in l2_connected()
1040 if (l2->tm) in l2_connected()
1041 l2_tei(l2, MDL_STATUS_UP_IND, 0); in l2_connected()
1047 struct layer2 *l2 = fi->userdata; in l2_released() local
1050 if (!get_PollFlag(l2, skb)) { in l2_released()
1055 stop_t200(l2, 6); in l2_released()
1056 lapb_dl_release_l2l3(l2, DL_RELEASE_CNF); in l2_released()
1058 if (l2->tm) in l2_released()
1059 l2_tei(l2, MDL_STATUS_DOWN_IND, 0); in l2_released()
1065 struct layer2 *l2 = fi->userdata; in l2_reestablish() local
1068 if (!get_PollFlagFree(l2, skb)) { in l2_reestablish()
1070 test_and_set_bit(FLG_L3_INIT, &l2->flag); in l2_reestablish()
1077 struct layer2 *l2 = fi->userdata; in l2_st5_dm_release() local
1080 if (get_PollFlagFree(l2, skb)) { in l2_st5_dm_release()
1081 stop_t200(l2, 7); in l2_st5_dm_release()
1082 if (!test_bit(FLG_L3_INIT, &l2->flag)) in l2_st5_dm_release()
1083 skb_queue_purge(&l2->i_queue); in l2_st5_dm_release()
1084 if (test_bit(FLG_LAPB, &l2->flag)) in l2_st5_dm_release()
1085 l2down_create(l2, PH_DEACTIVATE_REQ, in l2_st5_dm_release()
1086 l2_newid(l2), 0, NULL); in l2_st5_dm_release()
1087 st5_dl_release_l2l3(l2); in l2_st5_dm_release()
1089 if (l2->tm) in l2_st5_dm_release()
1090 l2_tei(l2, MDL_STATUS_DOWN_IND, 0); in l2_st5_dm_release()
1097 struct layer2 *l2 = fi->userdata; in l2_st6_dm_release() local
1100 if (get_PollFlagFree(l2, skb)) { in l2_st6_dm_release()
1101 stop_t200(l2, 8); in l2_st6_dm_release()
1102 lapb_dl_release_l2l3(l2, DL_RELEASE_CNF); in l2_st6_dm_release()
1104 if (l2->tm) in l2_st6_dm_release()
1105 l2_tei(l2, MDL_STATUS_DOWN_IND, 0); in l2_st6_dm_release()
1110 enquiry_cr(struct layer2 *l2, u_char typ, u_char cr, u_char pf) in enquiry_cr() argument
1116 i = sethdraddr(l2, tmp, cr); in enquiry_cr()
1117 if (test_bit(FLG_MOD128, &l2->flag)) { in enquiry_cr()
1119 tmp[i++] = (l2->vr << 1) | (pf ? 1 : 0); in enquiry_cr()
1121 tmp[i++] = (l2->vr << 5) | typ | (pf ? 0x10 : 0); in enquiry_cr()
1125 mISDNDevName4ch(&l2->ch), __func__); in enquiry_cr()
1129 enqueue_super(l2, skb); in enquiry_cr()
1133 enquiry_response(struct layer2 *l2) in enquiry_response() argument
1135 if (test_bit(FLG_OWN_BUSY, &l2->flag)) in enquiry_response()
1136 enquiry_cr(l2, RNR, RSP, 1); in enquiry_response()
1138 enquiry_cr(l2, RR, RSP, 1); in enquiry_response()
1139 test_and_clear_bit(FLG_ACK_PEND, &l2->flag); in enquiry_response()
1143 transmit_enquiry(struct layer2 *l2) in transmit_enquiry() argument
1145 if (test_bit(FLG_OWN_BUSY, &l2->flag)) in transmit_enquiry()
1146 enquiry_cr(l2, RNR, CMD, 1); in transmit_enquiry()
1148 enquiry_cr(l2, RR, CMD, 1); in transmit_enquiry()
1149 test_and_clear_bit(FLG_ACK_PEND, &l2->flag); in transmit_enquiry()
1150 start_t200(l2, 9); in transmit_enquiry()
1157 struct layer2 *l2 = fi->userdata; in nrerrorrecovery() local
1159 l2mgr(l2, MDL_ERROR_IND, (void *) 'J'); in nrerrorrecovery()
1161 test_and_clear_bit(FLG_L3_INIT, &l2->flag); in nrerrorrecovery()
1165 invoke_retransmission(struct layer2 *l2, unsigned int nr) in invoke_retransmission() argument
1169 if (l2->vs != nr) { in invoke_retransmission()
1170 while (l2->vs != nr) { in invoke_retransmission()
1171 (l2->vs)--; in invoke_retransmission()
1172 if (test_bit(FLG_MOD128, &l2->flag)) { in invoke_retransmission()
1173 l2->vs %= 128; in invoke_retransmission()
1174 p1 = (l2->vs - l2->va) % 128; in invoke_retransmission()
1176 l2->vs %= 8; in invoke_retransmission()
1177 p1 = (l2->vs - l2->va) % 8; in invoke_retransmission()
1179 p1 = (p1 + l2->sow) % l2->window; in invoke_retransmission()
1180 if (l2->windowar[p1]) in invoke_retransmission()
1181 skb_queue_head(&l2->i_queue, l2->windowar[p1]); in invoke_retransmission()
1185 mISDNDevName4ch(&l2->ch), p1); in invoke_retransmission()
1186 l2->windowar[p1] = NULL; in invoke_retransmission()
1188 mISDN_FsmEvent(&l2->l2m, EV_L2_ACK_PULL, NULL); in invoke_retransmission()
1195 struct layer2 *l2 = fi->userdata; in l2_st7_got_super() local
1201 if (test_bit(FLG_ORIG, &l2->flag)) in l2_st7_got_super()
1204 skb_pull(skb, l2addrsize(l2)); in l2_st7_got_super()
1205 if (IsRNR(skb->data, l2)) { in l2_st7_got_super()
1206 set_peer_busy(l2); in l2_st7_got_super()
1209 clear_peer_busy(l2); in l2_st7_got_super()
1210 if (IsREJ(skb->data, l2)) in l2_st7_got_super()
1213 if (test_bit(FLG_MOD128, &l2->flag)) { in l2_st7_got_super()
1224 l2mgr(l2, MDL_ERROR_IND, (void *) 'A'); in l2_st7_got_super()
1226 enquiry_response(l2); in l2_st7_got_super()
1228 if (legalnr(l2, nr)) { in l2_st7_got_super()
1230 setva(l2, nr); in l2_st7_got_super()
1231 invoke_retransmission(l2, nr); in l2_st7_got_super()
1232 stop_t200(l2, 10); in l2_st7_got_super()
1233 if (mISDN_FsmAddTimer(&l2->t203, l2->T203, in l2_st7_got_super()
1235 l2m_debug(&l2->l2m, "Restart T203 ST7 REJ"); in l2_st7_got_super()
1236 } else if ((nr == l2->vs) && (typ == RR)) { in l2_st7_got_super()
1237 setva(l2, nr); in l2_st7_got_super()
1238 stop_t200(l2, 11); in l2_st7_got_super()
1239 mISDN_FsmRestartTimer(&l2->t203, l2->T203, in l2_st7_got_super()
1241 } else if ((l2->va != nr) || (typ == RNR)) { in l2_st7_got_super()
1242 setva(l2, nr); in l2_st7_got_super()
1244 mISDN_FsmDelTimer(&l2->t203, 9); in l2_st7_got_super()
1245 restart_t200(l2, 12); in l2_st7_got_super()
1247 if (skb_queue_len(&l2->i_queue) && (typ == RR)) in l2_st7_got_super()
1256 struct layer2 *l2 = fi->userdata; in l2_feed_i_if_reest() local
1259 if (!test_bit(FLG_L3_INIT, &l2->flag)) in l2_feed_i_if_reest()
1260 skb_queue_tail(&l2->i_queue, skb); in l2_feed_i_if_reest()
1268 struct layer2 *l2 = fi->userdata; in l2_feed_i_pull() local
1271 skb_queue_tail(&l2->i_queue, skb); in l2_feed_i_pull()
1278 struct layer2 *l2 = fi->userdata; in l2_feed_iqueue() local
1281 skb_queue_tail(&l2->i_queue, skb); in l2_feed_iqueue()
1287 struct layer2 *l2 = fi->userdata; in l2_got_iframe() local
1292 i = l2addrsize(l2); in l2_got_iframe()
1293 if (test_bit(FLG_MOD128, &l2->flag)) { in l2_got_iframe()
1302 if (test_bit(FLG_OWN_BUSY, &l2->flag)) { in l2_got_iframe()
1305 enquiry_response(l2); in l2_got_iframe()
1307 if (l2->vr == ns) { in l2_got_iframe()
1308 l2->vr++; in l2_got_iframe()
1309 if (test_bit(FLG_MOD128, &l2->flag)) in l2_got_iframe()
1310 l2->vr %= 128; in l2_got_iframe()
1312 l2->vr %= 8; in l2_got_iframe()
1313 test_and_clear_bit(FLG_REJEXC, &l2->flag); in l2_got_iframe()
1315 enquiry_response(l2); in l2_got_iframe()
1317 test_and_set_bit(FLG_ACK_PEND, &l2->flag); in l2_got_iframe()
1318 skb_pull(skb, l2headersize(l2, 0)); in l2_got_iframe()
1319 l2up(l2, DL_DATA_IND, skb); in l2_got_iframe()
1323 if (test_and_set_bit(FLG_REJEXC, &l2->flag)) { in l2_got_iframe()
1325 enquiry_response(l2); in l2_got_iframe()
1327 enquiry_cr(l2, REJ, RSP, PollFlag); in l2_got_iframe()
1328 test_and_clear_bit(FLG_ACK_PEND, &l2->flag); in l2_got_iframe()
1332 if (legalnr(l2, nr)) { in l2_got_iframe()
1333 if (!test_bit(FLG_PEER_BUSY, &l2->flag) && in l2_got_iframe()
1335 if (nr == l2->vs) { in l2_got_iframe()
1336 stop_t200(l2, 13); in l2_got_iframe()
1337 mISDN_FsmRestartTimer(&l2->t203, l2->T203, in l2_got_iframe()
1339 } else if (nr != l2->va) in l2_got_iframe()
1340 restart_t200(l2, 14); in l2_got_iframe()
1342 setva(l2, nr); in l2_got_iframe()
1347 if (skb_queue_len(&l2->i_queue) && (fi->state == ST_L2_7)) in l2_got_iframe()
1349 if (test_and_clear_bit(FLG_ACK_PEND, &l2->flag)) in l2_got_iframe()
1350 enquiry_cr(l2, RR, RSP, 0); in l2_got_iframe()
1356 struct layer2 *l2 = fi->userdata; in l2_got_tei() local
1359 l2->tei = (signed char)(long)arg; in l2_got_tei()
1360 set_channel_address(&l2->ch, l2->sapi, l2->tei); in l2_got_tei()
1362 l2up_create(l2, DL_INFORMATION_IND, sizeof(info), &info); in l2_got_tei()
1365 test_and_set_bit(FLG_L3_INIT, &l2->flag); in l2_got_tei()
1368 if (skb_queue_len(&l2->ui_queue)) in l2_got_tei()
1369 tx_ui(l2); in l2_got_tei()
1375 struct layer2 *l2 = fi->userdata; in l2_st5_tout_200() local
1377 if (test_bit(FLG_LAPD, &l2->flag) && in l2_st5_tout_200()
1378 test_bit(FLG_DCHAN_BUSY, &l2->flag)) { in l2_st5_tout_200()
1379 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 9); in l2_st5_tout_200()
1380 } else if (l2->rc == l2->N200) { in l2_st5_tout_200()
1382 test_and_clear_bit(FLG_T200_RUN, &l2->flag); in l2_st5_tout_200()
1383 skb_queue_purge(&l2->i_queue); in l2_st5_tout_200()
1384 l2mgr(l2, MDL_ERROR_IND, (void *) 'G'); in l2_st5_tout_200()
1385 if (test_bit(FLG_LAPB, &l2->flag)) in l2_st5_tout_200()
1386 l2down_create(l2, PH_DEACTIVATE_REQ, in l2_st5_tout_200()
1387 l2_newid(l2), 0, NULL); in l2_st5_tout_200()
1388 st5_dl_release_l2l3(l2); in l2_st5_tout_200()
1389 if (l2->tm) in l2_st5_tout_200()
1390 l2_tei(l2, MDL_STATUS_DOWN_IND, 0); in l2_st5_tout_200()
1392 l2->rc++; in l2_st5_tout_200()
1393 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 9); in l2_st5_tout_200()
1394 send_uframe(l2, NULL, (test_bit(FLG_MOD128, &l2->flag) ? in l2_st5_tout_200()
1402 struct layer2 *l2 = fi->userdata; in l2_st6_tout_200() local
1404 if (test_bit(FLG_LAPD, &l2->flag) && in l2_st6_tout_200()
1405 test_bit(FLG_DCHAN_BUSY, &l2->flag)) { in l2_st6_tout_200()
1406 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 9); in l2_st6_tout_200()
1407 } else if (l2->rc == l2->N200) { in l2_st6_tout_200()
1409 test_and_clear_bit(FLG_T200_RUN, &l2->flag); in l2_st6_tout_200()
1410 l2mgr(l2, MDL_ERROR_IND, (void *) 'H'); in l2_st6_tout_200()
1411 lapb_dl_release_l2l3(l2, DL_RELEASE_CNF); in l2_st6_tout_200()
1412 if (l2->tm) in l2_st6_tout_200()
1413 l2_tei(l2, MDL_STATUS_DOWN_IND, 0); in l2_st6_tout_200()
1415 l2->rc++; in l2_st6_tout_200()
1416 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, in l2_st6_tout_200()
1418 send_uframe(l2, NULL, DISC | 0x10, CMD); in l2_st6_tout_200()
1425 struct layer2 *l2 = fi->userdata; in l2_st7_tout_200() local
1427 if (test_bit(FLG_LAPD, &l2->flag) && in l2_st7_tout_200()
1428 test_bit(FLG_DCHAN_BUSY, &l2->flag)) { in l2_st7_tout_200()
1429 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 9); in l2_st7_tout_200()
1432 test_and_clear_bit(FLG_T200_RUN, &l2->flag); in l2_st7_tout_200()
1433 l2->rc = 0; in l2_st7_tout_200()
1435 transmit_enquiry(l2); in l2_st7_tout_200()
1436 l2->rc++; in l2_st7_tout_200()
1442 struct layer2 *l2 = fi->userdata; in l2_st8_tout_200() local
1444 if (test_bit(FLG_LAPD, &l2->flag) && in l2_st8_tout_200()
1445 test_bit(FLG_DCHAN_BUSY, &l2->flag)) { in l2_st8_tout_200()
1446 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 9); in l2_st8_tout_200()
1449 test_and_clear_bit(FLG_T200_RUN, &l2->flag); in l2_st8_tout_200()
1450 if (l2->rc == l2->N200) { in l2_st8_tout_200()
1451 l2mgr(l2, MDL_ERROR_IND, (void *) 'I'); in l2_st8_tout_200()
1453 test_and_clear_bit(FLG_L3_INIT, &l2->flag); in l2_st8_tout_200()
1455 transmit_enquiry(l2); in l2_st8_tout_200()
1456 l2->rc++; in l2_st8_tout_200()
1463 struct layer2 *l2 = fi->userdata; in l2_st7_tout_203() local
1465 if (test_bit(FLG_LAPD, &l2->flag) && in l2_st7_tout_203()
1466 test_bit(FLG_DCHAN_BUSY, &l2->flag)) { in l2_st7_tout_203()
1467 mISDN_FsmAddTimer(&l2->t203, l2->T203, EV_L2_T203, NULL, 9); in l2_st7_tout_203()
1471 transmit_enquiry(l2); in l2_st7_tout_203()
1472 l2->rc = 0; in l2_st7_tout_203()
1478 struct layer2 *l2 = fi->userdata; in l2_pull_iqueue() local
1483 if (!cansend(l2)) in l2_pull_iqueue()
1486 skb = skb_dequeue(&l2->i_queue); in l2_pull_iqueue()
1489 i = sethdraddr(l2, header, CMD); in l2_pull_iqueue()
1490 if (test_bit(FLG_MOD128, &l2->flag)) { in l2_pull_iqueue()
1491 header[i++] = l2->vs << 1; in l2_pull_iqueue()
1492 header[i++] = l2->vr << 1; in l2_pull_iqueue()
1494 header[i++] = (l2->vr << 5) | (l2->vs << 1); in l2_pull_iqueue()
1498 mISDNDevName4ch(&l2->ch), i); in l2_pull_iqueue()
1499 skb_queue_head(&l2->i_queue, skb); in l2_pull_iqueue()
1502 if (test_bit(FLG_MOD128, &l2->flag)) { in l2_pull_iqueue()
1503 p1 = (l2->vs - l2->va) % 128; in l2_pull_iqueue()
1504 l2->vs = (l2->vs + 1) % 128; in l2_pull_iqueue()
1506 p1 = (l2->vs - l2->va) % 8; in l2_pull_iqueue()
1507 l2->vs = (l2->vs + 1) % 8; in l2_pull_iqueue()
1509 p1 = (p1 + l2->sow) % l2->window; in l2_pull_iqueue()
1510 if (l2->windowar[p1]) { in l2_pull_iqueue()
1512 mISDNDevName4ch(&l2->ch), p1); in l2_pull_iqueue()
1513 dev_kfree_skb(l2->windowar[p1]); in l2_pull_iqueue()
1515 l2->windowar[p1] = skb; in l2_pull_iqueue()
1517 l2down(l2, PH_DATA_REQ, l2_newid(l2), nskb); in l2_pull_iqueue()
1518 test_and_clear_bit(FLG_ACK_PEND, &l2->flag); in l2_pull_iqueue()
1519 if (!test_and_set_bit(FLG_T200_RUN, &l2->flag)) { in l2_pull_iqueue()
1520 mISDN_FsmDelTimer(&l2->t203, 13); in l2_pull_iqueue()
1521 mISDN_FsmAddTimer(&l2->t200, l2->T200, EV_L2_T200, NULL, 11); in l2_pull_iqueue()
1528 struct layer2 *l2 = fi->userdata; in l2_st8_got_super() local
1534 if (test_bit(FLG_ORIG, &l2->flag)) in l2_st8_got_super()
1537 skb_pull(skb, l2addrsize(l2)); in l2_st8_got_super()
1539 if (IsRNR(skb->data, l2)) { in l2_st8_got_super()
1540 set_peer_busy(l2); in l2_st8_got_super()
1543 clear_peer_busy(l2); in l2_st8_got_super()
1545 if (test_bit(FLG_MOD128, &l2->flag)) { in l2_st8_got_super()
1554 if (legalnr(l2, nr)) { in l2_st8_got_super()
1556 restart_t200(l2, 15); in l2_st8_got_super()
1558 stop_t200(l2, 16); in l2_st8_got_super()
1559 mISDN_FsmAddTimer(&l2->t203, l2->T203, in l2_st8_got_super()
1561 setva(l2, nr); in l2_st8_got_super()
1563 invoke_retransmission(l2, nr); in l2_st8_got_super()
1565 if (skb_queue_len(&l2->i_queue) && cansend(l2)) in l2_st8_got_super()
1571 enquiry_response(l2); in l2_st8_got_super()
1572 if (legalnr(l2, nr)) in l2_st8_got_super()
1573 setva(l2, nr); in l2_st8_got_super()
1582 struct layer2 *l2 = fi->userdata; in l2_got_FRMR() local
1585 skb_pull(skb, l2addrsize(l2) + 1); in l2_got_FRMR()
1589 l2mgr(l2, MDL_ERROR_IND, (void *) 'K'); in l2_got_FRMR()
1591 test_and_clear_bit(FLG_L3_INIT, &l2->flag); in l2_got_FRMR()
1599 struct layer2 *l2 = fi->userdata; in l2_st24_tei_remove() local
1601 skb_queue_purge(&l2->ui_queue); in l2_st24_tei_remove()
1602 l2->tei = GROUP_TEI; in l2_st24_tei_remove()
1609 struct layer2 *l2 = fi->userdata; in l2_st3_tei_remove() local
1611 skb_queue_purge(&l2->ui_queue); in l2_st3_tei_remove()
1612 l2->tei = GROUP_TEI; in l2_st3_tei_remove()
1613 l2up_create(l2, DL_RELEASE_IND, 0, NULL); in l2_st3_tei_remove()
1620 struct layer2 *l2 = fi->userdata; in l2_st5_tei_remove() local
1622 skb_queue_purge(&l2->i_queue); in l2_st5_tei_remove()
1623 skb_queue_purge(&l2->ui_queue); in l2_st5_tei_remove()
1624 freewin(l2); in l2_st5_tei_remove()
1625 l2->tei = GROUP_TEI; in l2_st5_tei_remove()
1626 stop_t200(l2, 17); in l2_st5_tei_remove()
1627 st5_dl_release_l2l3(l2); in l2_st5_tei_remove()
1634 struct layer2 *l2 = fi->userdata; in l2_st6_tei_remove() local
1636 skb_queue_purge(&l2->ui_queue); in l2_st6_tei_remove()
1637 l2->tei = GROUP_TEI; in l2_st6_tei_remove()
1638 stop_t200(l2, 18); in l2_st6_tei_remove()
1639 l2up_create(l2, DL_RELEASE_IND, 0, NULL); in l2_st6_tei_remove()
1646 struct layer2 *l2 = fi->userdata; in l2_tei_remove() local
1648 skb_queue_purge(&l2->i_queue); in l2_tei_remove()
1649 skb_queue_purge(&l2->ui_queue); in l2_tei_remove()
1650 freewin(l2); in l2_tei_remove()
1651 l2->tei = GROUP_TEI; in l2_tei_remove()
1652 stop_t200(l2, 17); in l2_tei_remove()
1653 mISDN_FsmDelTimer(&l2->t203, 19); in l2_tei_remove()
1654 l2up_create(l2, DL_RELEASE_IND, 0, NULL); in l2_tei_remove()
1665 struct layer2 *l2 = fi->userdata; in l2_st14_persistent_da() local
1668 skb_queue_purge(&l2->i_queue); in l2_st14_persistent_da()
1669 skb_queue_purge(&l2->ui_queue); in l2_st14_persistent_da()
1670 if (test_and_clear_bit(FLG_ESTAB_PEND, &l2->flag)) in l2_st14_persistent_da()
1671 l2up(l2, DL_RELEASE_IND, skb); in l2_st14_persistent_da()
1679 struct layer2 *l2 = fi->userdata; in l2_st5_persistent_da() local
1682 skb_queue_purge(&l2->i_queue); in l2_st5_persistent_da()
1683 skb_queue_purge(&l2->ui_queue); in l2_st5_persistent_da()
1684 freewin(l2); in l2_st5_persistent_da()
1685 stop_t200(l2, 19); in l2_st5_persistent_da()
1686 st5_dl_release_l2l3(l2); in l2_st5_persistent_da()
1688 if (l2->tm) in l2_st5_persistent_da()
1689 l2_tei(l2, MDL_STATUS_DOWN_IND, 0); in l2_st5_persistent_da()
1696 struct layer2 *l2 = fi->userdata; in l2_st6_persistent_da() local
1699 skb_queue_purge(&l2->ui_queue); in l2_st6_persistent_da()
1700 stop_t200(l2, 20); in l2_st6_persistent_da()
1701 l2up(l2, DL_RELEASE_CNF, skb); in l2_st6_persistent_da()
1703 if (l2->tm) in l2_st6_persistent_da()
1704 l2_tei(l2, MDL_STATUS_DOWN_IND, 0); in l2_st6_persistent_da()
1710 struct layer2 *l2 = fi->userdata; in l2_persistent_da() local
1713 skb_queue_purge(&l2->i_queue); in l2_persistent_da()
1714 skb_queue_purge(&l2->ui_queue); in l2_persistent_da()
1715 freewin(l2); in l2_persistent_da()
1716 stop_t200(l2, 19); in l2_persistent_da()
1717 mISDN_FsmDelTimer(&l2->t203, 19); in l2_persistent_da()
1718 l2up(l2, DL_RELEASE_IND, skb); in l2_persistent_da()
1720 if (l2->tm) in l2_persistent_da()
1721 l2_tei(l2, MDL_STATUS_DOWN_IND, 0); in l2_persistent_da()
1727 struct layer2 *l2 = fi->userdata; in l2_set_own_busy() local
1730 if (!test_and_set_bit(FLG_OWN_BUSY, &l2->flag)) { in l2_set_own_busy()
1731 enquiry_cr(l2, RNR, RSP, 0); in l2_set_own_busy()
1732 test_and_clear_bit(FLG_ACK_PEND, &l2->flag); in l2_set_own_busy()
1741 struct layer2 *l2 = fi->userdata; in l2_clear_own_busy() local
1744 if (!test_and_clear_bit(FLG_OWN_BUSY, &l2->flag)) { in l2_clear_own_busy()
1745 enquiry_cr(l2, RR, RSP, 0); in l2_clear_own_busy()
1746 test_and_clear_bit(FLG_ACK_PEND, &l2->flag); in l2_clear_own_busy()
1755 struct layer2 *l2 = fi->userdata; in l2_frame_error() local
1757 l2mgr(l2, MDL_ERROR_IND, arg); in l2_frame_error()
1763 struct layer2 *l2 = fi->userdata; in l2_frame_error_reest() local
1765 l2mgr(l2, MDL_ERROR_IND, arg); in l2_frame_error_reest()
1767 test_and_clear_bit(FLG_L3_INIT, &l2->flag); in l2_frame_error_reest()
1868 ph_data_indication(struct layer2 *l2, struct mISDNhead *hh, struct sk_buff *skb) in ph_data_indication() argument
1876 l = l2addrsize(l2); in ph_data_indication()
1878 mISDN_FsmEvent(&l2->l2m, EV_L2_FRAME_ERROR, (void *) 'N'); in ph_data_indication()
1881 if (test_bit(FLG_LAPD, &l2->flag)) { /* Maybe not needed */ in ph_data_indication()
1887 mISDNDevName4ch(&l2->ch)); in ph_data_indication()
1892 if (psapi != l2->sapi) { in ph_data_indication()
1896 mISDNDevName4ch(&l2->ch), psapi, in ph_data_indication()
1897 l2->sapi); in ph_data_indication()
1901 if ((ptei != l2->tei) && (ptei != GROUP_TEI)) { in ph_data_indication()
1905 mISDNDevName4ch(&l2->ch), ptei, l2->tei); in ph_data_indication()
1912 c = iframe_error(l2, skb); in ph_data_indication()
1914 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_I, skb); in ph_data_indication()
1915 } else if (IsSFrame(datap, l2)) { /* S-Frame */ in ph_data_indication()
1916 c = super_error(l2, skb); in ph_data_indication()
1918 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_SUPER, skb); in ph_data_indication()
1920 c = UI_error(l2, skb); in ph_data_indication()
1922 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_UI, skb); in ph_data_indication()
1923 } else if (IsSABME(datap, l2)) { in ph_data_indication()
1924 c = unnum_error(l2, skb, CMD); in ph_data_indication()
1926 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_SABME, skb); in ph_data_indication()
1928 c = unnum_error(l2, skb, RSP); in ph_data_indication()
1930 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_UA, skb); in ph_data_indication()
1932 c = unnum_error(l2, skb, CMD); in ph_data_indication()
1934 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DISC, skb); in ph_data_indication()
1936 c = unnum_error(l2, skb, RSP); in ph_data_indication()
1938 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DM, skb); in ph_data_indication()
1940 c = FRMR_error(l2, skb); in ph_data_indication()
1942 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_FRMR, skb); in ph_data_indication()
1947 mISDNDevName4ch(&l2->ch), c); in ph_data_indication()
1948 mISDN_FsmEvent(&l2->l2m, EV_L2_FRAME_ERROR, (void *)(long)c); in ph_data_indication()
1956 struct layer2 *l2 = container_of(ch, struct layer2, ch); in l2_send() local
1962 __func__, mISDNDevName4ch(&l2->ch), hh->prim, hh->id, in l2_send()
1963 l2->sapi, l2->tei); in l2_send()
1970 mISDNDevName4ch(&l2->ch), hh->prim, hh->id); in l2_send()
1974 ret = ph_data_indication(l2, hh, skb); in l2_send()
1977 ret = ph_data_confirm(l2, hh, skb); in l2_send()
1980 test_and_set_bit(FLG_L1_ACTIV, &l2->flag); in l2_send()
1981 l2up_create(l2, MPH_ACTIVATE_IND, 0, NULL); in l2_send()
1982 if (test_and_clear_bit(FLG_ESTAB_PEND, &l2->flag)) in l2_send()
1983 ret = mISDN_FsmEvent(&l2->l2m, in l2_send()
1987 test_and_clear_bit(FLG_L1_ACTIV, &l2->flag); in l2_send()
1988 l2up_create(l2, MPH_DEACTIVATE_IND, 0, NULL); in l2_send()
1989 ret = mISDN_FsmEvent(&l2->l2m, EV_L1_DEACTIVATE, skb); in l2_send()
1992 if (!l2->up) in l2_send()
1994 ret = l2->up->send(l2->up, skb); in l2_send()
1997 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DL_DATA, skb); in l2_send()
2000 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DL_UNITDATA, skb); in l2_send()
2003 if (test_bit(FLG_LAPB, &l2->flag)) in l2_send()
2004 test_and_set_bit(FLG_ORIG, &l2->flag); in l2_send()
2005 if (test_bit(FLG_L1_ACTIV, &l2->flag)) { in l2_send()
2006 if (test_bit(FLG_LAPD, &l2->flag) || in l2_send()
2007 test_bit(FLG_ORIG, &l2->flag)) in l2_send()
2008 ret = mISDN_FsmEvent(&l2->l2m, in l2_send()
2011 if (test_bit(FLG_LAPD, &l2->flag) || in l2_send()
2012 test_bit(FLG_ORIG, &l2->flag)) { in l2_send()
2014 &l2->flag); in l2_send()
2016 ret = l2down(l2, PH_ACTIVATE_REQ, l2_newid(l2), in l2_send()
2021 if (test_bit(FLG_LAPB, &l2->flag)) in l2_send()
2022 l2down_create(l2, PH_DEACTIVATE_REQ, in l2_send()
2023 l2_newid(l2), 0, NULL); in l2_send()
2024 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_DL_RELEASE_REQ, in l2_send()
2028 mISDN_FsmEvent(&l2->l2m, EV_L2_T200I, NULL); in l2_send()
2031 mISDN_FsmEvent(&l2->l2m, EV_L2_T203I, NULL); in l2_send()
2035 l2m_debug(&l2->l2m, "l2 unknown pr %04x", in l2_send()
2046 tei_l2(struct layer2 *l2, u_int cmd, u_long arg) in tei_l2() argument
2052 mISDNDevName4ch(&l2->ch), cmd, __func__); in tei_l2()
2055 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_ASSIGN, (void *)arg); in tei_l2()
2058 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_REMOVE, NULL); in tei_l2()
2061 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_ERROR, NULL); in tei_l2()
2066 mISDNDevName4ch(&l2->ch)); in tei_l2()
2067 ret = mISDN_FsmEvent(&l2->l2m, EV_L2_MDL_ERROR, NULL); in tei_l2()
2074 release_l2(struct layer2 *l2) in release_l2() argument
2076 mISDN_FsmDelTimer(&l2->t200, 21); in release_l2()
2077 mISDN_FsmDelTimer(&l2->t203, 16); in release_l2()
2078 skb_queue_purge(&l2->i_queue); in release_l2()
2079 skb_queue_purge(&l2->ui_queue); in release_l2()
2080 skb_queue_purge(&l2->down_queue); in release_l2()
2081 ReleaseWin(l2); in release_l2()
2082 if (test_bit(FLG_LAPD, &l2->flag)) { in release_l2()
2083 TEIrelease(l2); in release_l2()
2084 if (l2->ch.st) in release_l2()
2085 l2->ch.st->dev->D.ctrl(&l2->ch.st->dev->D, in release_l2()
2088 kfree(l2); in release_l2()
2094 struct layer2 *l2 = container_of(ch, struct layer2, ch); in l2_ctrl() local
2103 if (test_bit(FLG_LAPD, &l2->flag)) { in l2_ctrl()
2104 set_channel_address(&l2->ch, l2->sapi, l2->tei); in l2_ctrl()
2106 l2up_create(l2, DL_INFORMATION_IND, in l2_ctrl()
2111 if (l2->ch.peer) in l2_ctrl()
2112 l2->ch.peer->ctrl(l2->ch.peer, CLOSE_CHANNEL, NULL); in l2_ctrl()
2113 release_l2(l2); in l2_ctrl()
2123 struct layer2 *l2; in create_l2() local
2126 l2 = kzalloc(sizeof(struct layer2), GFP_KERNEL); in create_l2()
2127 if (!l2) { in create_l2()
2131 l2->next_id = 1; in create_l2()
2132 l2->down_id = MISDN_ID_NONE; in create_l2()
2133 l2->up = ch; in create_l2()
2134 l2->ch.st = ch->st; in create_l2()
2135 l2->ch.send = l2_send; in create_l2()
2136 l2->ch.ctrl = l2_ctrl; in create_l2()
2139 test_and_set_bit(FLG_LAPD, &l2->flag); in create_l2()
2140 test_and_set_bit(FLG_LAPD_NET, &l2->flag); in create_l2()
2141 test_and_set_bit(FLG_MOD128, &l2->flag); in create_l2()
2142 l2->sapi = sapi; in create_l2()
2143 l2->maxlen = MAX_DFRAME_LEN; in create_l2()
2145 l2->window = 7; in create_l2()
2147 l2->window = 1; in create_l2()
2149 test_and_set_bit(FLG_PTP, &l2->flag); in create_l2()
2151 test_and_set_bit(FLG_FIXED_TEI, &l2->flag); in create_l2()
2152 l2->tei = tei; in create_l2()
2153 l2->T200 = 1000; in create_l2()
2154 l2->N200 = 3; in create_l2()
2155 l2->T203 = 10000; in create_l2()
2161 l2->ch.st->dev->D.ctrl(&l2->ch.st->dev->D, OPEN_CHANNEL, &rq); in create_l2()
2164 test_and_set_bit(FLG_LAPD, &l2->flag); in create_l2()
2165 test_and_set_bit(FLG_MOD128, &l2->flag); in create_l2()
2166 test_and_set_bit(FLG_ORIG, &l2->flag); in create_l2()
2167 l2->sapi = sapi; in create_l2()
2168 l2->maxlen = MAX_DFRAME_LEN; in create_l2()
2170 l2->window = 7; in create_l2()
2172 l2->window = 1; in create_l2()
2174 test_and_set_bit(FLG_PTP, &l2->flag); in create_l2()
2176 test_and_set_bit(FLG_FIXED_TEI, &l2->flag); in create_l2()
2177 l2->tei = tei; in create_l2()
2178 l2->T200 = 1000; in create_l2()
2179 l2->N200 = 3; in create_l2()
2180 l2->T203 = 10000; in create_l2()
2186 l2->ch.st->dev->D.ctrl(&l2->ch.st->dev->D, OPEN_CHANNEL, &rq); in create_l2()
2189 test_and_set_bit(FLG_LAPB, &l2->flag); in create_l2()
2190 l2->window = 7; in create_l2()
2191 l2->maxlen = MAX_DATA_SIZE; in create_l2()
2192 l2->T200 = 1000; in create_l2()
2193 l2->N200 = 4; in create_l2()
2194 l2->T203 = 5000; in create_l2()
2195 l2->addr.A = 3; in create_l2()
2196 l2->addr.B = 1; in create_l2()
2201 kfree(l2); in create_l2()
2204 skb_queue_head_init(&l2->i_queue); in create_l2()
2205 skb_queue_head_init(&l2->ui_queue); in create_l2()
2206 skb_queue_head_init(&l2->down_queue); in create_l2()
2207 skb_queue_head_init(&l2->tmp_queue); in create_l2()
2208 InitWin(l2); in create_l2()
2209 l2->l2m.fsm = &l2fsm; in create_l2()
2210 if (test_bit(FLG_LAPB, &l2->flag) || in create_l2()
2211 test_bit(FLG_FIXED_TEI, &l2->flag) || in create_l2()
2212 test_bit(FLG_LAPD_NET, &l2->flag)) in create_l2()
2213 l2->l2m.state = ST_L2_4; in create_l2()
2215 l2->l2m.state = ST_L2_1; in create_l2()
2216 l2->l2m.debug = *debug; in create_l2()
2217 l2->l2m.userdata = l2; in create_l2()
2218 l2->l2m.userint = 0; in create_l2()
2219 l2->l2m.printdebug = l2m_debug; in create_l2()
2221 mISDN_FsmInitTimer(&l2->l2m, &l2->t200); in create_l2()
2222 mISDN_FsmInitTimer(&l2->l2m, &l2->t203); in create_l2()
2223 return l2; in create_l2()
2229 struct layer2 *l2; in x75create() local
2233 l2 = create_l2(crq->ch, crq->protocol, 0, 0, 0); in x75create()
2234 if (!l2) in x75create()
2236 crq->ch = &l2->ch; in x75create()