This source file includes following definitions.
- Q921State2Name
- Q921SendEnquiry
- Q921SendEnquiryResponse
- Q921ResetExceptionConditions
- Q921EstablishDataLink
- Q921NrErrorRecovery
- Q921InvokeRetransmission
- Q921AcknowledgePending
- Q921_InitTrunk
- Q921Tx21Proc
- Q921Tx23Proc
- Q921Log
- print_hex
- Q921LogMesg
- Q921GetTime
- Q921T200TimerStart
- Q921T200TimerStop
- Q921T200TimerReset
- Q921T203TimerStart
- Q921T203TimerStop
- Q921T203TimerReset
- Q921T202TimerStart
- Q921T202TimerStop
- Q921T202TimerReset
- Q921T201TimerStart
- Q921T201TimerStop
- Q921T201TimerReset
- Q921TM01TimerStart
- Q921TM01TimerStop
- Q921TM01TimerReset
- Q921T200TimerExpire
- Q921T203TimerExpire
- Q921T202TimerExpire
- Q921T201TimerExpire
- Q921TM01TimerExpire
- Q921TimerTick
- Q921SetGetTimeCB
- Q921QueueHDLCFrame
- Q921EnqueueI
- Q921SendQueuedIFrame
- Q921SendS
- Q921SendU
- Q921Rx32
- Q921SendRR
- Q921SendRNR
- Q921SendREJ
- Q921SendSABME
- Q921Start
- Q921Stop
- Q921SendDM
- Q921SendDISC
- Q921SendUA
- Q921SendUN
- Q921ProcSABME
- Q921ProcDM
- Q921ProcUA
- Q921ProcDISC
- Q921ProcRR
- Q921ProcREJ
- Q921ProcRNR
- Q921SetReceiverBusy
- Q921ClearReceiverBusy
- Q921ProcIFrame
- Q921ProcSFrame
- Q921ProcUFrame
- Q921Rx12
- Q921SetLogCB
- Q921SetLogLevel
- Q921ChangeState
- Q921TeiSend
- Q921TeiSendAssignRequest
- Q921TeiProcAssignResponse
- Q921TeiSendVerifyRequest
- Q921TeiProcCheckRequest
- Q921TeiProcRemoveRequest
- Q921TeiProcAssignRequest
- Q921TeiSendCheckRequest
- Q921TeiProcCheckResponse
- Q921TeiProcVerifyRequest
- Q921TeiSendDenyResponse
- Q921TeiSendAssignedResponse
- Q921TeiSendRemoveRequest
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77 #include <stdlib.h>
78 #include <stdio.h>
79 #include <string.h>
80 #include <stdarg.h>
81
82 #include "freetdm.h"
83 #include "Q921.h"
84 #include "Q921priv.h"
85 #include "mfifo.h"
86
87 #ifdef WIN32
88 #pragma warning(disable:4100 4244)
89 #endif
90
91
92
93
94
95
96
97
98
99
100 static struct Q921StateName {
101 Q921State_t value;
102 const char *name;
103 } Q921StateNames[10] = {
104 { Q921_STATE_STOPPED, "Stopped" },
105 { Q921_STATE_TEI_UNASSIGNED, "TEI Unassigned" },
106 { Q921_STATE_TEI_AWAITING, "TEI Awaiting Assignment" },
107 { Q921_STATE_TEI_ESTABLISH, "TEI Awaiting Establishment" },
108 { Q921_STATE_TEI_ASSIGNED, "TEI Assigned" },
109 { Q921_STATE_AWAITING_ESTABLISHMENT, "Awaiting Establishment" },
110 { Q921_STATE_AWAITING_RELEASE, "Awaiting Release" },
111 { Q921_STATE_MULTIPLE_FRAME_ESTABLISHED, "Multiple Frame Mode Established" },
112 { Q921_STATE_TIMER_RECOVERY, "Timer Recovery" },
113 { 0, 0 }
114 };
115
116
117
118
119
120
121
122
123
124 static const char *Q921State2Name(Q921State_t state)
125 {
126 struct Q921StateName *p = Q921StateNames;
127
128 while(p->name) {
129 if(p->value == state)
130 return p->name;
131 p++;
132 }
133
134 return "Unknown";
135 }
136
137
138
139
140
141 static int Q921SendEnquiry(L2TRUNK trunk, L2UCHAR tei)
142 {
143 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
144
145
146 if(Q921_CHECK_FLAG(link, Q921_FLAG_RECV_BUSY)) {
147
148 Q921SendRNR(trunk, trunk->sapi, Q921_COMMAND(trunk), tei, 1);
149 }
150 else {
151 Q921SendRR(trunk, trunk->sapi, Q921_COMMAND(trunk), tei, 1);
152 }
153
154
155 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
156
157
158 Q921T200TimerReset(trunk, tei);
159
160
161 return 1;
162 }
163
164
165
166
167 static int Q921SendEnquiryResponse(L2TRUNK trunk, L2UCHAR tei)
168 {
169 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
170
171
172 if(Q921_CHECK_FLAG(link, Q921_FLAG_RECV_BUSY)) {
173
174 Q921SendRNR(trunk, trunk->sapi, Q921_RESPONSE(trunk), tei, 1);
175 }
176 else {
177 Q921SendRR(trunk, trunk->sapi, Q921_RESPONSE(trunk), tei, 1);
178
179
180 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
181 }
182
183 return 1;
184 }
185
186
187
188
189
190
191
192
193 static void Q921ResetExceptionConditions(L2TRUNK trunk, L2UCHAR tei)
194 {
195 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
196
197
198 Q921_CLEAR_FLAG(link, Q921_FLAG_PEER_RECV_BUSY);
199
200
201 Q921_CLEAR_FLAG(link, Q921_FLAG_REJECT);
202
203
204 Q921_CLEAR_FLAG(link, Q921_FLAG_RECV_BUSY);
205
206
207 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
208
209 return;
210 }
211
212
213
214
215
216
217
218
219 static int Q921EstablishDataLink(L2TRUNK trunk, L2UCHAR tei)
220 {
221 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
222
223
224 Q921ResetExceptionConditions(trunk, tei);
225
226
227 link->N200 = 0;
228
229
230 Q921SendSABME(trunk, trunk->sapi, Q921_COMMAND(trunk), tei, 1);
231
232
233 Q921T200TimerReset(trunk, tei);
234 Q921T203TimerStop(trunk, tei);
235
236 return 1;
237 }
238
239
240
241
242
243
244
245
246 static int Q921NrErrorRecovery(L2TRUNK trunk, L2UCHAR tei)
247 {
248 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
249
250
251
252
253 Q921EstablishDataLink(trunk, tei);
254
255
256 Q921_CLEAR_FLAG(link, Q921_FLAG_L3_INITIATED);
257
258 return 1;
259 }
260
261
262
263
264
265
266
267
268
269
270 static int Q921InvokeRetransmission(L2TRUNK trunk, L2UCHAR tei, L2UCHAR nr)
271 {
272 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
273 L2UCHAR *mes;
274 L2INT qpos, qnum, size = 0;
275
276 qnum = MFIFOGetMesCount(link->IFrameResendQueue);
277 qpos = qnum - 1;
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300 while(link->vs != nr && qpos > 0) {
301
302 Q921_DEC_COUNTER(link->vs);
303
304
305 qpos--;
306 }
307
308
309
310
311 if(link->vs != nr && !qpos) {
312
313
314 }
315
316
317
318
319
320 while(qpos < qnum) {
321
322 mes = MFIFOGetMesPtrOffset(link->IFrameResendQueue, &size, qpos);
323 if(mes) {
324
325 MFIFOWriteMes(link->IFrameQueue, mes, size);
326
327
328 }
329
330 qpos++;
331 }
332
333 return 1;
334 }
335
336
337 static int Q921AcknowledgePending(L2TRUNK trunk, L2UCHAR tei)
338 {
339 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
340
341 switch(link->state) {
342 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
343 case Q921_STATE_TIMER_RECOVERY:
344 if(Q921_CHECK_FLAG(link, Q921_FLAG_ACK_PENDING)) {
345
346 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
347
348
349 Q921SendRR(trunk, trunk->sapi, Q921_COMMAND(trunk), tei, 0);
350
351 return 1;
352 }
353 break;
354
355 default:
356 break;
357 }
358
359 return 0;
360 }
361
362
363
364
365
366
367
368
369
370 int Q921_InitTrunk(L2TRUNK trunk,
371 L2UCHAR sapi,
372 L2UCHAR tei,
373 Q921NetUser_t NetUser,
374 Q921NetType_t NetType,
375 L2INT hsize,
376 Q921Tx21CB_t cb21,
377 Q921Tx23CB_t cb23,
378 void *priv21,
379 void *priv23)
380 {
381 int numlinks = 0;
382
383 trunk->sapi = sapi;
384 trunk->tei = tei;
385 trunk->NetUser = NetUser;
386 trunk->NetType = NetType;
387 trunk->Q921Tx21Proc = cb21;
388 trunk->Q921Tx23Proc = cb23;
389 trunk->PrivateData21 = priv21;
390 trunk->PrivateData23 = priv23;
391 trunk->Q921HeaderSpace = hsize;
392
393 numlinks = Q921_IS_PTMP_NT(trunk) ? Q921_TEI_MAX : 1;
394
395 if (trunk->initialized != INITIALIZED_MAGIC) {
396 MFIFOCreate(trunk->HDLCInQueue, Q921MAXHDLCSPACE, 10);
397
398
399
400
401 trunk->context = ftdm_malloc(numlinks * sizeof(struct Q921_Link));
402 if(!trunk->context)
403 return -1;
404
405 trunk->initialized = INITIALIZED_MAGIC;
406 }
407
408
409 trunk->T200Timeout = 1000;
410 trunk->T203Timeout = 10000;
411 trunk->T202Timeout = 2000;
412 trunk->T201Timeout = 200000;
413 trunk->TM01Timeout = 10000;
414
415
416 trunk->N200Limit = 3;
417 trunk->N201Limit = 260;
418 trunk->N202Limit = 3;
419 trunk->k = 7;
420
421
422 trunk->T202 = 0;
423 trunk->N202 = 0;
424
425
426 memset(trunk->context, 0, numlinks * sizeof(struct Q921_Link));
427
428
429 memset(trunk->tei_map, 0, Q921_TEI_MAX + 1);
430
431 if(Q921_IS_PTMP(trunk)) {
432
433
434
435
436
437 trunk->tei = 0;
438 }
439
440 return 0;
441 }
442
443
444
445
446
447
448
449
450
451
452 static int Q921Tx21Proc(L2TRUNK trunk, L2UCHAR *Msg, L2INT size)
453 {
454 Q921LogMesg(trunk, Q921_LOG_DEBUG, 0, Msg, size, "Sending frame");
455
456 return trunk->Q921Tx21Proc(trunk->PrivateData21, Msg, size);
457 }
458
459
460
461
462
463
464
465
466
467
468 static int Q921Tx23Proc(L2TRUNK trunk, Q921DLMsg_t ind, L2UCHAR tei, L2UCHAR *Msg, L2INT size)
469 {
470 return trunk->Q921Tx23Proc(trunk->PrivateData23, ind, tei, Msg, size);
471 }
472
473
474
475
476
477
478
479
480
481
482
483
484 static int Q921Log(L2TRUNK trunk, Q921LogLevel_t level, const char *fmt, ...)
485 {
486 char buf[Q921_LOGBUFSIZE];
487 L2INT len;
488 va_list ap;
489
490 if(!trunk->Q921LogProc)
491 return 0;
492
493 if(trunk->loglevel < level)
494 return 0;
495
496 va_start(ap, fmt);
497
498 len = vsnprintf(buf, sizeof(buf)-1, fmt, ap);
499 if(len <= 0) {
500
501 return -1;
502 }
503 if(len >= sizeof(buf))
504 len = sizeof(buf) - 1;
505
506 buf[len] = '\0';
507
508 va_end(ap);
509
510 return trunk->Q921LogProc(trunk->PrivateDataLog, level, buf, len);
511 }
512
513
514 static int print_hex(char *buf, int bsize, const unsigned char *in, const int len)
515 {
516 static const char hex[] = { '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', 'a', 'b', 'c', 'd', 'e', 'f' };
517 int offset = 0;
518 int pos = 0;
519 int nr = 0;
520
521 buf[pos++] = '[';
522 bsize -= 3;
523
524 while((bsize - pos) > 0 && offset < len) {
525 buf[pos++] = hex[(in[offset] & 0xF0) >> 4];
526 buf[pos++] = hex[(in[offset++] & 0x0F)];
527
528 if(++nr == 32 && offset < len && (bsize - pos) > 3) {
529 nr = 0;
530 buf[pos++] = ']';
531 buf[pos++] = '\n';
532 buf[pos++] = '[';
533 }
534 else if(offset < len) {
535 buf[pos++] = ' ';
536 }
537 }
538
539 buf[pos++] = ']';
540 buf[pos++] = '\n';
541 buf[pos] = '\0';
542
543 return pos;
544 }
545
546 #define APPEND_MSG(buf, off, lef, fmt, ...) \
547 len = snprintf(buf + off, lef, fmt, ##__VA_ARGS__); \
548 if(len > 0) { \
549 off += len; \
550 lef -= len; \
551 } else { \
552 goto out; \
553 }
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568 static int Q921LogMesg(L2TRUNK trunk, Q921LogLevel_t level, L2UCHAR received, L2UCHAR *mes, L2INT size, const char *fmt, ...)
569 {
570 char buf[Q921_LOGBUFSIZE];
571 size_t len, left;
572 va_list ap;
573
574 if(!trunk->Q921LogProc)
575 return 0;
576
577 if(trunk->loglevel < level)
578 return 0;
579
580 if(!mes)
581 return 0;
582
583 memset(buf, 0, sizeof(buf));
584
585 left = sizeof(buf) - 1;
586
587 va_start(ap, fmt);
588
589 len = vsnprintf(buf, left, fmt, ap);
590 if(len > 0)
591 left -= len;
592 else {
593
594 return -1;
595 }
596
597 va_end(ap);
598
599 if(trunk->loglevel == Q921_LOG_DEBUG) {
600 char pbuf[1024];
601 size_t pleft, poffset;
602 L2UCHAR sapi, tei, cr;
603 L2UCHAR *pmes = mes + trunk->Q921HeaderSpace;
604 struct Q921_Link *link;
605
606 memset(pbuf, 0, sizeof(pbuf));
607
608 pleft = sizeof(pbuf);
609 poffset = 0;
610
611
612
613
614 sapi = (pmes[0] & 0xfc) >> 2;
615 cr = (pmes[0] & 0x02) >> 1;
616 tei = (pmes[1] & 0xfe) >> 1;
617 link = Q921_LINK_CONTEXT(trunk, tei);
618
619
620 cr = (received) ? Q921_IS_COMMAND(trunk, cr) : Q921_IS_RESPONSE(trunk, cr);
621
622
623 if((pmes[2] & 0x01) == 0x00) {
624 ;
625 }
626 else if((pmes[2] & 0x03) == 0x01) {
627 ;
628 }
629 else if((pmes[2] & 0x03) == 0x03) {
630 ;
631 }
632
633 APPEND_MSG(pbuf, poffset, pleft, "\n----------------- Q.921 Packet [%s%s] ---------------\n", received ? "Incoming" : "Outgoing",
634 (tei == link->tei || tei == Q921_TEI_BCAST) ? "" : ", Ignored" );
635
636
637 APPEND_MSG(pbuf, poffset, pleft, " SAPI: %u, TEI: %u, C/R: %s (%d)\n\n", sapi, tei, (cr) ? "Command" : "Response", (mes[0] & 0x02) >> 1 );
638
639
640
641
642 if((pmes[2] & 0x01) == 0x00) {
643
644
645
646 L2UCHAR pf = pmes[3] & 0x01;
647 L2UCHAR nr = pmes[3] >> 1;
648 L2UCHAR ns = pmes[2] >> 1;
649
650 APPEND_MSG(pbuf, poffset, pleft, " Type: I Frame\n P/F: %d, N(S): %d, N(R): %d [V(A): %d, V(R): %d, V(S): %d]\n", pf, ns, nr,
651 link->va, link->vr, link->vs);
652
653
654 if(tei != link->tei) {
655 APPEND_MSG(pbuf, poffset, pleft, " CONTENT:\n");
656
657 len = print_hex(pbuf + poffset, (int)pleft, &pmes[4], size - (trunk->Q921HeaderSpace + 4));
658 poffset += len;
659 pleft -= len;
660 }
661 }
662 else if((pmes[2] & 0x03) == 0x01) {
663
664
665
666 L2UCHAR sv = (pmes[2] & 0x0c) >> 2;
667 L2UCHAR pf = pmes[3] & 0x01;
668 L2UCHAR nr = pmes[3] >> 1;
669 const char *type;
670
671 switch(sv) {
672 case 0x00:
673 type = "RR (Receive Ready)";
674 break;
675
676 case 0x02:
677 type = "RNR (Receiver Not Ready)";
678 break;
679
680 case 0x04:
681 type = "REJ (Reject)";
682 break;
683
684 default:
685 type = "Unknown";
686 break;
687 }
688
689 APPEND_MSG(pbuf, poffset, pleft, " Type: S Frame, SV: %s\n P/F: %d, N(R): %d [V(A): %d, V(R): %d, V(S): %d]\n", type, pf, nr,
690 link->va, link->vr, link->vs);
691 }
692 else if((pmes[2] & 0x03) == 0x03) {
693
694
695
696 L2UCHAR m = (pmes[2] & 0xe0) >> 3 | (pmes[2] & 0x0c) >> 2;
697 L2UCHAR pf = (pmes[2] & 0x10) >> 4;
698 const char *type;
699
700 switch(m) {
701 case 0x00:
702 type = "UI (Unnumbered Information)";
703 break;
704
705 case 0x03:
706 type = "DM (Disconnected Mode)";
707 break;
708
709 case 0x08:
710 type = "DISC (Disconnect)";
711 break;
712
713 case 0x0c:
714 type = "UA (Unnumbered Acknowledgement)";
715 break;
716
717 case 0x0f:
718 type = "SABME";
719 break;
720
721 case 0x11:
722 type = "FRMR (Frame Reject)";
723 break;
724
725 case 0x17:
726 type = "XID (Exchange Identification)";
727 break;
728
729 default:
730 type = "Unknown";
731 }
732
733
734 APPEND_MSG(pbuf, poffset, pleft, " Type: U Frame (%s)\n P/F: %d\n", type, pf);
735
736 if(m == 0x00) {
737 switch(pmes[3]) {
738 case Q921_LAYER_ENT_ID_TEI:
739 type = "TEI Mgmt";
740 break;
741
742 case Q921_LAYER_ENT_ID_Q931:
743 type = "Q.931";
744 break;
745
746 default:
747 type = "Unknown";
748 }
749
750 if(pmes[3] == Q921_LAYER_ENT_ID_TEI) {
751 const char *command = "";
752
753 switch(pmes[6]) {
754 case Q921_TEI_ID_REQUEST:
755 command = "Request";
756 break;
757 case Q921_TEI_ID_VERIFY:
758 command = "Verify";
759 break;
760 case Q921_TEI_ID_CHECKREQ:
761 command = "Check req";
762 break;
763 case Q921_TEI_ID_CHECKRESP:
764 command = "Check resp";
765 break;
766 case Q921_TEI_ID_REMOVE:
767 command = "Remove";
768 break;
769 case Q921_TEI_ID_ASSIGNED:
770 command = "Assign";
771 break;
772 case Q921_TEI_ID_DENIED:
773 command = "Denied";
774 break;
775 }
776 APPEND_MSG(pbuf, poffset, pleft, " ENT ID: %d (%s), COMMAND: %d (%s), RI: %#x, AI: %d\n",
777 pmes[3], type, pmes[6], command, (int)((pmes[4] << 8) | pmes[5]), pmes[7] >> 1);
778 }
779 else {
780 APPEND_MSG(pbuf, poffset, pleft, " ENT ID: %d (%s), MESSAGE CONTENT:\n", pmes[3], type);
781
782 len = print_hex(pbuf + poffset, (int)pleft, &pmes[3], size - (trunk->Q921HeaderSpace + 3));
783 poffset += len;
784 pleft -= len;
785 }
786 }
787 }
788 else {
789
790
791
792 strncat(pbuf + poffset, " -- unknown frame type --\n", pleft);
793
794 len = (sizeof(pbuf) - poffset) - strlen(pbuf + poffset);
795 if(len > 0) {
796 poffset += len;
797 pleft -= len;
798 } else
799 goto out;
800 }
801
802 APPEND_MSG(pbuf, poffset, pleft, "\n Q.921 state: \"%s\" (%d) [flags: %c%c%c%c]\n", Q921State2Name(link->state), link->state,
803 Q921_CHECK_FLAG(link, Q921_FLAG_ACK_PENDING) ? 'A' : '-',
804 Q921_CHECK_FLAG(link, Q921_FLAG_REJECT) ? 'R' : '-',
805 Q921_CHECK_FLAG(link, Q921_FLAG_PEER_RECV_BUSY) ? 'P' : '-',
806 Q921_CHECK_FLAG(link, Q921_FLAG_RECV_BUSY) ? 'B' : '-');
807
808 strncat(pbuf + poffset, "----------------------------------------------\n\n", pleft);
809
810 len = (sizeof(pbuf) - poffset) - strlen(pbuf + poffset);
811 if(len > 0) {
812 poffset += len;
813 pleft -= len;
814 } else
815 goto out;
816
817
818
819 len = strlen(pbuf);
820 if(len <= left)
821 strncat(buf, pbuf, left);
822 else
823 strncat(buf, "-- packet truncated --\n", left);
824 }
825
826 out:
827 buf[sizeof(buf) - 1] = '\0';
828
829 return trunk->Q921LogProc(trunk->PrivateDataLog, level, buf, (int)strlen(buf));
830 }
831
832
833
834
835
836
837
838
839
840
841
842 static L2ULONG (*Q921GetTimeProc) (void) = NULL;
843 static L2ULONG tLast = {0};
844
845 static L2ULONG Q921GetTime(void)
846 {
847 L2ULONG tNow = 0;
848
849 if(Q921GetTimeProc)
850 {
851 tNow = Q921GetTimeProc();
852 if(tNow < tLast)
853 {
854
855 }
856 tLast = tNow;
857 }
858 return tNow;
859 }
860
861
862
863
864 static void Q921T200TimerStart(L2TRUNK trunk, L2UCHAR tei)
865 {
866 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
867
868 if (!link->T200) {
869 link->T200 = Q921GetTime() + trunk->T200Timeout;
870
871 Q921Log(trunk, Q921_LOG_DEBUG, "T200 (timeout: %d msecs) started for TEI %d\n", trunk->T200Timeout, tei);
872 }
873 }
874
875 static void Q921T200TimerStop(L2TRUNK trunk, L2UCHAR tei)
876 {
877 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
878
879 link->T200 = 0;
880
881 Q921Log(trunk, Q921_LOG_DEBUG, "T200 stopped for TEI %d\n", tei);
882 }
883
884 static void Q921T200TimerReset(L2TRUNK trunk, L2UCHAR tei)
885 {
886 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
887
888 link->T200 = Q921GetTime() + trunk->T200Timeout;
889
890 Q921Log(trunk, Q921_LOG_DEBUG, "T200 (timeout: %d msecs) restarted for TEI %d\n", trunk->T200Timeout, tei);
891 }
892
893
894
895
896 static void Q921T203TimerStart(L2TRUNK trunk, L2UCHAR tei)
897 {
898 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
899
900 if (!link->T203) {
901 link->T203 = Q921GetTime() + trunk->T203Timeout;
902
903 Q921Log(trunk, Q921_LOG_DEBUG, "T203 (timeout: %d msecs) started for TEI %d\n", trunk->T203Timeout, tei);
904 }
905 }
906
907 static void Q921T203TimerStop(L2TRUNK trunk, L2UCHAR tei)
908 {
909 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
910
911 link->T203 = 0;
912
913 Q921Log(trunk, Q921_LOG_DEBUG, "T203 stopped for TEI %d\n", tei);
914 }
915
916 static void Q921T203TimerReset(L2TRUNK trunk, L2UCHAR tei)
917 {
918 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
919
920 link->T203 = Q921GetTime() + trunk->T203Timeout;
921
922 Q921Log(trunk, Q921_LOG_DEBUG, "T203 (timeout: %d msecs) restarted for TEI %d\n", trunk->T203Timeout, tei);
923 }
924
925
926
927
928 static void Q921T202TimerStart(L2TRUNK trunk)
929 {
930 if (!trunk->T202) {
931 trunk->T202 = Q921GetTime() + trunk->T202Timeout;
932
933 Q921Log(trunk, Q921_LOG_DEBUG, "T202 (timeout: %d msecs) started\n", trunk->T202Timeout);
934 }
935 }
936
937 static void Q921T202TimerStop(L2TRUNK trunk)
938 {
939 trunk->T202 = 0;
940
941 Q921Log(trunk, Q921_LOG_DEBUG, "T202 stopped\n");
942 }
943
944 static void Q921T202TimerReset(L2TRUNK trunk)
945 {
946 trunk->T202 = Q921GetTime() + trunk->T202Timeout;
947
948 Q921Log(trunk, Q921_LOG_DEBUG, "T202 (timeout: %d msecs) restarted\n", trunk->T202Timeout);
949 }
950
951
952
953
954 static void Q921T201TimerStart(L2TRUNK trunk, L2UCHAR tei)
955 {
956 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
957
958 if (!link->T201) {
959 link->T201 = Q921GetTime() + trunk->T201Timeout;
960
961 Q921Log(trunk, Q921_LOG_DEBUG, "T201 (timeout: %d msecs) started for TEI %d\n", trunk->T201Timeout, tei);
962 }
963 }
964
965 static void Q921T201TimerStop(L2TRUNK trunk, L2UCHAR tei)
966 {
967 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
968
969 link->T201 = 0;
970
971 Q921Log(trunk, Q921_LOG_DEBUG, "T201 stopped for TEI %d\n", tei);
972 }
973
974 #ifdef __UNUSED_FOR_NOW__
975 static void Q921T201TimerReset(L2TRUNK trunk, L2UCHAR tei)
976 {
977 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
978
979 link->T201 = Q921GetTime() + trunk->T201Timeout;
980
981 Q921Log(trunk, Q921_LOG_DEBUG, "T201 (timeout: %d msecs) restarted for TEI %d\n", trunk->T201Timeout, tei);
982 }
983 #endif
984
985
986
987
988 static void Q921TM01TimerStart(L2TRUNK trunk, L2UCHAR tei)
989 {
990 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
991
992 if (!link->TM01) {
993 link->TM01 = Q921GetTime() + trunk->TM01Timeout;
994
995 Q921Log(trunk, Q921_LOG_DEBUG, "TM01 (timeout: %d msecs) started for TEI %d\n", trunk->TM01Timeout, tei);
996 }
997 }
998
999 #ifdef __UNUSED_FOR_NOW__
1000 static void Q921TM01TimerStop(L2TRUNK trunk, L2UCHAR tei)
1001 {
1002 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
1003
1004 link->TM01 = 0;
1005
1006 Q921Log(trunk, Q921_LOG_DEBUG, "TM01 stopped for TEI %d\n", tei);
1007 }
1008 #endif
1009
1010 static void Q921TM01TimerReset(L2TRUNK trunk, L2UCHAR tei)
1011 {
1012 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
1013
1014 link->TM01 = Q921GetTime() + trunk->TM01Timeout;
1015
1016 Q921Log(trunk, Q921_LOG_DEBUG, "TM01 (timeout: %d msecs) restarted for TEI %d\n", trunk->TM01Timeout, tei);
1017 }
1018
1019
1020
1021
1022 static void Q921T200TimerExpire(L2TRUNK trunk, L2UCHAR tei)
1023 {
1024 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
1025 struct Q921_Link *trlink = Q921_TRUNK_CONTEXT(trunk);
1026
1027 Q921Log(trunk, Q921_LOG_DEBUG, "T200 expired for TEI %d (trunk TEI %d)\n", tei, trlink->tei);
1028
1029
1030 Q921T200TimerStop(trunk, tei);
1031
1032 switch(link->state) {
1033 case Q921_STATE_AWAITING_ESTABLISHMENT:
1034 if(link->N200 >= trunk->N200Limit) {
1035
1036 MFIFOClear(link->IFrameQueue);
1037
1038
1039 Q921Log(trunk, Q921_LOG_ERROR, "Failed to establish Q.921 link in %d retries\n", link->N200);
1040
1041
1042 Q921Tx23Proc(trunk, Q921_DL_RELEASE, tei, NULL, 0);
1043
1044
1045 Q921ChangeState(trunk, Q921_STATE_TEI_ASSIGNED, tei);
1046 } else {
1047
1048 link->N200++;
1049
1050
1051 Q921SendSABME(trunk,
1052 trunk->sapi,
1053 Q921_COMMAND(trunk),
1054 tei,
1055 1);
1056
1057
1058 Q921T200TimerStart(trunk, tei);
1059 }
1060 break;
1061
1062 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
1063 link->N200 = 0;
1064
1065 if(!Q921_CHECK_FLAG(link, Q921_FLAG_PEER_RECV_BUSY)) {
1066
1067
1068
1069 Q921_DEC_COUNTER(link->vs);
1070
1071
1072
1073
1074
1075
1076
1077 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
1078
1079
1080 Q921T200TimerStart(trunk, tei);
1081 } else {
1082
1083 Q921SendEnquiry(trunk, tei);
1084 }
1085
1086
1087 link->N200++;
1088
1089
1090 Q921ChangeState(trunk, Q921_STATE_TIMER_RECOVERY, tei);
1091 break;
1092
1093 case Q921_STATE_TIMER_RECOVERY:
1094 if(link->N200 == trunk->N200Limit) {
1095
1096
1097
1098 Q921EstablishDataLink(trunk, tei);
1099
1100
1101 Q921_CLEAR_FLAG(link, Q921_FLAG_L3_INITIATED);
1102
1103
1104 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
1105 } else {
1106 if(link->vs == link->va) {
1107
1108 Q921SendEnquiry(trunk, tei);
1109
1110 } else if(!Q921_CHECK_FLAG(link, Q921_FLAG_PEER_RECV_BUSY)) {
1111
1112
1113
1114 Q921_DEC_COUNTER(link->vs);
1115
1116
1117
1118
1119
1120
1121
1122 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
1123
1124
1125 Q921T200TimerStart(trunk, tei);
1126 }
1127
1128
1129 link->N200++;
1130
1131
1132 }
1133 break;
1134
1135 default:
1136 break;
1137 }
1138 }
1139
1140 static void Q921T203TimerExpire(L2TRUNK trunk, L2UCHAR tei)
1141 {
1142 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
1143 struct Q921_Link *trlink = Q921_TRUNK_CONTEXT(trunk);
1144
1145 Q921Log(trunk, Q921_LOG_DEBUG, "T203 expired for TEI %d (trunk TEI %d)\n", tei, trlink->tei);
1146
1147
1148 Q921T203TimerStop(trunk, tei);
1149
1150 switch(link->state) {
1151 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
1152
1153 Q921SendEnquiry(trunk, tei);
1154
1155
1156 link->N200 = 0;
1157
1158
1159 break;
1160
1161 default:
1162 break;
1163 }
1164 }
1165
1166 static void Q921T202TimerExpire(L2TRUNK trunk)
1167 {
1168 struct Q921_Link *link = Q921_TRUNK_CONTEXT(trunk);
1169
1170 Q921T202TimerReset(trunk);
1171
1172 Q921Log(trunk, Q921_LOG_DEBUG, "T202 expired for Q.921 trunk with TEI %d\n", link->tei);
1173
1174
1175
1176 switch(link->state) {
1177 case Q921_STATE_TEI_ASSIGNED:
1178 Q921TeiSendVerifyRequest(trunk);
1179 break;
1180
1181 default:
1182
1183 if(trunk->N202 >= trunk->N202Limit) {
1184
1185 trunk->N202 = 0;
1186
1187 Q921T202TimerStop(trunk);
1188
1189 return;
1190 }
1191 Q921TeiSendAssignRequest(trunk);
1192
1193 trunk->N202++;
1194 }
1195 }
1196
1197 static void Q921T201TimerExpire(L2TRUNK trunk, L2UCHAR tei)
1198 {
1199 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
1200 struct Q921_Link *trlink = Q921_TRUNK_CONTEXT(trunk);
1201
1202 Q921Log(trunk, Q921_LOG_DEBUG, "T201 expired for TEI %d (trunk TEI: %d)\n", tei, trlink->tei);
1203
1204 Q921T201TimerStop(trunk, tei);
1205
1206
1207 if(link->N202 < trunk->N202Limit) {
1208
1209 Q921TeiSendCheckRequest(trunk, tei);
1210
1211
1212 link->N202++;
1213 } else {
1214
1215 Q921ChangeState(trunk, Q921_STATE_STOPPED, tei);
1216
1217
1218 memset(link, 0, sizeof(struct Q921_Link));
1219
1220
1221 trunk->tei_map[tei] = 0;
1222 }
1223 }
1224
1225 #ifdef __UNUSED_FOR_NOW__
1226 static void Q921TM01TimerExpire(L2TRUNK trunk, L2UCHAR tei)
1227 {
1228 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
1229 struct Q921_Link *trlink = Q921_TRUNK_CONTEXT(trunk);
1230
1231 Q921Log(trunk, Q921_LOG_DEBUG, "TM01 expired for TEI %d (trunk TEI: %d)\n", tei, trlink->tei);
1232
1233
1234 Q921TM01TimerReset(trunk, tei);
1235
1236 switch(link->state) {
1237 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
1238 case Q921_STATE_TIMER_RECOVERY:
1239
1240
1241
1242 #if 0
1243
1244 Q921SendDISC(trunk, trunk->sapi, Q921_COMMAND(trunk), tei, 1);
1245
1246
1247 MFIFOClear(link->IFrameQueue);
1248
1249
1250 Q921ChangeState(trunk, Q921_STATE_AWAITING_RELEASE, tei);
1251 #endif
1252 break;
1253
1254 default:
1255 break;
1256 }
1257 }
1258 #endif
1259
1260
1261
1262
1263 void Q921TimerTick(L2TRUNK trunk)
1264 {
1265 struct Q921_Link *link;
1266 L2ULONG tNow = Q921GetTime();
1267 int numlinks = Q921_IS_PTMP_NT(trunk) ? Q921_TEI_MAX : 1;
1268 int x;
1269
1270 for(x = 0; x <= numlinks; x++) {
1271 link = Q921_LINK_CONTEXT(trunk, x);
1272
1273
1274 if(link->state == Q921_STATE_STOPPED)
1275 continue;
1276
1277 if (link->T200 && tNow > link->T200) {
1278 Q921T200TimerExpire(trunk, link->tei);
1279 }
1280 if (link->T203 && tNow > link->T203) {
1281 Q921T203TimerExpire(trunk, link->tei);
1282 }
1283
1284 if(Q921_IS_PTMP_NT(trunk) && link->tei) {
1285 if (link->T201 && tNow > link->T201) {
1286 Q921T201TimerExpire(trunk, link->tei);
1287 }
1288 }
1289
1290 if(!Q921_IS_PTMP_NT(trunk)) {
1291 if (trunk->T202 && tNow > trunk->T202) {
1292 Q921T202TimerExpire(trunk);
1293 }
1294 }
1295
1296
1297 Q921SendQueuedIFrame(trunk, link->tei);
1298
1299
1300 Q921AcknowledgePending(trunk, link->tei);
1301 }
1302
1303 }
1304
1305 void Q921SetGetTimeCB(L2ULONG (*callback)(void))
1306 {
1307 Q921GetTimeProc = callback;
1308 }
1309
1310
1311
1312
1313
1314
1315
1316
1317
1318
1319
1320
1321
1322
1323
1324
1325
1326
1327
1328
1329 int Q921QueueHDLCFrame(L2TRUNK trunk, L2UCHAR *b, L2INT size)
1330 {
1331 return MFIFOWriteMes(trunk->HDLCInQueue, b, size);
1332 }
1333
1334
1335
1336
1337
1338
1339 static int Q921EnqueueI(L2TRUNK trunk, L2UCHAR Sapi, char cr, L2UCHAR Tei, char pf, L2UCHAR *mes, L2INT size)
1340 {
1341 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, Tei);
1342
1343
1344 mes[trunk->Q921HeaderSpace+0] = ((Sapi << 2) & 0xfc) | ((cr << 1) & 0x02);
1345 mes[trunk->Q921HeaderSpace+1] = (Tei << 1) | 0x01;
1346 mes[trunk->Q921HeaderSpace+2] = 0x00;
1347 mes[trunk->Q921HeaderSpace+3] = (pf & 0x01);
1348
1349 Q921Log(trunk, Q921_LOG_DEBUG, "Enqueueing I frame for TEI %d [%d]\n", link->tei, Tei);
1350
1351
1352 MFIFOWriteMes(link->IFrameQueue, mes, size);
1353
1354
1355 Q921SendQueuedIFrame(trunk, link->tei);
1356
1357 return 1;
1358 }
1359
1360
1361
1362
1363
1364 static int Q921SendQueuedIFrame(L2TRUNK trunk, L2UCHAR tei)
1365 {
1366 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
1367
1368 L2INT size = 0;
1369 L2UCHAR *mes;
1370
1371 if(MFIFOGetMesCount(link->IFrameQueue) == 0) {
1372 return 0;
1373 }
1374
1375
1376 if(link->state != Q921_STATE_MULTIPLE_FRAME_ESTABLISHED) {
1377 return 0;
1378 }
1379
1380
1381 if(Q921_CHECK_FLAG(link, Q921_FLAG_PEER_RECV_BUSY)) {
1382 return 0;
1383 }
1384
1385
1386 if(link->vs == ((link->va + trunk->k) % 128)) {
1387 Q921Log(trunk, Q921_LOG_WARNING, "Maximum number (%d) of outstanding I frames reached for TEI %d\n", trunk->k, tei);
1388 return 0;
1389 }
1390
1391 mes = MFIFOGetMesPtr(link->IFrameQueue, &size);
1392 if(mes) {
1393
1394 mes[trunk->Q921HeaderSpace+2] = link->vs << 1;
1395 mes[trunk->Q921HeaderSpace+3] |= link->vr << 1;
1396
1397 if(MFIFOGetMesCount(link->IFrameQueue) == 0) {
1398
1399 }
1400
1401
1402 Q921Tx21Proc(trunk, mes, size);
1403
1404
1405 Q921_INC_COUNTER(link->vs);
1406
1407
1408 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
1409
1410
1411 if(!link->T200) {
1412
1413 Q921T200TimerStart(trunk, tei);
1414 Q921T203TimerStop(trunk, tei);
1415 }
1416
1417
1418 MFIFOWriteMesOverwrite(link->IFrameResendQueue, mes, size);
1419
1420
1421 MFIFOKillNext(link->IFrameQueue);
1422
1423
1424 if(Q921_IS_NT(trunk)) {
1425 Q921TM01TimerReset(trunk, tei);
1426 }
1427
1428
1429 return 1;
1430 }
1431
1432 return 0;
1433 }
1434
1435
1436
1437
1438
1439 static int Q921SendS(L2TRUNK trunk, L2UCHAR Sapi, char cr, L2UCHAR Tei, char pf, L2UCHAR sv, L2UCHAR *mes, L2INT size)
1440 {
1441 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, Tei);
1442
1443 if(!Q921_IS_READY(link)) {
1444
1445 Q921Log(trunk, Q921_LOG_DEBUG, "Link not ready, discarding S frame for TEI %d\n", Tei);
1446 return 0;
1447 }
1448
1449
1450 mes[trunk->Q921HeaderSpace+0] = ((Sapi << 2) & 0xfc) | ((cr << 1) & 0x02);
1451 mes[trunk->Q921HeaderSpace+1] = (Tei << 1) | 0x01;
1452 mes[trunk->Q921HeaderSpace+2] = ((sv << 2) & 0x0c) | 0x01;
1453 mes[trunk->Q921HeaderSpace+3] = (link->vr << 1) | (pf & 0x01);
1454
1455 return Q921Tx21Proc(trunk, mes, size);
1456 }
1457
1458
1459
1460
1461
1462
1463 static int Q921SendU(L2TRUNK trunk, L2UCHAR Sapi, char cr, L2UCHAR Tei, char pf, L2UCHAR m, L2UCHAR *mes, L2INT size)
1464 {
1465 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, Tei);
1466
1467
1468 mes[trunk->Q921HeaderSpace+0] = ((Sapi << 2) & 0xfc) | ((cr << 1) & 0x02);
1469 mes[trunk->Q921HeaderSpace+1] = (Tei << 1) | 0x01;
1470 mes[trunk->Q921HeaderSpace+2] = ((m << 3) & 0xe0) | ((pf << 4) & 0x10) | ((m << 2) & 0x0c) | 0x03;
1471
1472
1473 if(m == 0x00 && Sapi != Q921_SAPI_TEI && link->state < Q921_STATE_TEI_ASSIGNED) {
1474
1475
1476 MFIFOWriteMes(link->UIFrameQueue, mes, size);
1477
1478 Q921Log(trunk, Q921_LOG_DEBUG, "Link not ready, UI Frame of size %d bytes queued for TEI %d\n", size, Tei);
1479 return 1;
1480 }
1481
1482 return Q921Tx21Proc(trunk, mes, size);
1483 }
1484
1485
1486
1487
1488 int Q921Rx32(L2TRUNK trunk, Q921DLMsg_t ind, L2UCHAR tei, L2UCHAR * Mes, L2INT Size)
1489 {
1490 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
1491 L2INT res = 0;
1492
1493 Q921Log(trunk, Q921_LOG_DEBUG, "Got frame from Q.931, type: %d, tei: %d, size: %d\n", ind, tei, Size);
1494
1495 switch(ind) {
1496 case Q921_DL_ESTABLISH:
1497
1498
1499
1500 switch(link->state) {
1501 case Q921_STATE_TEI_ASSIGNED:
1502 if(!Q921_IS_NT(trunk)) {
1503
1504 Q921EstablishDataLink(trunk, link->tei);
1505
1506
1507 Q921_SET_FLAG(link, Q921_FLAG_L3_INITIATED);
1508
1509
1510 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, link->tei);
1511 }
1512 break;
1513
1514 case Q921_STATE_AWAITING_ESTABLISHMENT:
1515 if(!Q921_IS_NT(trunk)) {
1516
1517 MFIFOClear(link->IFrameQueue);
1518
1519
1520 Q921_SET_FLAG(link, Q921_FLAG_L3_INITIATED);
1521 }
1522 break;
1523
1524 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
1525 case Q921_STATE_TIMER_RECOVERY:
1526 if(!Q921_IS_NT(trunk)) {
1527
1528 MFIFOClear(link->IFrameQueue);
1529
1530
1531 Q921EstablishDataLink(trunk, link->tei);
1532
1533
1534 Q921_SET_FLAG(link, Q921_FLAG_L3_INITIATED);
1535
1536
1537 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, link->tei);
1538 }
1539 break;
1540
1541 default:
1542 break;
1543 }
1544 break;
1545
1546 case Q921_DL_RELEASE:
1547 switch(link->state) {
1548 case Q921_STATE_TEI_ASSIGNED:
1549
1550 Q921Tx23Proc(trunk, Q921_DL_RELEASE, tei, NULL, 0);
1551 break;
1552
1553 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
1554 case Q921_STATE_TIMER_RECOVERY:
1555 if(!Q921_IS_NT(trunk)) {
1556
1557 MFIFOClear(link->IFrameQueue);
1558
1559
1560 link->N200 = 0;
1561
1562
1563 Q921SendDISC(trunk, trunk->sapi, Q921_COMMAND(trunk), link->tei, 1);
1564
1565
1566 if(link->state == Q921_STATE_MULTIPLE_FRAME_ESTABLISHED) {
1567 Q921T203TimerStop(trunk, link->tei);
1568 }
1569 Q921T200TimerReset(trunk, link->tei);
1570
1571
1572 Q921ChangeState(trunk, Q921_STATE_AWAITING_RELEASE, link->tei);
1573 }
1574 break;
1575
1576 default:
1577 break;
1578 }
1579 break;
1580
1581 case Q921_DL_DATA:
1582 res = Q921EnqueueI(trunk,
1583 trunk->sapi,
1584 Q921_COMMAND(trunk),
1585 link->tei,
1586 0,
1587 Mes,
1588 Size);
1589
1590 if(link->state < Q921_STATE_MULTIPLE_FRAME_ESTABLISHED) {
1591
1592
1593
1594 Q921EstablishDataLink(trunk, link->tei);
1595
1596
1597 Q921_SET_FLAG(link, Q921_FLAG_L3_INITIATED);
1598
1599
1600 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, link->tei);
1601 }
1602 break;
1603
1604 case Q921_DL_UNIT_DATA:
1605 res = Q921SendUN(trunk,
1606 trunk->sapi,
1607 Q921_COMMAND(trunk),
1608 Q921_TEI_BCAST,
1609 0,
1610 Mes,
1611 Size);
1612
1613 break;
1614
1615 default:
1616 break;
1617 }
1618
1619 return res;
1620 }
1621
1622
1623
1624
1625
1626
1627
1628
1629
1630
1631
1632
1633
1634
1635
1636
1637 static int Q921SendRR(L2TRUNK trunk, int Sapi, int cr, int Tei, int pf)
1638 {
1639 L2UCHAR mes[25];
1640
1641 return Q921SendS(trunk, Sapi, cr, Tei, pf, 0x00, mes, trunk->Q921HeaderSpace+4);
1642 }
1643
1644
1645
1646
1647
1648
1649
1650
1651
1652
1653
1654
1655
1656
1657
1658
1659 static int Q921SendRNR(L2TRUNK trunk, int Sapi, int cr, int Tei, int pf)
1660 {
1661 L2UCHAR mes[25];
1662
1663 return Q921SendS(trunk, Sapi, cr, Tei, pf, 0x01, mes, trunk->Q921HeaderSpace+4);
1664 }
1665
1666
1667
1668
1669
1670
1671
1672
1673
1674
1675
1676
1677
1678
1679
1680
1681 static int Q921SendREJ(L2TRUNK trunk, int Sapi, int cr, int Tei, int pf)
1682 {
1683 L2UCHAR mes[25];
1684
1685 return Q921SendS(trunk, Sapi, cr, Tei, pf, 0x03, mes, trunk->Q921HeaderSpace+4);
1686 }
1687
1688
1689
1690
1691
1692
1693
1694
1695
1696
1697
1698
1699
1700
1701
1702
1703 static int Q921SendSABME(L2TRUNK trunk, int Sapi, int cr, int Tei, int pf)
1704 {
1705 L2UCHAR mes[25];
1706
1707 return Q921SendU(trunk, Sapi, cr, Tei, pf, 0x0f, mes, trunk->Q921HeaderSpace+3);
1708 }
1709
1710
1711
1712
1713
1714
1715
1716
1717 int Q921Start(L2TRUNK trunk)
1718 {
1719 int x, numlinks = Q921_IS_PTMP_NT(trunk) ? Q921_TEI_MAX : 1;
1720 struct Q921_Link *link = Q921_TRUNK_CONTEXT(trunk);
1721
1722 if(trunk->initialized != INITIALIZED_MAGIC)
1723 return 0;
1724
1725 memset(trunk->context, 0, numlinks * sizeof(struct Q921_Link));
1726
1727
1728 for(x = 0; x <= numlinks; x++) {
1729 link = Q921_LINK_CONTEXT(trunk, x);
1730
1731 link->state = Q921_STATE_TEI_UNASSIGNED;
1732 link->tei = 0;
1733
1734
1735 MFIFOCreate(link->UIFrameQueue, Q921MAXHDLCSPACE, 10);
1736 MFIFOCreate(link->IFrameQueue, Q921MAXHDLCSPACE, 10);
1737 MFIFOCreate(link->IFrameResendQueue, Q921MAXHDLCSPACE, 10);
1738 }
1739
1740 if(Q921_IS_PTMP_TE(trunk)) {
1741 link->state = Q921_STATE_TEI_UNASSIGNED;
1742 link->tei = 0;
1743 }
1744 else if(Q921_IS_PTMP_NT(trunk)) {
1745 link = Q921_TRUNK_CONTEXT(trunk);
1746
1747 link->state = Q921_STATE_TEI_ASSIGNED;
1748 link->tei = trunk->tei;
1749
1750
1751 memset(trunk->tei_map, 0, Q921_TEI_MAX + 1);
1752 }
1753 else {
1754 link->state = Q921_STATE_TEI_ASSIGNED;
1755 link->tei = trunk->tei;
1756 }
1757
1758 Q921Log(trunk, Q921_LOG_DEBUG, "Starting trunk %p (sapi: %d, tei: %d, mode: %s %s)\n",
1759 trunk,
1760 trunk->sapi,
1761 link->tei,
1762 Q921_IS_PTMP(trunk) ? "PTMP" : "PTP",
1763 Q921_IS_TE(trunk) ? "TE" : "NT");
1764
1765 if(Q921_IS_PTP(trunk)) {
1766 Q921Log(trunk, Q921_LOG_DEBUG, "Sending SABME\n");
1767
1768 return Q921SendSABME(trunk,
1769 trunk->sapi,
1770 Q921_COMMAND(trunk),
1771 link->tei,
1772 1);
1773
1774 } else if(Q921_IS_PTMP_NT(trunk)) {
1775
1776 Q921Log(trunk, Q921_LOG_DEBUG, "Revoking all TEIs\n");
1777
1778 return Q921TeiSendRemoveRequest(trunk, Q921_TEI_BCAST);
1779 } else {
1780
1781 Q921Log(trunk, Q921_LOG_DEBUG, "Requesting TEI\n");
1782
1783 return Q921TeiSendAssignRequest(trunk);
1784 }
1785 }
1786
1787
1788
1789
1790
1791
1792
1793
1794
1795
1796 int Q921Stop(L2TRUNK trunk)
1797 {
1798 struct Q921_Link *link;
1799 int x, numlinks;
1800
1801 if(!trunk)
1802 return -1;
1803
1804 link = Q921_TRUNK_CONTEXT(trunk);
1805 numlinks = Q921_IS_PTMP_NT(trunk) ? Q921_TEI_MAX : 1;
1806
1807 if(Q921_IS_STOPPED(link))
1808 return 0;
1809
1810
1811 if(Q921_IS_PTMP_TE(trunk)) {
1812
1813 Q921TeiSendVerifyRequest(trunk);
1814
1815
1816 link->tei = 0;
1817 }
1818
1819
1820 for(x = 0; x <= numlinks; x++) {
1821 Q921T200TimerStop(trunk, x);
1822 Q921T203TimerStop(trunk, x);
1823 Q921T201TimerStop(trunk, x);
1824
1825
1826 Q921ChangeState(trunk, Q921_STATE_STOPPED, x);
1827
1828
1829 MFIFOClear(link->UIFrameQueue);
1830 MFIFOClear(link->IFrameQueue);
1831 MFIFOClear(link->IFrameResendQueue);
1832 }
1833 Q921T202TimerStop(trunk);
1834
1835
1836 MFIFOClear(trunk->HDLCInQueue);
1837
1838 return 0;
1839 }
1840
1841
1842
1843
1844
1845
1846
1847
1848
1849
1850
1851
1852
1853
1854
1855
1856
1857 static int Q921SendDM(L2TRUNK trunk, int Sapi, int cr, int Tei, int pf)
1858 {
1859 L2UCHAR mes[25];
1860
1861 return Q921SendU(trunk, Sapi, cr, Tei, pf, 0x03, mes, trunk->Q921HeaderSpace+3);
1862 }
1863
1864
1865
1866
1867
1868
1869
1870
1871
1872
1873
1874
1875
1876
1877
1878
1879 static int Q921SendDISC(L2TRUNK trunk, int Sapi, int cr, int Tei, int pf)
1880 {
1881 L2UCHAR mes[25];
1882
1883 return Q921SendU(trunk, Sapi, cr, Tei, pf, 0x08, mes, trunk->Q921HeaderSpace+3);
1884 }
1885
1886
1887
1888
1889
1890
1891
1892
1893
1894
1895
1896
1897
1898
1899
1900
1901 static int Q921SendUA(L2TRUNK trunk, int Sapi, int cr, int Tei, int pf)
1902 {
1903 L2UCHAR mes[25];
1904
1905 return Q921SendU(trunk, Sapi, cr, Tei, pf, 0x0c, mes, trunk->Q921HeaderSpace+3);
1906 }
1907
1908 static int Q921SendUN(L2TRUNK trunk, int Sapi, int cr, int Tei, int pf, L2UCHAR *mes, L2INT size)
1909 {
1910 return Q921SendU(trunk, Sapi, cr, Tei, pf, 0x00, mes, size+trunk->Q921HeaderSpace+3);
1911 }
1912
1913
1914
1915
1916
1917
1918
1919
1920
1921
1922 static int Q921ProcSABME(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
1923 {
1924 L2UCHAR pf = (mes[2] & 0x10) >> 4;
1925 L2UCHAR tei = (mes[1] & 0xfe) >> 1;
1926 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
1927
1928 switch(link->state) {
1929 case Q921_STATE_TEI_ASSIGNED:
1930
1931 Q921SendUA(trunk,
1932 trunk->sapi,
1933 Q921_RESPONSE(trunk),
1934 tei, pf);
1935
1936
1937 link->vr=0;
1938 link->vs=0;
1939 link->va=0;
1940
1941
1942 Q921Tx23Proc(trunk, Q921_DL_ESTABLISH, tei, NULL, 0);
1943
1944
1945 Q921T203TimerStart(trunk, tei);
1946
1947
1948 Q921ChangeState(trunk, Q921_STATE_MULTIPLE_FRAME_ESTABLISHED, tei);
1949 break;
1950
1951 case Q921_STATE_AWAITING_ESTABLISHMENT:
1952
1953 Q921SendUA(trunk,
1954 trunk->sapi,
1955 Q921_RESPONSE(trunk),
1956 tei, pf);
1957
1958
1959 break;
1960
1961 case Q921_STATE_AWAITING_RELEASE:
1962
1963 Q921SendDM(trunk,
1964 trunk->sapi,
1965 Q921_RESPONSE(trunk),
1966 tei, pf);
1967
1968
1969 break;
1970
1971 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
1972 case Q921_STATE_TIMER_RECOVERY:
1973
1974 Q921SendUA(trunk,
1975 trunk->sapi,
1976 Q921_RESPONSE(trunk),
1977 tei, pf);
1978
1979
1980 Q921ResetExceptionConditions(trunk, tei);
1981
1982
1983
1984
1985 if(link->vs != link->va) {
1986
1987 MFIFOClear(link->IFrameQueue);
1988
1989
1990 Q921Tx23Proc(trunk, Q921_DL_ESTABLISH, tei, NULL, 0);
1991 }
1992
1993
1994 link->vr=0;
1995 link->vs=0;
1996 link->va=0;
1997
1998
1999 Q921T200TimerStop(trunk, tei);
2000 Q921T203TimerStart(trunk, tei);
2001
2002
2003 if(link->state == Q921_STATE_TIMER_RECOVERY)
2004 Q921ChangeState(trunk, Q921_STATE_MULTIPLE_FRAME_ESTABLISHED, tei);
2005 break;
2006
2007 default:
2008 break;
2009 }
2010
2011 return 1;
2012 }
2013
2014
2015
2016
2017
2018
2019
2020
2021
2022
2023 static int Q921ProcDM(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
2024 {
2025 L2UCHAR pf = (mes[2] & 0x10) >> 4;
2026 L2UCHAR tei = (mes[1] & 0xfe) >> 1;
2027 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
2028
2029 switch(link->state) {
2030 case Q921_STATE_TEI_ASSIGNED:
2031 if(!pf) {
2032
2033 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2034 }
2035 break;
2036
2037 case Q921_STATE_AWAITING_ESTABLISHMENT:
2038 case Q921_STATE_AWAITING_RELEASE:
2039 if(pf) {
2040 if(link->state == Q921_STATE_AWAITING_ESTABLISHMENT) {
2041
2042 MFIFOClear(link->IFrameQueue);
2043 }
2044
2045
2046 Q921Tx23Proc(trunk, Q921_DL_RELEASE, tei, NULL, 0);
2047
2048
2049 Q921T200TimerStop(trunk, tei);
2050
2051
2052 Q921ChangeState(trunk, Q921_STATE_TEI_ASSIGNED, tei);
2053 }
2054 break;
2055
2056 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
2057 if(pf) {
2058
2059
2060
2061 } else {
2062
2063
2064
2065 Q921EstablishDataLink(trunk, tei);
2066
2067
2068 Q921_CLEAR_FLAG(link, Q921_FLAG_L3_INITIATED);
2069
2070
2071 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2072 }
2073 break;
2074
2075 case Q921_STATE_TIMER_RECOVERY:
2076 if(pf) {
2077
2078 } else {
2079
2080 }
2081
2082
2083 Q921EstablishDataLink(trunk, tei);
2084
2085
2086 Q921_CLEAR_FLAG(link, Q921_FLAG_L3_INITIATED);
2087
2088
2089 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2090 break;
2091
2092 default:
2093 break;
2094 }
2095
2096 return 1;
2097 }
2098
2099
2100
2101
2102
2103
2104
2105
2106
2107 static int Q921ProcUA(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
2108 {
2109 L2UCHAR pf = (mes[2] & 0x10) >> 4;
2110 L2UCHAR tei = (mes[1] & 0xfe) >> 1;
2111 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
2112
2113 switch(link->state) {
2114 case Q921_STATE_TEI_ASSIGNED:
2115 case Q921_STATE_TIMER_RECOVERY:
2116
2117 Q921Log(trunk, Q921_LOG_ERROR, "Received UA frame in invalid state\n");
2118 break;
2119
2120 case Q921_STATE_AWAITING_ESTABLISHMENT:
2121 if(pf) {
2122
2123 if(Q921_CHECK_FLAG(link, Q921_FLAG_L3_INITIATED)) {
2124 link->vr = 0;
2125
2126
2127 Q921Tx23Proc(trunk, Q921_DL_ESTABLISH_CONFIRM, tei, NULL, 0);
2128
2129 } else if(link->vs != link->va) {
2130
2131
2132 MFIFOClear(link->IFrameQueue);
2133
2134
2135 Q921Tx23Proc(trunk, Q921_DL_ESTABLISH, tei, NULL, 0);
2136 }
2137
2138
2139 Q921T200TimerStop(trunk, tei);
2140 Q921T203TimerStart(trunk, tei);
2141
2142 link->vs = 0;
2143 link->va = 0;
2144
2145
2146 Q921ChangeState(trunk, Q921_STATE_MULTIPLE_FRAME_ESTABLISHED, tei);
2147 } else {
2148
2149 Q921Log(trunk, Q921_LOG_ERROR, "Received UA frame is not a response to a request\n");
2150
2151
2152 }
2153 break;
2154
2155 case Q921_STATE_AWAITING_RELEASE:
2156 if(pf) {
2157
2158 Q921Tx23Proc(trunk, Q921_DL_RELEASE_CONFIRM, tei, NULL, 0);
2159
2160
2161 Q921T200TimerStop(trunk, tei);
2162
2163
2164 Q921ChangeState(trunk, Q921_STATE_TEI_ASSIGNED, tei);
2165 } else {
2166
2167 Q921Log(trunk, Q921_LOG_ERROR, "Received UA frame is not a response to a request\n");
2168
2169
2170 }
2171 break;
2172
2173 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
2174
2175 Q921Log(trunk, Q921_LOG_ERROR, "Received UA frame in invalid state\n");
2176
2177
2178 break;
2179
2180 default:
2181 break;
2182 }
2183
2184 return 1;
2185 }
2186
2187
2188
2189
2190
2191
2192
2193
2194
2195
2196 static int Q921ProcDISC(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
2197 {
2198 L2UCHAR pf = (mes[2] & 0x10) >> 4;
2199 L2UCHAR tei = (mes[1] & 0xfe) >> 1;
2200 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
2201
2202 switch(link->state) {
2203 case Q921_STATE_TEI_ASSIGNED:
2204 case Q921_STATE_AWAITING_ESTABLISHMENT:
2205
2206 Q921SendDM(trunk,
2207 trunk->sapi,
2208 Q921_RESPONSE(trunk),
2209 tei, pf);
2210
2211
2212 break;
2213
2214 case Q921_STATE_AWAITING_RELEASE:
2215 Q921SendUA(trunk,
2216 trunk->sapi,
2217 Q921_RESPONSE(trunk),
2218 tei, pf);
2219
2220
2221 break;
2222
2223 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
2224 case Q921_STATE_TIMER_RECOVERY:
2225
2226 MFIFOClear(link->IFrameQueue);
2227
2228
2229 Q921SendUA(trunk,
2230 trunk->sapi,
2231 Q921_RESPONSE(trunk),
2232 tei, pf);
2233
2234
2235 Q921Tx23Proc(trunk, Q921_DL_RELEASE, tei, NULL, 0);
2236
2237
2238 Q921T200TimerStop(trunk, tei);
2239
2240 if(link->state == Q921_STATE_MULTIPLE_FRAME_ESTABLISHED) {
2241
2242 Q921T203TimerStop(trunk, tei);
2243 }
2244
2245
2246 Q921ChangeState(trunk, Q921_STATE_TEI_ASSIGNED, tei);
2247 break;
2248
2249 default:
2250 Q921Log(trunk, Q921_LOG_ERROR, "Invalid DISC received in state \"%s\" (%d)", Q921State2Name(link->state), link->state);
2251 break;
2252 }
2253
2254 return 1;
2255 }
2256
2257
2258
2259
2260
2261
2262
2263
2264
2265
2266 static int Q921ProcRR(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
2267 {
2268 L2UCHAR cr = (mes[0] & 0x02) >> 1;
2269 L2UCHAR pf = mes[3] & 0x01;
2270 L2UCHAR nr = (mes[3] >> 1);
2271
2272 L2UCHAR tei = (mes[1] & 0xfe) >> 1;
2273 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
2274
2275 switch(link->state) {
2276 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
2277
2278 Q921_CLEAR_FLAG(link, Q921_FLAG_PEER_RECV_BUSY);
2279
2280 if (Q921_IS_COMMAND(trunk, cr)) {
2281 if(pf) {
2282
2283 Q921SendEnquiryResponse(trunk, tei);
2284 }
2285 } else {
2286 if(pf) {
2287
2288 }
2289 }
2290
2291
2292 if(link->va <= nr && nr <= link->vs) {
2293
2294 if(nr == link->vs) {
2295
2296 link->va = nr;
2297
2298
2299 Q921T200TimerStop(trunk, tei);
2300 Q921T203TimerReset(trunk, tei);
2301
2302 } else if(nr == link->va) {
2303
2304
2305
2306 } else {
2307
2308 link->va = nr;
2309
2310
2311 Q921T200TimerReset(trunk, tei);
2312 }
2313
2314
2315 } else {
2316
2317 Q921NrErrorRecovery(trunk, tei);
2318
2319
2320 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2321 }
2322 break;
2323
2324 case Q921_STATE_TIMER_RECOVERY:
2325
2326 Q921_CLEAR_FLAG(link, Q921_FLAG_PEER_RECV_BUSY);
2327
2328
2329 if(Q921_IS_COMMAND(trunk, cr) && pf) {
2330
2331 Q921SendEnquiryResponse(trunk, tei);
2332 }
2333
2334
2335 if(link->va <= nr && nr <= link->vs) {
2336
2337 link->va = nr;
2338
2339 if(!Q921_IS_COMMAND(trunk, cr) && pf) {
2340
2341 Q921T200TimerStop(trunk, tei);
2342 Q921T203TimerStart(trunk, tei);
2343
2344
2345 Q921InvokeRetransmission(trunk, tei, nr);
2346
2347
2348 Q921ChangeState(trunk, Q921_STATE_MULTIPLE_FRAME_ESTABLISHED, tei);
2349 }
2350
2351 } else {
2352
2353 Q921NrErrorRecovery(trunk, tei);
2354
2355
2356 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2357 }
2358 break;
2359
2360 default:
2361 break;
2362 }
2363 return 1;
2364 }
2365
2366
2367
2368
2369
2370
2371
2372
2373
2374
2375 static int Q921ProcREJ(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
2376 {
2377 L2UCHAR cr = (mes[0] & 0x02) >> 1;
2378 L2UCHAR pf = mes[3] & 0x01;
2379 L2UCHAR nr = (mes[3] >> 1);
2380
2381 L2UCHAR tei = (mes[1] & 0xfe) >> 1;
2382 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
2383
2384 switch(link->state) {
2385 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
2386
2387 Q921_CLEAR_FLAG(link, Q921_FLAG_PEER_RECV_BUSY);
2388
2389
2390 if(Q921_IS_COMMAND(trunk, cr)) {
2391 if(pf) {
2392
2393 Q921SendEnquiryResponse(trunk, tei);
2394 }
2395 } else {
2396 if(pf) {
2397
2398 }
2399 }
2400
2401
2402 if(link->va <= nr && nr <= link->vs) {
2403
2404
2405 link->va = nr;
2406
2407
2408 Q921T200TimerStop(trunk, tei);
2409 Q921T203TimerStart(trunk, tei);
2410
2411
2412 Q921InvokeRetransmission(trunk, tei, nr);
2413
2414
2415 } else {
2416
2417 Q921NrErrorRecovery(trunk, tei);
2418
2419
2420 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2421 }
2422 break;
2423
2424 case Q921_STATE_TIMER_RECOVERY:
2425
2426 Q921_CLEAR_FLAG(link, Q921_FLAG_PEER_RECV_BUSY);
2427
2428
2429 if(Q921_IS_COMMAND(trunk, cr) && pf) {
2430
2431 Q921SendEnquiryResponse(trunk, tei);
2432 }
2433
2434
2435 if(link->va <= nr && nr <= link->vs) {
2436
2437
2438 link->va = nr;
2439
2440 if(!Q921_IS_COMMAND(trunk, cr) && pf) {
2441
2442 Q921T200TimerStop(trunk, tei);
2443 Q921T203TimerStart(trunk, tei);
2444
2445
2446 Q921InvokeRetransmission(trunk, tei, nr);
2447
2448
2449 Q921ChangeState(trunk, Q921_STATE_MULTIPLE_FRAME_ESTABLISHED, tei);
2450 }
2451
2452 } else {
2453
2454 Q921NrErrorRecovery(trunk, tei);
2455
2456
2457 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2458 }
2459 break;
2460
2461 default:
2462 break;
2463 }
2464
2465 return 1;
2466 }
2467
2468
2469
2470
2471
2472
2473
2474
2475
2476
2477 static int Q921ProcRNR(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
2478 {
2479 L2UCHAR cr = (mes[0] & 0x02) >> 1;
2480 L2UCHAR pf = mes[3] & 0x01;
2481 L2UCHAR nr = (mes[3] >> 1);
2482
2483 L2UCHAR tei = (mes[1] & 0xfe) >> 1;
2484 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
2485
2486 switch(link->state) {
2487 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
2488
2489 Q921_SET_FLAG(link, Q921_FLAG_PEER_RECV_BUSY);
2490
2491
2492 if(Q921_IS_COMMAND(trunk, cr)) {
2493 if(pf) {
2494
2495 Q921SendEnquiryResponse(trunk, tei);
2496 }
2497 } else {
2498 if(pf) {
2499
2500 }
2501 }
2502
2503
2504 if(link->va <= nr && nr <= link->vs) {
2505
2506
2507 link->va = nr;
2508
2509
2510 Q921T200TimerReset(trunk, tei);
2511 Q921T203TimerStop(trunk, tei);
2512
2513
2514 } else {
2515
2516 Q921NrErrorRecovery(trunk, tei);
2517
2518
2519 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2520 }
2521 break;
2522
2523 case Q921_STATE_TIMER_RECOVERY:
2524
2525 Q921_SET_FLAG(link, Q921_FLAG_PEER_RECV_BUSY);
2526
2527
2528 if(Q921_IS_COMMAND(trunk, cr) && pf) {
2529
2530 Q921SendEnquiryResponse(trunk, tei);
2531 }
2532
2533
2534 if(link->va <= nr && nr <= link->vs) {
2535
2536
2537 link->va = nr;
2538
2539 if(!Q921_IS_COMMAND(trunk, cr) && pf) {
2540
2541 Q921T200TimerReset(trunk, tei);
2542
2543
2544 Q921InvokeRetransmission(trunk, tei, nr);
2545
2546
2547 Q921ChangeState(trunk, Q921_STATE_MULTIPLE_FRAME_ESTABLISHED, tei);
2548 }
2549
2550 } else {
2551
2552 Q921NrErrorRecovery(trunk, tei);
2553
2554
2555 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2556 }
2557 break;
2558
2559 default:
2560 break;
2561 }
2562
2563 return 1;
2564 }
2565
2566 #if 0
2567 static int Q921SetReceiverBusy(L2TRUNK trunk)
2568 {
2569 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
2570
2571 switch(link->state) {
2572 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
2573 if(!Q921_CHECK_FLAG(link, Q921_FLAG_RECV_BUSY)) {
2574
2575 Q921_SET_FLAG(link, Q921_FLAG_RECV_BUSY);
2576
2577
2578 Q921SendRR(trunk, trunk->sapi, Q921_RESPONSE(trunk), link->tei, 0);
2579
2580
2581 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
2582 }
2583 break;
2584
2585 case Q921_STATE_TIMER_RECOVERY:
2586 if(!Q921_CHECK_FLAG(link, Q921_FLAG_RECV_BUSY)) {
2587
2588 Q921_SET_FLAG(link, Q921_FLAG_RECV_BUSY);
2589
2590
2591 Q921SendRNR(trunk, trunk->sapi, Q921_RESPONSE(trunk), link->tei, 0);
2592
2593
2594 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
2595 }
2596 break;
2597
2598 default:
2599 break;
2600 }
2601
2602 return 0;
2603 }
2604
2605 static int Q921ClearReceiverBusy(L2TRUNK trunk)
2606 {
2607 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
2608
2609 switch(link->state) {
2610 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
2611 case Q921_STATE_TIMER_RECOVERY:
2612 if(Q921_CHECK_FLAG(link, Q921_FLAG_RECV_BUSY)) {
2613
2614 Q921_CLEAR_FLAG(link, Q921_FLAG_RECV_BUSY);
2615
2616
2617 Q921SendRNR(trunk, trunk->sapi, Q921_RESPONSE(trunk), link->tei, 0);
2618
2619
2620 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
2621 }
2622 break;
2623
2624 default:
2625 break;
2626 }
2627
2628 return 0;
2629 }
2630 #endif
2631
2632 static int Q921ProcIFrame(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
2633 {
2634
2635
2636
2637 L2UCHAR tei = (mes[1] & 0xfe) >> 1;
2638 L2UCHAR pf = mes[3] & 0x01;
2639 L2UCHAR nr = mes[3] >> 1;
2640 L2UCHAR ns = mes[2] >> 1;
2641 L2UCHAR discard = 0;
2642 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
2643
2644
2645 if(link->state < Q921_STATE_MULTIPLE_FRAME_ESTABLISHED) {
2646 Q921Log(trunk, Q921_LOG_NOTICE, "I frame in invalid state ignored\n");
2647 return 0;
2648 }
2649
2650
2651 if(Q921_CHECK_FLAG(link, Q921_FLAG_RECV_BUSY)) {
2652
2653 discard = 1;
2654
2655 if(pf) {
2656
2657 Q921SendRNR(trunk, trunk->sapi, Q921_RESPONSE(trunk), tei, 1);
2658
2659
2660 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
2661 }
2662 }
2663 else {
2664 if(ns != link->vr) {
2665
2666 discard = 1;
2667
2668 if(Q921_CHECK_FLAG(link, Q921_FLAG_REJECT) && pf) {
2669
2670
2671 Q921SendRR(trunk, trunk->sapi, Q921_RESPONSE(trunk), tei, 1);
2672
2673
2674 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
2675 }
2676 else if(!Q921_CHECK_FLAG(link, Q921_FLAG_REJECT)){
2677
2678
2679 Q921_SET_FLAG(link, Q921_FLAG_REJECT);
2680
2681
2682 Q921SendREJ(trunk, trunk->sapi, Q921_RESPONSE(trunk), tei, pf);
2683
2684
2685 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
2686 }
2687 }
2688 else {
2689
2690 Q921_INC_COUNTER(link->vr);
2691
2692
2693 Q921_CLEAR_FLAG(link, Q921_FLAG_REJECT);
2694
2695
2696 Q921Tx23Proc(trunk, Q921_DL_DATA, tei, mes, size);
2697
2698 if(pf) {
2699
2700 Q921SendRR(trunk, trunk->sapi, Q921_RESPONSE(trunk), tei, 1);
2701
2702
2703 Q921_CLEAR_FLAG(link, Q921_FLAG_ACK_PENDING);
2704 }
2705 else if(!Q921_CHECK_FLAG(link, Q921_FLAG_ACK_PENDING)) {
2706
2707
2708
2709 Q921SendRR(trunk, trunk->sapi, Q921_RESPONSE(trunk), tei, 0);
2710
2711
2712 Q921_SET_FLAG(link, Q921_FLAG_ACK_PENDING);
2713 }
2714 }
2715 }
2716
2717
2718 switch(link->state) {
2719 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
2720 if(link->va <= nr && nr <= link->vs) {
2721 if(Q921_CHECK_FLAG(link, Q921_FLAG_PEER_RECV_BUSY)) {
2722 link->va = nr;
2723 }
2724 else if(nr == link->vs) {
2725
2726 link->va = nr;
2727
2728
2729 Q921T200TimerStop(trunk, tei);
2730 Q921T203TimerReset(trunk, tei);
2731 }
2732 else if(nr != link->va) {
2733
2734 link->va = nr;
2735
2736
2737 Q921T200TimerReset(trunk, tei);
2738 }
2739
2740
2741 if(Q921_IS_NT(trunk)) {
2742 Q921TM01TimerReset(trunk, tei);
2743 }
2744 }
2745 else {
2746
2747 Q921NrErrorRecovery(trunk, tei);
2748
2749
2750 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2751 }
2752 break;
2753
2754 case Q921_STATE_TIMER_RECOVERY:
2755 if(link->va <= nr && nr <= link->vs) {
2756
2757 link->va = nr;
2758
2759
2760 if(Q921_IS_NT(trunk)) {
2761 Q921TM01TimerReset(trunk, tei);
2762 }
2763 }
2764 else {
2765
2766 Q921NrErrorRecovery(trunk, tei);
2767
2768
2769 Q921ChangeState(trunk, Q921_STATE_AWAITING_ESTABLISHMENT, tei);
2770 }
2771 break;
2772
2773 default:
2774 break;
2775 }
2776
2777 return 0;
2778 }
2779
2780
2781 static int Q921ProcSFrame(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
2782 {
2783 L2UCHAR sv = (mes[2] & 0x0c) >> 2;
2784
2785
2786 L2INT res = -1;
2787
2788 switch(sv) {
2789 case 0x00:
2790 res = Q921ProcRR(trunk, mes, size);
2791 break;
2792
2793 case 0x02:
2794 res = Q921ProcRNR(trunk, mes, size);
2795 break;
2796
2797 case 0x04:
2798 res = Q921ProcREJ(trunk, mes, size);
2799 break;
2800
2801 default:
2802 Q921Log(trunk, Q921_LOG_ERROR, "Invalid S frame type %d\n", sv);
2803 break;
2804 }
2805
2806 return res;
2807 }
2808
2809
2810
2811 static int Q921ProcUFrame(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
2812 {
2813 L2UCHAR m = (mes[2] & 0xe0) >> 3 | (mes[2] & 0x0c) >> 2;
2814
2815 L2INT res = -1;
2816
2817 switch(m) {
2818 case 0x00:
2819 if(mes[3] == Q921_LAYER_ENT_ID_TEI)
2820 {
2821 if(!Q921_IS_PTMP(trunk)) {
2822
2823 return res;
2824 }
2825
2826 switch(mes[6]) {
2827 case Q921_TEI_ID_REQUEST:
2828 res = Q921TeiProcAssignRequest(trunk, mes, size);
2829 break;
2830
2831 case Q921_TEI_ID_ASSIGNED:
2832 case Q921_TEI_ID_DENIED:
2833 res = Q921TeiProcAssignResponse(trunk, mes, size);
2834 break;
2835
2836 case Q921_TEI_ID_CHECKREQ:
2837 res = Q921TeiProcCheckRequest(trunk, mes, size);
2838 break;
2839
2840 case Q921_TEI_ID_CHECKRESP:
2841 res = Q921TeiProcCheckResponse(trunk, mes, size);
2842 break;
2843
2844 case Q921_TEI_ID_REMOVE:
2845 res = Q921TeiProcRemoveRequest(trunk, mes, size);
2846 break;
2847
2848 case Q921_TEI_ID_VERIFY:
2849 res = Q921TeiProcVerifyRequest(trunk, mes, size);
2850 break;
2851
2852 default:
2853 Q921Log(trunk, Q921_LOG_ERROR, "Invalid UN message from TEI management/endpoint\n");
2854 break;
2855 }
2856 }
2857 else if(mes[3] == Q921_LAYER_ENT_ID_Q931) {
2858
2859 Q921Log(trunk, Q921_LOG_DEBUG, "UI Frame for Layer 3 received\n");
2860
2861 res = Q921Tx23Proc(trunk, Q921_DL_UNIT_DATA, 0, mes, size);
2862 }
2863 break;
2864
2865 case 0x03:
2866 res = Q921ProcDM(trunk, mes, size);
2867 break;
2868
2869 case 0x08:
2870 res = Q921ProcDISC(trunk, mes, size);
2871 break;
2872
2873 case 0x0c:
2874 res = Q921ProcUA(trunk, mes, size);
2875 break;
2876
2877 case 0x0f:
2878 res = Q921ProcSABME(trunk, mes, size);
2879 break;
2880
2881 case 0x11:
2882 case 0x17:
2883 res = 0;
2884 break;
2885
2886 default:
2887 Q921Log(trunk, Q921_LOG_ERROR, "Invalid U frame type: %d\n", m);
2888 break;
2889 }
2890
2891 return res;
2892 }
2893
2894
2895
2896
2897
2898
2899
2900
2901
2902
2903
2904
2905
2906
2907
2908
2909
2910
2911
2912
2913 int Q921Rx12(L2TRUNK trunk)
2914 {
2915 L2INT size;
2916 L2UCHAR *smes = MFIFOGetMesPtr(trunk->HDLCInQueue, &size);
2917
2918 if(smes)
2919 {
2920 struct Q921_Link *link;
2921 L2UCHAR sapi, tei;
2922 L2UCHAR *mes;
2923 L2INT rs;
2924
2925 rs = size - trunk->Q921HeaderSpace;
2926 mes = &smes[trunk->Q921HeaderSpace];
2927
2928 Q921LogMesg(trunk, Q921_LOG_DEBUG, 1, mes, rs, "New packet received (%d bytes)", rs);
2929
2930
2931 sapi = (mes[0] & 0xfc) >> 2;
2932 tei = (mes[1] & 0xfe) >> 1;
2933 link = Q921_LINK_CONTEXT(trunk, tei);
2934
2935 if(Q921_IS_PTMP_TE(trunk) && (
2936 (link->state >= Q921_STATE_TEI_ASSIGNED && tei != link->tei && tei != Q921_TEI_BCAST) ||
2937 (link->state == Q921_STATE_TEI_UNASSIGNED && tei != Q921_TEI_BCAST)))
2938 {
2939
2940 goto out;
2941 }
2942
2943 if((mes[2] & 0x01) == 0x00) {
2944 Q921ProcIFrame(trunk, mes, rs);
2945 }
2946 else if((mes[2] & 0x03) == 0x01) {
2947 Q921ProcSFrame(trunk, mes, rs);
2948 }
2949 else if((mes[2] & 0x03) == 0x03) {
2950 Q921ProcUFrame(trunk, mes, rs);
2951 }
2952 else {
2953 Q921Log(trunk, Q921_LOG_ERROR, "Invalid frame type: %d\n", (int)(mes[2] & 0x03));
2954
2955 }
2956
2957 out:
2958 MFIFOKillNext(trunk->HDLCInQueue);
2959
2960 return 1;
2961 }
2962
2963 return 0;
2964 }
2965
2966
2967
2968
2969
2970
2971
2972
2973
2974
2975
2976
2977
2978 void Q921SetLogCB(L2TRUNK trunk, Q921LogCB_t func, void *priv)
2979 {
2980 if(!trunk)
2981 return;
2982
2983 trunk->Q921LogProc = func;
2984 trunk->PrivateDataLog = priv;
2985 }
2986
2987
2988
2989
2990
2991
2992
2993
2994
2995 void Q921SetLogLevel(L2TRUNK trunk, Q921LogLevel_t level)
2996 {
2997 if(!trunk)
2998 return;
2999
3000 if (level < Q921_LOG_NONE) {
3001 level = Q921_LOG_NONE;
3002 } else if (level > Q921_LOG_DEBUG) {
3003 level = Q921_LOG_DEBUG;
3004 }
3005
3006 trunk->loglevel = level;
3007 }
3008
3009
3010
3011
3012
3013
3014
3015
3016
3017
3018
3019 static int Q921ChangeState(L2TRUNK trunk, Q921State_t state, L2UCHAR tei)
3020 {
3021 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
3022 Q921State_t oldstate = link->state;
3023 int res = 0;
3024
3025 Q921Log(trunk, Q921_LOG_DEBUG, "Changing state from \"%s\" (%d) to \"%s\" (%d) for TEI %d\n",
3026 Q921State2Name(oldstate), oldstate,
3027 Q921State2Name(state), state,
3028 tei);
3029
3030
3031
3032
3033 switch(state) {
3034 case Q921_STATE_MULTIPLE_FRAME_ESTABLISHED:
3035
3036 if(Q921_IS_NT(trunk)) {
3037 Q921TM01TimerStart(trunk, tei);
3038 }
3039 break;
3040
3041 default:
3042 break;
3043 }
3044
3045
3046
3047
3048 switch(oldstate) {
3049 case Q921_STATE_STOPPED:
3050
3051 switch(state) {
3052 case Q921_STATE_TEI_UNASSIGNED:
3053 if(Q921_IS_PTMP_TE(trunk)) {
3054 res = Q921TeiSendAssignRequest(trunk);
3055 }
3056 break;
3057
3058 case Q921_STATE_TEI_ASSIGNED:
3059 if(Q921_IS_PTMP_NT(trunk)) {
3060 res = Q921TeiSendRemoveRequest(trunk, Q921_TEI_BCAST);
3061 }
3062 break;
3063
3064 default:
3065 break;
3066 }
3067 break;
3068
3069 default:
3070 break;
3071 }
3072
3073 link->state = state;
3074
3075 Q921Log(trunk, Q921_LOG_DEBUG, "Q921ChangeState() returns %d, new state is \"%s\" (%d) for TEI %d\n", res, Q921State2Name(state), state, tei);
3076
3077 return res;
3078 }
3079
3080
3081
3082
3083
3084 static int Q921TeiSend(L2TRUNK trunk, L2UCHAR type, L2USHORT ri, L2UCHAR ai)
3085 {
3086 L2UCHAR mes[10];
3087 L2UCHAR offset = Q921_UFRAME_DATA_OFFSET(trunk);
3088
3089 mes[offset++] = Q921_LAYER_ENT_ID_TEI;
3090 mes[offset++] = (ri & 0xff00) >> 8;
3091 mes[offset++] = ri & 0xff;
3092 mes[offset++] = type;
3093 mes[offset++] = ai << 1 | 0x01;
3094
3095 return Q921SendU(trunk, Q921_SAPI_TEI, Q921_COMMAND(trunk), Q921_TEI_BCAST, 0, 0x00, mes, offset);
3096 }
3097
3098
3099
3100
3101
3102
3103
3104
3105
3106
3107 static int Q921TeiSendAssignRequest(L2TRUNK trunk)
3108 {
3109 struct Q921_Link *link = Q921_TRUNK_CONTEXT(trunk);
3110 L2INT res;
3111
3112 if (!Q921_IS_PTMP_TE(trunk))
3113 return 0;
3114
3115 #ifndef WIN32
3116 link->ri = (L2USHORT)(random() % 0xffff);
3117 #else
3118 link->ri = (L2USHORT)(rand() % 0xffff);
3119 #endif
3120
3121
3122 res = Q921TeiSend(trunk, Q921_TEI_ID_REQUEST, link->ri, Q921_TEI_BCAST);
3123
3124
3125 Q921T202TimerStart(trunk);
3126
3127 return res;
3128 }
3129
3130
3131
3132
3133
3134
3135
3136
3137
3138
3139
3140
3141 static int Q921TeiProcAssignResponse(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
3142 {
3143 struct Q921_Link *link = Q921_TRUNK_CONTEXT(trunk);
3144 L2UCHAR offset = Q921_UFRAME_DATA_OFFSET(trunk);
3145 L2USHORT ri = 0;
3146
3147 if (!Q921_IS_PTMP_TE(trunk))
3148 return 0;
3149
3150 ri = (mes[offset + 1] << 8) | mes[offset + 2];
3151
3152 if(ri != link->ri) {
3153
3154 return 0;
3155 }
3156
3157 switch(mes[offset + 3]) {
3158 case Q921_TEI_ID_ASSIGNED:
3159
3160 link->tei = mes[offset + 4] >> 1;
3161
3162 Q921Log(trunk, Q921_LOG_DEBUG, "Assigned TEI %d, setting state to TEI_ASSIGNED\n", link->tei);
3163
3164 Q921ChangeState(trunk, Q921_STATE_TEI_ASSIGNED, link->tei);
3165 break;
3166
3167 case Q921_TEI_ID_DENIED:
3168
3169 if ((mes[offset + 4] >> 1) == Q921_TEI_BCAST) {
3170
3171
3172
3173 } else {
3174
3175 }
3176
3177 Q921Log(trunk, Q921_LOG_DEBUG, "TEI assignment has been denied, reason: %s\n",
3178 ((mes[offset +4] >> 1) == Q921_TEI_BCAST) ? "No free TEIs available" : "Unknown");
3179
3180 Q921ChangeState(trunk, Q921_STATE_TEI_UNASSIGNED, link->tei);
3181 break;
3182
3183 default:
3184 return 0;
3185 }
3186
3187
3188 Q921T202TimerStop(trunk);
3189
3190 return 1;
3191 }
3192
3193
3194
3195
3196
3197
3198
3199
3200
3201
3202 static int Q921TeiSendVerifyRequest(L2TRUNK trunk)
3203 {
3204 struct Q921_Link *link = Q921_TRUNK_CONTEXT(trunk);
3205 L2INT res;
3206
3207 if (!Q921_IS_PTMP_TE(trunk))
3208 return 0;
3209
3210
3211 if (trunk->T202)
3212 return 0;
3213
3214
3215 res = Q921TeiSend(trunk, Q921_TEI_ID_VERIFY, link->ri, link->tei);
3216
3217
3218 Q921T202TimerStart(trunk);
3219
3220 return res;
3221 }
3222
3223
3224
3225
3226
3227
3228
3229
3230
3231
3232
3233
3234 static int Q921TeiProcCheckRequest(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
3235 {
3236 struct Q921_Link *link = Q921_TRUNK_CONTEXT(trunk);
3237 L2UCHAR offset = Q921_UFRAME_DATA_OFFSET(trunk);
3238 L2UCHAR tei = (mes[offset + 4] >> 1);
3239 L2INT res = 0;
3240
3241 if (!Q921_IS_PTMP_TE(trunk))
3242 return 0;
3243
3244 Q921Log(trunk, Q921_LOG_DEBUG, "Received TEI Check request for TEI %d\n", tei);
3245
3246 if (tei == Q921_TEI_BCAST || tei == link->tei) {
3247
3248
3249
3250
3251
3252 res = Q921TeiSend(trunk, Q921_TEI_ID_CHECKRESP, link->ri, link->tei);
3253
3254 Q921T202TimerStop(trunk);
3255 }
3256
3257 return res;
3258 }
3259
3260
3261
3262
3263
3264
3265
3266
3267
3268
3269
3270
3271 static int Q921TeiProcRemoveRequest(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
3272 {
3273 struct Q921_Link *link = Q921_TRUNK_CONTEXT(trunk);
3274 L2UCHAR offset = Q921_UFRAME_DATA_OFFSET(trunk);
3275 L2UCHAR tei = (mes[offset + 4] >> 1);
3276 L2INT res = 0;
3277
3278 if (!Q921_IS_PTMP_TE(trunk))
3279 return 0;
3280
3281 Q921Log(trunk, Q921_LOG_DEBUG, "Received TEI Remove request for TEI %d\n", tei);
3282
3283 if (tei == Q921_TEI_BCAST || tei == link->tei) {
3284
3285
3286
3287
3288
3289 link->tei = 0;
3290
3291
3292 Q921ChangeState(trunk, Q921_STATE_TEI_UNASSIGNED, link->tei);
3293
3294
3295 res = Q921TeiSendAssignRequest(trunk);
3296 }
3297 return res;
3298 }
3299
3300
3301
3302
3303
3304
3305
3306
3307
3308
3309
3310
3311 static int Q921TeiProcAssignRequest(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
3312 {
3313 L2UCHAR offset = Q921_UFRAME_DATA_OFFSET(trunk);
3314 L2USHORT ri = 0;
3315 L2UCHAR tei = 0;
3316
3317 if (!Q921_IS_PTMP_NT(trunk))
3318 return 0;
3319
3320 ri = (mes[offset + 1] << 8) | mes[offset + 2];
3321 tei = mes[offset + 4] >> 1;
3322
3323 if(tei == Q921_TEI_BCAST) {
3324 int x;
3325
3326
3327 for(x = Q921_TEI_DYN_MIN, tei = 0; x <= Q921_TEI_MAX; x++) {
3328 if(!trunk->tei_map[x]) {
3329 tei = x;
3330 break;
3331 }
3332 }
3333 }
3334 else if(!(tei > 0 && tei < Q921_TEI_DYN_MIN)) {
3335
3336 Q921TeiSendDenyResponse(trunk, 0, ri);
3337
3338 return 0;
3339 }
3340
3341 if(!tei) {
3342
3343 Q921TeiSendDenyResponse(trunk, Q921_TEI_BCAST, ri);
3344 }
3345 else {
3346 struct Q921_Link *link = Q921_LINK_CONTEXT(trunk, tei);
3347
3348
3349 trunk->tei_map[tei] = 1;
3350
3351
3352 link->tei = tei;
3353
3354
3355 Q921ChangeState(trunk, Q921_STATE_TEI_ASSIGNED, tei);
3356
3357
3358 Q921TeiSendAssignedResponse(trunk, tei, ri);
3359
3360
3361 Q921T201TimerStart(trunk, tei);
3362 }
3363 return 0;
3364 }
3365
3366
3367
3368
3369
3370
3371
3372
3373
3374
3375 static int Q921TeiSendCheckRequest(L2TRUNK trunk, L2UCHAR tei)
3376 {
3377 L2INT res = 0;
3378
3379 if (!Q921_IS_PTMP_NT(trunk))
3380 return 0;
3381
3382
3383 res = Q921TeiSend(trunk, Q921_TEI_ID_CHECKREQ, 0, tei);
3384
3385
3386 Q921T201TimerStart(trunk, tei);
3387
3388 return res;
3389 }
3390
3391
3392
3393
3394
3395
3396
3397
3398
3399
3400
3401 static int Q921TeiProcCheckResponse(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
3402 {
3403 struct Q921_Link *link;
3404 L2UCHAR offset = Q921_UFRAME_DATA_OFFSET(trunk);
3405 L2USHORT ri = 0;
3406 L2UCHAR tei = 0;
3407
3408 if (!Q921_IS_PTMP_NT(trunk))
3409 return 0;
3410
3411 ri = (mes[offset + 1] << 8) | mes[offset + 2];
3412 tei = mes[offset + 4] >> 1;
3413
3414
3415 Q921T201TimerStop(trunk, tei);
3416
3417
3418 link = Q921_LINK_CONTEXT(trunk, tei);
3419 link->N202 = 0;
3420
3421 if(!(tei > 0 && tei < Q921_TEI_MAX) || !trunk->tei_map[tei]) {
3422
3423
3424
3425 Q921TeiSendRemoveRequest(trunk, tei);
3426
3427
3428 Q921ChangeState(trunk, Q921_STATE_STOPPED, tei);
3429
3430
3431 memset(link, 0, sizeof(struct Q921_Link));
3432 } else {
3433
3434 Q921T201TimerStart(trunk, tei);
3435 }
3436
3437 return 0;
3438 }
3439
3440
3441
3442
3443
3444
3445
3446
3447
3448
3449
3450
3451 static int Q921TeiProcVerifyRequest(L2TRUNK trunk, L2UCHAR *mes, L2INT size)
3452 {
3453 L2UCHAR resp[25];
3454 L2UCHAR offset = Q921_UFRAME_DATA_OFFSET(trunk);
3455 L2UCHAR tei = 0;
3456
3457 if (!Q921_IS_PTMP_NT(trunk))
3458 return 0;
3459
3460 tei = mes[offset + 4] >> 1;
3461
3462
3463 resp[offset + 0] = 0;
3464
3465 return 0;
3466 }
3467
3468
3469
3470
3471
3472
3473
3474
3475
3476 static int Q921TeiSendDenyResponse(L2TRUNK trunk, L2UCHAR tei, L2USHORT ri)
3477 {
3478 if (!Q921_IS_PTMP_NT(trunk))
3479 return 0;
3480
3481 return Q921TeiSend(trunk, Q921_TEI_ID_DENIED, ri, tei);
3482 }
3483
3484
3485
3486
3487
3488
3489
3490
3491
3492
3493
3494
3495 static int Q921TeiSendAssignedResponse(L2TRUNK trunk, L2UCHAR tei, L2USHORT ri)
3496 {
3497 if (!Q921_IS_PTMP_NT(trunk))
3498 return 0;
3499
3500 return Q921TeiSend(trunk, Q921_TEI_ID_ASSIGNED, ri, tei);
3501 }
3502
3503
3504
3505
3506
3507
3508
3509
3510
3511
3512 static int Q921TeiSendRemoveRequest(L2TRUNK trunk, L2UCHAR tei)
3513 {
3514 if (!Q921_IS_PTMP_NT(trunk))
3515 return 0;
3516
3517 return Q921TeiSend(trunk, Q921_TEI_ID_REMOVE, 0, tei);
3518 }