checkin q931/q932/q921 code.
git-svn-id: http://svn.openzap.org/svn/openzap/trunk@65 a93c3328-9c30-0410-af19-c9cd2b2d52af
This commit is contained in:
Michael Jerris
parent
5ab3190cc8
commit
70f5fc6153
|
|
@ -0,0 +1,46 @@
|
|||
/*****************************************************************************
|
||||
|
||||
FileName: EuroISDNStateNT.c
|
||||
|
||||
Contents: EuroISDN State Engine for NT (Network Mode).
|
||||
|
||||
The controlling state engine for Q.931 is the state engine
|
||||
on the NT side. The state engine on the TE side is a slave
|
||||
of this. The TE side maintain it's own states as described in
|
||||
ITU-T Q931, but will in raise conditions be overridden by
|
||||
the NT side.
|
||||
|
||||
License/Copyright:
|
||||
|
||||
Copyright (c) 2007, Jan Vidar Berger, Case Labs, Ltd. All rights reserved.
|
||||
email:janvb@caselaboratories.com
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are
|
||||
met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright notice,
|
||||
this list of conditions and the following disclaimer.
|
||||
* Redistributions in binary form must reproduce the above copyright notice,
|
||||
this list of conditions and the following disclaimer in the documentation
|
||||
and/or other materials provided with the distribution.
|
||||
* Neither the name of the Case Labs, Ltd nor the names of its contributors
|
||||
may be used to endorse or promote products derived from this software
|
||||
without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE.
|
||||
*****************************************************************************/
|
||||
|
||||
#include "Q931.h"
|
||||
|
||||
|
||||
|
|
@ -0,0 +1,57 @@
|
|||
/*****************************************************************************
|
||||
|
||||
FileName: EuroISDNStateTE.c
|
||||
|
||||
Contents: EuroISDN State Engine for TE (User Mode).
|
||||
|
||||
The controlling state engine for Q.931 is the state engine
|
||||
on the NT side. The state engine on the TE side is a slave
|
||||
of this. The TE side maintain it's own states as described in
|
||||
ITU-T Q931, but will in raise conditions be overridden by
|
||||
the NT side.
|
||||
|
||||
License/Copyright:
|
||||
|
||||
Copyright (c) 2007, Jan Vidar Berger, Case Labs, Ltd. All rights reserved.
|
||||
email:janvb@caselaboratories.com
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are
|
||||
met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright notice,
|
||||
this list of conditions and the following disclaimer.
|
||||
* Redistributions in binary form must reproduce the above copyright notice,
|
||||
this list of conditions and the following disclaimer in the documentation
|
||||
and/or other materials provided with the distribution.
|
||||
* Neither the name of the Case Labs, Ltd nor the names of its contributors
|
||||
may be used to endorse or promote products derived from this software
|
||||
without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE.
|
||||
*****************************************************************************/
|
||||
|
||||
#include "Q931.h"
|
||||
|
||||
/*
|
||||
EuroISDN is a sub-set of Q.931. Q.931 is very generic as it embrase a lot,
|
||||
while EuroISDN is more exact and make decitions on some of the
|
||||
'implementation options' in the original standard. EuroISDN will
|
||||
however run smoothly under the generic space, so these functions are more
|
||||
for show
|
||||
*/
|
||||
|
||||
void EuroISDNCreateTE(L3UCHAR i)
|
||||
{
|
||||
Q931CreateTE(i);
|
||||
}
|
||||
|
|
@ -0,0 +1,477 @@
|
|||
/*****************************************************************************
|
||||
|
||||
FileName: q921.c
|
||||
|
||||
Description: Contains the implementation of a Q.921 protocol on top of the
|
||||
Comet Driver.
|
||||
|
||||
Most of the work required to execute a Q.921 protocol is
|
||||
taken care of by the Comet ship and it's driver. This layer
|
||||
will simply configure and make use of these features to
|
||||
complete a Q.921 implementation.
|
||||
|
||||
Created: 27.dec.2000/JVB
|
||||
|
||||
License/Copyright:
|
||||
|
||||
Copyright (c) 2007, Jan Vidar Berger, Case Labs, Ltd. All rights reserved.
|
||||
email:janvb@caselaboratories.com
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are
|
||||
met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright notice,
|
||||
this list of conditions and the following disclaimer.
|
||||
* Redistributions in binary form must reproduce the above copyright notice,
|
||||
this list of conditions and the following disclaimer in the documentation
|
||||
and/or other materials provided with the distribution.
|
||||
* Neither the name of the Case Labs, Ltd nor the names of its contributors
|
||||
may be used to endorse or promote products derived from this software
|
||||
without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE.
|
||||
|
||||
*****************************************************************************/
|
||||
#include "q921.h"
|
||||
#include <stdlib.h>
|
||||
#include "mfifo.h"
|
||||
|
||||
/*****************************************************************************
|
||||
Global Tables & Variables.
|
||||
*****************************************************************************/
|
||||
Q921Data Q921DevSpace[Q921MAXTRUNK];
|
||||
int Q921HeaderSpace={0};
|
||||
|
||||
int (*Q921Tx21Proc)(int dev, unsigned char *, int)={NULL};
|
||||
int (*Q921Tx23Proc)(int dev, unsigned char *, int)={NULL};
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921Init
|
||||
|
||||
Decription: Initialize the Q.921 stack so it is ready for use. This
|
||||
function MUST be called as part of initializing the
|
||||
application.
|
||||
|
||||
*****************************************************************************/
|
||||
void Q921Init()
|
||||
{
|
||||
int x;
|
||||
for(x=0; x<Q921MAXTRUNK;x++)
|
||||
{
|
||||
MFIFOCreate(Q921DevSpace[x].HDLCInQueue, Q921MAXHDLCSPACE, 10);
|
||||
Q921DevSpace[x].vr=0;
|
||||
Q921DevSpace[x].vs=0;
|
||||
Q921DevSpace[x].state=0;;
|
||||
}
|
||||
}
|
||||
|
||||
void Q921SetHeaderSpace(int hspace)
|
||||
{
|
||||
Q921HeaderSpace=hspace;
|
||||
}
|
||||
|
||||
void Q921SetTx21CB(int (*callback)(int dev, unsigned char *, int))
|
||||
{
|
||||
Q921Tx21Proc = callback;
|
||||
}
|
||||
|
||||
void Q921SetTx23CB(int (*callback)(int dev, unsigned char *, int))
|
||||
{
|
||||
Q921Tx23Proc = callback;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921QueueHDLCFrame
|
||||
|
||||
Description: Called to receive and queue an incoming HDLC frame. Will
|
||||
queue this in Q921HDLCInQueue. The called must either call
|
||||
Q921Rx12 directly afterwards or signal Q921Rx12 to be called
|
||||
later. Q921Rx12 will read from the same queue and process
|
||||
the frame.
|
||||
|
||||
This function assumes that the message contains header
|
||||
space. This is removed for internal Q921 processing, but
|
||||
must be keept for I frames.
|
||||
|
||||
Parameters: trunk trunk #
|
||||
b ptr to frame;
|
||||
size size of frame in bytes
|
||||
|
||||
*****************************************************************************/
|
||||
int Q921QueueHDLCFrame(int trunk, char *b, int size)
|
||||
{
|
||||
return MFIFOWriteMes(Q921DevSpace[trunk].HDLCInQueue, b, size);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921SendI
|
||||
|
||||
Description: Compose and Send I Frame to layer. Will receive an I frame
|
||||
with space for L2 header and fill out that header before
|
||||
it call Q921Tx21Proc.
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf P fiels octet 5
|
||||
mes ptr to I frame message.
|
||||
size size of message in bytes.
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
int Q921SendI(int trunk, unsigned char Sapi, char cr, unsigned char Tei, char pf, char *mes, int size)
|
||||
{
|
||||
mes[Q921HeaderSpace+0] = (Sapi&0xfc) | ((cr<<1)&0x02);
|
||||
mes[Q921HeaderSpace+1] = (Tei<<1) | 0x01;
|
||||
mes[Q921HeaderSpace+2] = Q921DevSpace[trunk].vs<<1;
|
||||
mes[Q921HeaderSpace+3] = (Q921DevSpace[trunk].vr<<1) | (pf & 0x01);
|
||||
Q921DevSpace[trunk].vs++;
|
||||
|
||||
return Q921Tx21Proc(trunk, mes, size);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921SendRR
|
||||
|
||||
Description: Compose and send Receive Ready.
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf P/F fiels octet 5
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
int Q921SendRR(int trunk, int Sapi, int cr, int Tei, int pf)
|
||||
{
|
||||
char mes[400];
|
||||
|
||||
mes[Q921HeaderSpace+0] = (Sapi&0xfc) | ((cr<<1)&0x02);
|
||||
mes[Q921HeaderSpace+1] = (Tei<<1) | 0x01;
|
||||
mes[Q921HeaderSpace+2] = 0x01;
|
||||
mes[Q921HeaderSpace+3] = (Q921DevSpace[trunk].vr<<1) | (pf & 0x01);
|
||||
|
||||
return Q921Tx21Proc(trunk, mes, Q921HeaderSpace+4);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921SendRNR
|
||||
|
||||
Description: Compose and send Receive Nor Ready
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf P/F fiels octet 5
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
int Q921SendRNR(int trunk, int Sapi, int cr, int Tei, int pf)
|
||||
{
|
||||
char mes[400];
|
||||
|
||||
mes[Q921HeaderSpace+0] = (Sapi&0xfc) | ((cr<<1)&0x02);
|
||||
mes[Q921HeaderSpace+1] = (Tei<<1) | 0x01;
|
||||
mes[Q921HeaderSpace+2] = 0x05;
|
||||
mes[Q921HeaderSpace+3] = (Q921DevSpace[trunk].vr<<1) | (pf & 0x01);
|
||||
|
||||
return Q921Tx21Proc(trunk, mes, Q921HeaderSpace+4);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921SendREJ
|
||||
|
||||
Description: Compose and Send Reject.
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf P/F fiels octet 5
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
int Q921SendREJ(int trunk, int Sapi, int cr, int Tei, int pf)
|
||||
{
|
||||
char mes[400];
|
||||
|
||||
mes[Q921HeaderSpace+0] = (Sapi&0xfc) | ((cr<<1)&0x02);
|
||||
mes[Q921HeaderSpace+1] = (Tei<<1) | 0x01;
|
||||
mes[Q921HeaderSpace+2] = 0x09;
|
||||
mes[Q921HeaderSpace+3] = (Q921DevSpace[trunk].vr<<1) | (pf & 0x01);
|
||||
|
||||
return Q921Tx21Proc(trunk, mes, Q921HeaderSpace+4);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921SendSABME
|
||||
|
||||
Description: Compose and send SABME
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf P fiels octet 4
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
int Q921SendSABME(int trunk, int Sapi, int cr, int Tei, int pf)
|
||||
{
|
||||
char mes[400];
|
||||
|
||||
mes[Q921HeaderSpace+0] = (Sapi&0xfc) | ((cr<<1)&0x02);
|
||||
mes[Q921HeaderSpace+1] = (Tei<<1) | 0x01;
|
||||
mes[Q921HeaderSpace+2] = 0x6f | ((pf<<4)&0x10);
|
||||
|
||||
return Q921Tx21Proc(trunk, mes, Q921HeaderSpace+3);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921SendDM
|
||||
|
||||
Description: Comose and Send DM (Disconnected Mode)
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf F fiels octet 4
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
int Q921SendDM(int trunk, int Sapi, int cr, int Tei, int pf)
|
||||
{
|
||||
char mes[400];
|
||||
|
||||
mes[Q921HeaderSpace+0] = (Sapi&0xfc) | ((cr<<1)&0x02);
|
||||
mes[Q921HeaderSpace+1] = (Tei<<1) | 0x01;
|
||||
mes[Q921HeaderSpace+2] = 0x0f | ((pf<<4)&0x10);
|
||||
|
||||
return Q921Tx21Proc(trunk, mes, Q921HeaderSpace+3);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921
|
||||
|
||||
Description:
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf P fiels octet 4
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
//int Q921SendUI(...)
|
||||
//{
|
||||
//}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921SendDISC
|
||||
|
||||
Description: Compose and Send Disconnect
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf P fiels octet 4
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
int Q921SendDISC(int trunk, int Sapi, int cr, int Tei, int pf)
|
||||
{
|
||||
char mes[400];
|
||||
|
||||
mes[Q921HeaderSpace+0] = (Sapi&0xfc) | ((cr<<1)&0x02);
|
||||
mes[Q921HeaderSpace+1] = (Tei<<1) | 0x01;
|
||||
mes[Q921HeaderSpace+2] = 0x43 | ((pf<<4)&0x10);
|
||||
|
||||
return Q921Tx21Proc(trunk, mes, Q921HeaderSpace+3);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921SendUA
|
||||
|
||||
Description: Compose and Send UA
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf F fiels octet 4
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
int Q921SendUA(int trunk, int Sapi, int cr, int Tei, int pf)
|
||||
{
|
||||
char mes[400];
|
||||
|
||||
mes[Q921HeaderSpace+0] = (Sapi&0xfc) | ((cr<<1)&0x02);
|
||||
mes[Q921HeaderSpace+1] = (Tei<<1) | 0x01;
|
||||
mes[Q921HeaderSpace+2] = 0x63 | ((pf<<4)&0x10);
|
||||
|
||||
return Q921Tx21Proc(trunk, mes, Q921HeaderSpace+3);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921
|
||||
|
||||
Description:
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf P fiels octet 5
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
//int Q921SendFRMR(...)
|
||||
//{
|
||||
//}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921
|
||||
|
||||
Description:
|
||||
|
||||
Parameters: trunk trunk #
|
||||
Sapi Sapi
|
||||
cr C/R field.
|
||||
Tei Tei.
|
||||
pf P fiels octet 5
|
||||
|
||||
Return Value: 0 if failed, 1 if Send.
|
||||
|
||||
*****************************************************************************/
|
||||
//int Q921SendXID(...)
|
||||
//{
|
||||
//}
|
||||
|
||||
int Q921ProcSABME(int trunk, char *mes, int size)
|
||||
{
|
||||
Q921DevSpace[trunk].vr=0;
|
||||
Q921DevSpace[trunk].vs=0;
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q921Rx12
|
||||
|
||||
Description: Called to process a message frame from layer 1. Will
|
||||
identify the message and call the proper 'processor' for
|
||||
layer 2 messages and forward I frames to the layer 3 entity.
|
||||
|
||||
Q921Rx12 will check the input fifo for a message, and if a
|
||||
message exist process one message before it exits. The caller
|
||||
must either call Q921Rx12 polling or keep track on #
|
||||
messages in the queue.
|
||||
|
||||
Parameters: trunk trunk #.
|
||||
|
||||
Return Value: # messages processed (always 1 or 0).
|
||||
|
||||
*****************************************************************************/
|
||||
int Q921Rx12(long trunk)
|
||||
{
|
||||
char *mes;
|
||||
int rs,size; /* receive size & Q921 frame size*/
|
||||
char *smes = MFIFOGetMesPtr(Q921DevSpace[trunk].HDLCInQueue, &size);
|
||||
if(smes != NULL)
|
||||
{
|
||||
rs = size - Q921HeaderSpace;
|
||||
mes = &smes[Q921HeaderSpace];
|
||||
/* check for I frame */
|
||||
if((mes[2] & 0x01) == 0)
|
||||
{
|
||||
if(Q921Tx23Proc(trunk, smes, size-2)) /* -2 to clip away CRC */
|
||||
{
|
||||
Q921DevSpace[trunk].vr++;
|
||||
Q921SendRR(trunk, (mes[0]&0xfc)>>2, (mes[0]>>1)&0x01,mes[1]>>1, mes[3]&0x01);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* todo: whatever*/
|
||||
}
|
||||
}
|
||||
|
||||
/* check for RR */
|
||||
else if(mes[2] ==0x01)
|
||||
{
|
||||
/* todo: check if RR is responce to I */
|
||||
Q921SendRR(trunk, (mes[0]&0xfc)>>2, (mes[0]>>1)&0x01,mes[1]>>1, mes[2]&0x01);
|
||||
}
|
||||
|
||||
/* check for RNR */
|
||||
/* check for REJ */
|
||||
/* check for SABME */
|
||||
else if((mes[2] & 0xef) == 0x6f)
|
||||
{
|
||||
Q921ProcSABME(trunk, mes, rs);
|
||||
Q921SendUA(trunk, (mes[0]&0xfc)>>2, (mes[0]>>1)&0x01,mes[1]>>1, (mes[2]&0x10)>>4);
|
||||
}
|
||||
|
||||
/* check for DM */
|
||||
/* check for UI */
|
||||
/* check for DISC */
|
||||
/* check for UA */
|
||||
/* check for FRMR */
|
||||
/* check for XID */
|
||||
|
||||
else
|
||||
{
|
||||
/* what the ? Issue an error */
|
||||
// Q921ErrorProc(trunk, Q921_UNKNOWNFRAME, mes, rs);
|
||||
/* todo: REJ or FRMR */
|
||||
}
|
||||
|
||||
MFIFOKillNext(Q921DevSpace[trunk].HDLCInQueue);
|
||||
|
||||
return 1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
|
@ -0,0 +1,664 @@
|
|||
/*****************************************************************************
|
||||
|
||||
FileName: Q931.c
|
||||
|
||||
Contents: Implementation of Q.931 stack main interface functions.
|
||||
See q931.h for description.
|
||||
|
||||
License/Copyright:
|
||||
|
||||
Copyright (c) 2007, Jan Vidar Berger, Case Labs, Ltd. All rights reserved.
|
||||
email:janvb@caselaboratories.com
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are
|
||||
met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright notice,
|
||||
this list of conditions and the following disclaimer.
|
||||
* Redistributions in binary form must reproduce the above copyright notice,
|
||||
this list of conditions and the following disclaimer in the documentation
|
||||
and/or other materials provided with the distribution.
|
||||
* Neither the name of the Case Labs, Ltd nor the names of its contributors
|
||||
may be used to endorse or promote products derived from this software
|
||||
without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE.
|
||||
*****************************************************************************/
|
||||
|
||||
#include "Q931.h"
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Dialect function pointers tables.
|
||||
|
||||
The following function pointer arrays define pack/unpack functions and
|
||||
processing furnctions for the different Q.931 based dialects.
|
||||
|
||||
The arrays are initialized with pointers to dummy functions and later
|
||||
overrided with pointers to actual functions as new dialects are added.
|
||||
|
||||
The initial Q.931 will as an example define 2 dielects as it treats User
|
||||
and Network mode as separate ISDN dialects.
|
||||
|
||||
The API messages Q931AddProc, Q931AddMes, Q931AddIE are used to initialize
|
||||
these table entries during system inititialization of a stack.
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT (*Q931Proc [Q931MAXDLCT][Q931MAXMES]) (Q931_TrunkInfo *pTrunk, L3UCHAR *,L3INT);
|
||||
|
||||
L3INT (*Q931Umes [Q931MAXDLCT][Q931MAXMES]) (Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size);
|
||||
L3INT (*Q931Pmes [Q931MAXDLCT][Q931MAXMES]) (Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize);
|
||||
|
||||
L3INT (*Q931Uie [Q931MAXDLCT][Q931MAXIE]) (Q931_TrunkInfo *pTrunk, ie *pIE, L3UCHAR * IBuf, L3UCHAR * OBuf, L3INT *IOff, L3INT *OOff);
|
||||
L3INT (*Q931Pie [Q931MAXDLCT][Q931MAXIE]) (Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT *Octet);
|
||||
|
||||
void (*Q931CreateDialectCB[Q931MAXDLCT]) (L3UCHAR iDialect)=
|
||||
{
|
||||
NULL,
|
||||
NULL
|
||||
};
|
||||
|
||||
Q931State Q931st[Q931MAXSTATE];
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Core system tables and variables.
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
L3INT Q931L4HeaderSpace={0}; /* header space to be ignoder/inserted */
|
||||
/* at head of each message. */
|
||||
|
||||
L3INT Q931L2HeaderSpace = {4}; /* Q921 header space, sapi, tei etc */
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Main interface callback functions.
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
L3INT (*Q931Tx34Proc)(Q931_TrunkInfo *pTrunk, L3UCHAR *,L3INT);
|
||||
/* callback for messages to be send to */
|
||||
/* layer 4. */
|
||||
|
||||
L3INT (*Q931Tx32Proc)(Q931_TrunkInfo *pTrunk,L3UCHAR *,L3INT);
|
||||
/* callback ptr for messages to be send */
|
||||
/* to layer 2. */
|
||||
|
||||
void (*Q931ErrorProc)(Q931_TrunkInfo *pTrunk, L3INT,L3INT,L3INT);
|
||||
/* callback for error messages. */
|
||||
|
||||
L3ULONG (*Q931GetTimeProc) ()=NULL; /* callback for func reading time in ms */
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931SetL4HeaderSpace
|
||||
|
||||
Description: Set the # of bytes to be inserted/ignored at the head of
|
||||
each message. Q931 will issue a message with space for header
|
||||
and the user will use this to fill in whatever header info
|
||||
is required to support the architecture used.
|
||||
|
||||
*****************************************************************************/
|
||||
void Q931SetL4HeaderSpace(L3INT space)
|
||||
{
|
||||
Q931L4HeaderSpace = space;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931SetL2HeaderSpace
|
||||
|
||||
Description: Set the # of bytes to be inserted/ignored at the head of
|
||||
each message. Q931 will issue a message with space for header
|
||||
and the user will use this to fill in whatever header info
|
||||
is required to support the architecture used.
|
||||
|
||||
*****************************************************************************/
|
||||
void Q931SetL2HeaderSpace(L3INT space)
|
||||
{
|
||||
Q931L2HeaderSpace = space;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931
|
||||
|
||||
Description: Dummy function for message processing.
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931ProcDummy(Q931_TrunkInfo *pTrunk, L3UCHAR * b,L3INT c)
|
||||
{
|
||||
return Q931E_INTERNAL;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931
|
||||
|
||||
Description: Dummy function for message processing
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931UmesDummy(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size)
|
||||
{
|
||||
return Q931E_UNKNOWN_MESSAGE;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931
|
||||
|
||||
Description: Dummy function for message processing
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931UieDummy(Q931_TrunkInfo *pTrunk,ie *pIE,L3UCHAR * IBuf, L3UCHAR * OBuf, L3INT *IOff, L3INT *OOff)
|
||||
{
|
||||
return Q931E_UNKNOWN_IE;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931
|
||||
|
||||
Description: Dummy function for message processing
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931PmesDummy(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize)
|
||||
{
|
||||
return Q931E_UNKNOWN_MESSAGE;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931PieDummy
|
||||
|
||||
Description: Dummy function for message processing
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931PieDummy(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT *Octet)
|
||||
{
|
||||
return Q931E_UNKNOWN_IE;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931TxDummy
|
||||
|
||||
Description: Dummy function for message processing
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931TxDummy(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT n)
|
||||
{
|
||||
return Q931E_MISSING_CB;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931ErrorDummy
|
||||
|
||||
Description: Dummy function for error processing
|
||||
|
||||
*****************************************************************************/
|
||||
void Q931ErrorDummy(Q931_TrunkInfo *pTrunk,L3INT a, L3INT b, L3INT c)
|
||||
{
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Initialize
|
||||
|
||||
Description: This function Initialize the stack.
|
||||
|
||||
Will set up the trunk array, channel
|
||||
arrays and initialize Q931 function arrays before it finally
|
||||
set up EuroISDN processing with User as diealect 0 and
|
||||
Network as dialect 1.
|
||||
|
||||
Note: Initialization of other stacks should be inserted after
|
||||
the initialization of EuroISDN.
|
||||
|
||||
*****************************************************************************/
|
||||
void Q931Initialize()
|
||||
{
|
||||
L3INT x,y;
|
||||
|
||||
/* Secure the callbacks to default procs */
|
||||
Q931Tx34Proc = Q931TxDummy;
|
||||
Q931Tx32Proc = Q931TxDummy;
|
||||
Q931ErrorProc = Q931ErrorDummy;
|
||||
|
||||
/* The user will only add the message handlers and IE handlers he need, */
|
||||
/* so we need to initialize every single entry to a default function */
|
||||
/* that will throw an appropriate error if they are ever called. */
|
||||
for(x=0;x< Q931MAXDLCT;x++)
|
||||
{
|
||||
for(y=0;y<Q931MAXMES;y++)
|
||||
{
|
||||
Q931Proc[x][y] = Q931ProcDummy;
|
||||
Q931Umes[x][y] = Q931UmesDummy;
|
||||
Q931Pmes[x][y] = Q931PmesDummy;
|
||||
}
|
||||
for(y=0;y<Q931MAXIE;y++)
|
||||
{
|
||||
Q931Pie[x][y] = Q931PieDummy;
|
||||
Q931Uie[x][y] = Q931UieDummy;
|
||||
}
|
||||
}
|
||||
|
||||
if(Q931CreateDialectCB[0] == NULL)
|
||||
Q931AddDialect(0, Q931CreateTE);
|
||||
|
||||
if(Q931CreateDialectCB[1] == NULL)
|
||||
Q931AddDialect(1, Q931CreateNT);
|
||||
|
||||
/* The last step we do is to call the callbacks to create the dialects */
|
||||
for(x=0; x< Q931MAXDLCT; x++)
|
||||
{
|
||||
if(Q931CreateDialectCB[x] != NULL)
|
||||
{
|
||||
Q931CreateDialectCB[x]((L3UCHAR)x);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931TimeTick
|
||||
|
||||
Description: Called periodically from an external source to allow the
|
||||
stack to process and maintain it's own timers.
|
||||
|
||||
Parameters: ms[IN] Milliseconds since last call.
|
||||
|
||||
Return Value: none
|
||||
|
||||
*****************************************************************************/
|
||||
void Q931TimeTick(L3ULONG ms)
|
||||
{
|
||||
ms=ms; // avoid warning for now.
|
||||
|
||||
// TODO: Loop through all active calls, check timers and call timour procs
|
||||
// if timers are expired.
|
||||
// Implement an function array so each dialect can deal with their own
|
||||
// timeouts.
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Rx23
|
||||
|
||||
Description: Receive message from layer 2 (LAPD). Receiving a message
|
||||
is always done in 2 steps. First the message must be
|
||||
interpreted and translated to a static struct. Secondly
|
||||
the message is processed and responded to.
|
||||
|
||||
The Q.931 message contains a static header that is
|
||||
interpreated in his function. The rest is interpreted
|
||||
in a sub function according to mestype.
|
||||
|
||||
Parameters: pTrunk [IN] Ptr to trunk info.
|
||||
buf [IN] Ptr to buffer containing message.
|
||||
Size [IN] Size of message.
|
||||
|
||||
Return Value: Error Code. 0 = No Error, < 0 :error, > 0 : Warning
|
||||
see q931errors.h for details.
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931Rx23(Q931_TrunkInfo *pTrunk, L3UCHAR * buf, L3INT Size)
|
||||
{
|
||||
L3UCHAR *Mes = &buf[Q931L2HeaderSpace];
|
||||
L3INT RetCode = Q931E_NO_ERROR;
|
||||
|
||||
Q931mes_Alerting * m = (Q931mes_Alerting*)Mes;
|
||||
L3INT ISize;
|
||||
L3INT IOff = 0;
|
||||
|
||||
/* Protocol Discriminator */
|
||||
m->ProtDisc = Mes[IOff++];
|
||||
|
||||
/* CRV */
|
||||
m->CRV = Q931Uie_CRV(pTrunk, Mes,m->buf, &IOff, &ISize);
|
||||
|
||||
/* Message Type */
|
||||
m->MesType = Mes[IOff++];
|
||||
|
||||
/* Call table proc to unpack codec message */
|
||||
RetCode = Q931Umes[pTrunk->Dialect][m->MesType](pTrunk, Mes, pTrunk->L3Buf,Q931L4HeaderSpace,Size- Q931L4HeaderSpace);
|
||||
if(RetCode >= Q931E_NO_ERROR)
|
||||
{
|
||||
RetCode=Q931Proc[pTrunk->Dialect][m->MesType](pTrunk, pTrunk->L3Buf, 2);
|
||||
}
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Tx34
|
||||
|
||||
Description: Called from the stac to send a message to layer 4.
|
||||
|
||||
Parameters: Mes[IN] Ptr to message buffer.
|
||||
Size[IN] Message size in bytes.
|
||||
|
||||
Return Value: Error Code. 0 = No Error, < 0 :error, > 0 : Warning
|
||||
see q931errors.h for details.
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931Tx34(Q931_TrunkInfo *pTrunk, L3UCHAR * Mes, L3INT Size)
|
||||
{
|
||||
return Q931Tx34Proc(pTrunk, Mes, Size);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Rx43
|
||||
|
||||
Description: Receive message from Layer 4 (application).
|
||||
|
||||
Parameters: pTrunk[IN] Trunk #.
|
||||
buf[IN] Message Pointer.
|
||||
Size[IN] Message size in bytes.
|
||||
|
||||
Return Value: Error Code. 0 = No Error, < 0 :error, > 0 : Warning
|
||||
see q931errors.h for details.
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931Rx43(Q931_TrunkInfo *pTrunk,L3UCHAR * buf, L3INT Size)
|
||||
{
|
||||
Q931mes_Header *ptr = (Q931mes_Header*)&buf[Q931L4HeaderSpace];
|
||||
L3INT RetCode = Q931E_NO_ERROR;
|
||||
|
||||
RetCode=Q931Proc[pTrunk->Dialect][ptr->MesType](pTrunk,buf,4);
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Tx32
|
||||
|
||||
Description: Called from the stack to send a message to L2. The input is
|
||||
always a non-packed message so it will first make a proper
|
||||
call to create a packed message before it transmits that
|
||||
message to layer 2.
|
||||
|
||||
Parameters: pTrunk[IN] Trunk #
|
||||
buf[IN] Ptr to message buffer.
|
||||
Size[IN] Message size in bytes.
|
||||
|
||||
Return Value: Error Code. 0 = No Error, < 0 :error, > 0 : Warning
|
||||
see q931errors.h for details.
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931Tx32(Q931_TrunkInfo *pTrunk, L3UCHAR * Mes, L3INT Size)
|
||||
{
|
||||
L3INT OSize;
|
||||
Q931mes_Alerting *ptr = (Q931mes_Alerting*)Mes;
|
||||
L3INT RetCode = Q931E_NO_ERROR;
|
||||
L3INT iDialect = pTrunk->Dialect;
|
||||
|
||||
/* Call pack function through table. */
|
||||
RetCode = Q931Pmes[iDialect][ptr->MesType](pTrunk,Mes,Size,&pTrunk->L2Buf[Q931L2HeaderSpace], &OSize);
|
||||
if(RetCode >= Q931E_NO_ERROR)
|
||||
{
|
||||
RetCode = Q931Tx32Proc(pTrunk, pTrunk->L2Buf, Size);
|
||||
}
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931SetError
|
||||
|
||||
Description: Called from the stack to indicate an error.
|
||||
|
||||
Parameters: ErrID ID of ie or message causing error.
|
||||
ErrPar1 Error parameter 1
|
||||
ErrPar2 Error parameter 2.
|
||||
|
||||
|
||||
*****************************************************************************/
|
||||
void Q931SetError(Q931_TrunkInfo *pTrunk,L3INT ErrID, L3INT ErrPar1, L3INT ErrPar2)
|
||||
{
|
||||
Q931ErrorProc(pTrunk,ErrID, ErrPar1, ErrPar2);
|
||||
}
|
||||
|
||||
void Q931SetTx34CB(L3INT (*Q931Tx34Par)(Q931_TrunkInfo *pTrunk,L3UCHAR * Mes, L3INT Size))
|
||||
{
|
||||
Q931Tx34Proc = Q931Tx34Par;
|
||||
}
|
||||
|
||||
void Q931SetTx32CB(L3INT (*Q931Tx32Par)(Q931_TrunkInfo *pTrunk,L3UCHAR * Mes, L3INT Size))
|
||||
{
|
||||
Q931Tx32Proc = Q931Tx32Par;
|
||||
}
|
||||
|
||||
void Q931SetErrorCB(L3INT (*Q931ErrorPar)(Q931_TrunkInfo *pTrunk,L3INT,L3INT,L3INT))
|
||||
{
|
||||
Q931ErrorProc = Q931ErrorPar;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931CreateCRV
|
||||
|
||||
Description: Create a CRV entry and return it's index. The function will
|
||||
locate a free entry in the call tables allocate it and
|
||||
allocate a unique CRV value attached to it.
|
||||
|
||||
Parameters: pTrunk [IN] Trunk number
|
||||
callindex [OUT] return call table index.
|
||||
|
||||
Return Value: Error Code. 0 = No Error, < 0 :error, > 0 : Warning
|
||||
see q931errors.h for details.
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931CreateCRV(Q931_TrunkInfo *pTrunk, L3INT * callIndex)
|
||||
{
|
||||
L3INT CRV = Q931GetUniqueCRV(pTrunk);
|
||||
|
||||
return Q931AllocateCRV(pTrunk, CRV, callIndex);
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931AllocateCRV
|
||||
|
||||
Description: Allocate a call table entry and assigns the given CRV value
|
||||
to it.
|
||||
|
||||
Parameters: pTrunk [IN] Trunk number
|
||||
iCRV [IN] Call Reference Value.
|
||||
callindex [OUT] return call table index.
|
||||
|
||||
Return Value: Error Code. 0 = No Error, < 0 :error, > 0 : Warning
|
||||
see q931errors.h for details.
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931AllocateCRV(Q931_TrunkInfo *pTrunk, L3INT iCRV, L3INT * callIndex)
|
||||
{
|
||||
L3INT x;
|
||||
for(x=0; x < Q931MAXCALLPERTRUNK; x++)
|
||||
{
|
||||
if(!pTrunk->call[x].InUse)
|
||||
{
|
||||
pTrunk->call[x].CRV = iCRV;
|
||||
pTrunk->call[x].BChan = 255;
|
||||
pTrunk->call[x].State = 0; /* null state - idle */
|
||||
pTrunk->call[x].TimerID = 0; /* no timer running */
|
||||
pTrunk->call[x].Timer = 0;
|
||||
pTrunk->call[x].InUse = 1; /* mark as used */
|
||||
*callIndex = x;
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
}
|
||||
return Q931E_TOMANYCALLS;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931GetCallState
|
||||
|
||||
Description: Look up CRV and return current call state. A non existing
|
||||
CRV is the same as state zero (0).
|
||||
|
||||
Parameters: pTrunk [IN] Trunk number.
|
||||
iCRV [IN] CRV
|
||||
|
||||
Return Value: Call State.
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q931GetCallState(Q931_TrunkInfo *pTrunk, L3INT iCRV)
|
||||
{
|
||||
L3INT x;
|
||||
for(x=0; x < Q931MAXCALLPERTRUNK; x++)
|
||||
{
|
||||
if(!pTrunk->call[x].InUse)
|
||||
{
|
||||
if(pTrunk->call[x].CRV == iCRV)
|
||||
{
|
||||
return pTrunk->call[x].State;
|
||||
}
|
||||
}
|
||||
}
|
||||
return 0; /* assume state zero for non existing CRV's */
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931StartTimer
|
||||
|
||||
Description: Start a timer.
|
||||
|
||||
Parameters: pTrunk Trunk number
|
||||
callindex call index.
|
||||
iTimer timer id
|
||||
*****************************************************************************/
|
||||
L3INT Q931StartTimer(Q931_TrunkInfo *pTrunk, L3INT callIndex, L3INT iTimerID)
|
||||
{
|
||||
pTrunk->call[callIndex].Timer = Q931GetTime();
|
||||
pTrunk->call[callIndex].TimerID = iTimerID;
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931StopTimer(Q931_TrunkInfo *pTrunk, L3INT callindex, L3INT iTimerID)
|
||||
{
|
||||
if(pTrunk->call[callindex].TimerID == iTimerID)
|
||||
pTrunk->call[callindex].TimerID = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931SetState(Q931_TrunkInfo *pTrunk, L3INT callIndex, L3INT iState)
|
||||
{
|
||||
pTrunk->call[callIndex].State = iState;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3ULONG Q931GetTime()
|
||||
{
|
||||
L3ULONG tNow;
|
||||
static L3ULONG tLast={0};
|
||||
if(Q931GetTimeProc != NULL)
|
||||
{
|
||||
tNow = Q931GetTimeProc();
|
||||
if(tNow < tLast) /* wrapped */
|
||||
{
|
||||
// todo
|
||||
}
|
||||
tLast = tNow;
|
||||
}
|
||||
return tNow;
|
||||
}
|
||||
|
||||
void Q931SetGetTimeCB(L3ULONG (*callback)())
|
||||
{
|
||||
Q931GetTimeProc = callback;
|
||||
}
|
||||
|
||||
L3INT Q931FindCRV(Q931_TrunkInfo *pTrunk, L3INT crv, L3INT *callindex)
|
||||
{
|
||||
L3INT x;
|
||||
for(x=0; x < Q931MAXCALLPERTRUNK; x++)
|
||||
{
|
||||
if(!pTrunk->call[x].InUse)
|
||||
{
|
||||
if(pTrunk->call[x].CRV == crv)
|
||||
{
|
||||
*callindex = x;
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
}
|
||||
}
|
||||
return Q931E_INVALID_CRV;
|
||||
}
|
||||
|
||||
|
||||
void Q931AddDialect(L3UCHAR i, void (*callback)(L3UCHAR iD ))
|
||||
{
|
||||
if(i < Q931MAXDLCT)
|
||||
{
|
||||
Q931CreateDialectCB[i] = callback;
|
||||
}
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
Function: Q931AddStateEntry
|
||||
|
||||
Description: Find an empty entry in the dialects state table and add this
|
||||
entry.
|
||||
*****************************************************************************/
|
||||
void Q931AddStateEntry(L3UCHAR iD, L3INT iState, L3INT iMes, L3UCHAR cDir)
|
||||
{
|
||||
int x;
|
||||
for(x=0; x < Q931MAXSTATE; x++)
|
||||
{
|
||||
if(Q931st[x].Message == 0)
|
||||
{
|
||||
Q931st[x].State = iState;
|
||||
Q931st[x].Message = iMes;
|
||||
Q931st[x].Direction = cDir;
|
||||
// TODO Sort table and use bsearch
|
||||
return;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
Function: Q931IsEventLegal
|
||||
|
||||
Description: Check state table for matching criteria to indicate if this
|
||||
Message is legal in this state or not.
|
||||
|
||||
Note: Someone write a bsearch or invent something smart here
|
||||
please - sequensial is ok for now.
|
||||
*****************************************************************************/
|
||||
L3BOOL Q931IsEventLegal(L3UCHAR iD, L3INT iState, L3INT iMes, L3UCHAR cDir)
|
||||
{
|
||||
int x;
|
||||
// TODO Sort table and use bsearch
|
||||
for(x=0; x < Q931MAXSTATE; x++)
|
||||
{
|
||||
if( Q931st[x].State == iState
|
||||
&& Q931st[x].Message == iMes
|
||||
&& Q931st[x].Direction == cDir)
|
||||
{
|
||||
return L3TRUE;
|
||||
}
|
||||
}
|
||||
return L3FALSE;
|
||||
}
|
||||
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
|
|
@ -0,0 +1,614 @@
|
|||
/*****************************************************************************
|
||||
|
||||
FileName: Q931api.c
|
||||
|
||||
Contents: api (Application Programming Interface) functions.
|
||||
See q931.h for description.
|
||||
|
||||
License/Copyright:
|
||||
|
||||
Copyright (c) 2007, Jan Vidar Berger, Case Labs, Ltd. All rights reserved.
|
||||
email:janvb@caselaboratories.com
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are
|
||||
met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright notice,
|
||||
this list of conditions and the following disclaimer.
|
||||
* Redistributions in binary form must reproduce the above copyright notice,
|
||||
this list of conditions and the following disclaimer in the documentation
|
||||
and/or other materials provided with the distribution.
|
||||
* Neither the name of the Case Labs, Ltd nor the names of its contributors
|
||||
may be used to endorse or promote products derived from this software
|
||||
without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE.
|
||||
*****************************************************************************/
|
||||
|
||||
#include "Q931.h"
|
||||
#include "memory.h"
|
||||
|
||||
/*
|
||||
L3INT Q931CreateMesIndex(L3INT mc)
|
||||
{
|
||||
if(mc < 0 || mc > 127 )
|
||||
return Q931E_INTERNAL;
|
||||
|
||||
if(Q931MesCount >127)
|
||||
return Q931E_INTERNAL;
|
||||
|
||||
Q931MesIndex[mc] = Q931MesCount ++;
|
||||
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
*/
|
||||
/*
|
||||
L3INT Q931CreateIEIndex(L3INT iec)
|
||||
{
|
||||
if(iec < 0 || iec > 127 )
|
||||
return Q931E_INTERNAL;
|
||||
|
||||
if(Q931IECount > 127)
|
||||
return Q931E_INTERNAL;
|
||||
|
||||
Q931IEIndex[iec] = Q931IECount ++;
|
||||
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
*/
|
||||
|
||||
void Q931Api_InitTrunk(Q931_TrunkInfo *pTrunk)
|
||||
{
|
||||
int y;
|
||||
pTrunk->LastCRV = 0;
|
||||
pTrunk->Dialect = 0;
|
||||
pTrunk->Enabled = 0;
|
||||
pTrunk->TrunkType = Q931_TrType_E1;
|
||||
pTrunk->NetUser = Q931_TE;
|
||||
pTrunk->TrunkState = 0;
|
||||
for(y=0; y < Q931MAXCHPERTRUNK; y++)
|
||||
{
|
||||
pTrunk->ch[y].Available = 1;
|
||||
|
||||
/* Set up E1 scheme by default */
|
||||
if(y==0)
|
||||
{
|
||||
pTrunk->ch[y].ChanType = Q931_ChType_Sync;
|
||||
}
|
||||
else if(y==16)
|
||||
{
|
||||
pTrunk->ch[y].ChanType = Q931_ChType_D;
|
||||
}
|
||||
else
|
||||
{
|
||||
pTrunk->ch[y].ChanType = Q931_ChType_B;
|
||||
}
|
||||
}
|
||||
|
||||
for(y=0; y < Q931MAXCALLPERTRUNK; y++)
|
||||
{
|
||||
pTrunk->call[y].InUse = 0;
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
void Q931SetMesProc(L3UCHAR mes, L3UCHAR dialect,
|
||||
L3INT (*Q931ProcFunc)(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom),
|
||||
L3INT (*Q931UmesFunc)(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size),
|
||||
L3INT (*Q931PmesFunc)(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize)
|
||||
)
|
||||
{
|
||||
if(Q931ProcFunc != NULL)
|
||||
Q931Proc[dialect][mes] = Q931ProcFunc;
|
||||
if(Q931UmesFunc != NULL)
|
||||
Q931Umes[dialect][mes] = Q931UmesFunc;
|
||||
if(Q931PmesFunc != NULL)
|
||||
Q931Pmes[dialect][mes] = Q931PmesFunc;
|
||||
}
|
||||
|
||||
void Q931SetIEProc(L3UCHAR iec, L3UCHAR dialect,
|
||||
L3INT (*Q931PieProc)(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT *Octet),
|
||||
L3INT (*Q931UieProc)(Q931_TrunkInfo *pTrunk, ie *pIE, L3UCHAR * IBuf, L3UCHAR * OBuf, L3INT *IOff, L3INT *OOff)
|
||||
)
|
||||
{
|
||||
if(Q931PieProc != NULL)
|
||||
Q931Pie[dialect][iec] = Q931PieProc;
|
||||
if(Q931UieProc != NULL)
|
||||
Q931Uie[dialect][iec] = Q931UieProc;
|
||||
}
|
||||
|
||||
#define trampoline(x) {x * t = (x *)pm; s = &t->buf[0];}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931GetIEBuf
|
||||
|
||||
Description: Return a ptr to the buf used for IE in the message.
|
||||
|
||||
*****************************************************************************/
|
||||
L3UCHAR * Q931GetIEBuf(L3UCHAR *pm)
|
||||
{
|
||||
L3UCHAR * s=NULL;
|
||||
Q931mes_Alerting * pMes= (Q931mes_Alerting *)pm;
|
||||
switch(pMes->MesType)
|
||||
{
|
||||
case Q931mes_ALERTING :
|
||||
trampoline(Q931mes_Alerting);
|
||||
break;
|
||||
|
||||
case Q931mes_CALL_PROCEEDING :
|
||||
trampoline(Q931mes_CallProceeding);
|
||||
break;
|
||||
|
||||
case Q931mes_CONNECT :
|
||||
trampoline(Q931mes_Connect);
|
||||
break;
|
||||
|
||||
case Q931mes_CONNECT_ACKNOWLEDGE :
|
||||
trampoline(Q931mes_ConnectAck);
|
||||
break;
|
||||
|
||||
case Q931mes_PROGRESS :
|
||||
trampoline(Q931mes_Progress);
|
||||
break;
|
||||
|
||||
case Q931mes_SETUP :
|
||||
trampoline(Q931mes_Setup);
|
||||
break;
|
||||
|
||||
case Q931mes_SETUP_ACKNOWLEDGE :
|
||||
trampoline(Q931mes_SetupAck);
|
||||
break;
|
||||
|
||||
case Q931mes_RESUME :
|
||||
trampoline(Q931mes_Resume);
|
||||
break;
|
||||
|
||||
case Q931mes_RESUME_ACKNOWLEDGE :
|
||||
trampoline(Q931mes_ResumeAck);
|
||||
break;
|
||||
|
||||
case Q931mes_RESUME_REJECT :
|
||||
trampoline(Q931mes_ResumeReject);
|
||||
break;
|
||||
|
||||
case Q932mes_RETRIEVE :
|
||||
trampoline(Q932mes_Retrieve);
|
||||
break;
|
||||
|
||||
case Q932mes_RETRIEVE_ACKNOWLEDGE :
|
||||
trampoline(Q932mes_RetrieveAck);
|
||||
break;
|
||||
|
||||
case Q932mes_RETRIEVE_REJECT :
|
||||
trampoline(Q932mes_RetrieveReject);
|
||||
break;
|
||||
|
||||
case Q931mes_SUSPEND :
|
||||
trampoline(Q931mes_Suspend);
|
||||
break;
|
||||
|
||||
case Q931mes_SUSPEND_ACKNOWLEDGE :
|
||||
trampoline(Q931mes_SuspendAck);
|
||||
break;
|
||||
|
||||
case Q931mes_SUSPEND_REJECT :
|
||||
trampoline(Q931mes_SuspendReject);
|
||||
break;
|
||||
|
||||
case Q931mes_USER_INFORMATION :
|
||||
trampoline(Q931mes_UserInformation);
|
||||
break;
|
||||
|
||||
case Q931mes_DISCONNECT :
|
||||
trampoline(Q931mes_Disconnect);
|
||||
break;
|
||||
|
||||
case Q931mes_RELEASE :
|
||||
trampoline(Q931mes_Release);
|
||||
break;
|
||||
|
||||
case Q931mes_RELEASE_COMPLETE :
|
||||
trampoline(Q931mes_ReleaseComplete);
|
||||
break;
|
||||
|
||||
case Q931mes_RESTART :
|
||||
trampoline(Q931mes_Restart);
|
||||
break;
|
||||
|
||||
case Q931mes_RESTART_ACKNOWLEDGE :
|
||||
trampoline(Q931mes_RestartAck);
|
||||
break;
|
||||
|
||||
case Q931mes_CONGESTION_CONTROL :
|
||||
trampoline(Q931mes_CongestionControl);
|
||||
break;
|
||||
|
||||
// case Q931mes_FACILITY :
|
||||
// trampoline(Q931mes_Facility);
|
||||
// break;
|
||||
|
||||
case Q931mes_INFORMATION :
|
||||
trampoline(Q931mes_Information);
|
||||
break;
|
||||
|
||||
case Q931mes_NOTIFY :
|
||||
trampoline(Q931mes_Notify);
|
||||
break;
|
||||
|
||||
// case Q931mes_REGISTER :
|
||||
// trampoline(Q931mes_Register);
|
||||
// break;
|
||||
|
||||
case Q931mes_STATUS :
|
||||
trampoline(Q931mes_Status);
|
||||
break;
|
||||
|
||||
case Q931mes_STATUS_ENQUIRY :
|
||||
trampoline(Q931mes_StatusEnquiry);
|
||||
break;
|
||||
|
||||
case Q931mes_SEGMENT :
|
||||
trampoline(Q931mes_Segment);
|
||||
break;
|
||||
|
||||
default:
|
||||
s = 0;
|
||||
break;
|
||||
}
|
||||
|
||||
return s;
|
||||
}
|
||||
|
||||
L3INT Q931GetMesSize(L3UCHAR *pMes)
|
||||
{
|
||||
|
||||
L3UCHAR *p = Q931GetIEBuf(pMes);
|
||||
L3INT Size = (L3INT)(p - pMes);
|
||||
return Size;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: q931AppendIE
|
||||
|
||||
Description: Append IE to the message.
|
||||
|
||||
Parameters: pm Ptr to message.
|
||||
pi Ptr to information element
|
||||
|
||||
Return Value ie setting
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
ie Q931AppendIE( L3UCHAR *pm, L3UCHAR *pi)
|
||||
{
|
||||
ie IE = 0;
|
||||
Q931mes_Alerting * pMes= (Q931mes_Alerting *)pm;
|
||||
Q931ie_BearerCap * pIE= (Q931ie_BearerCap *)pi;
|
||||
L3INT iISize = pIE->Size;
|
||||
|
||||
L3UCHAR *pBuf = Q931GetIEBuf(pm);
|
||||
L3INT Off = pMes->Size - (pBuf - pm);
|
||||
IE = Off | 0x8000;
|
||||
|
||||
memcpy(&pm[pMes->Size], pi, iISize);
|
||||
|
||||
pMes->Size += iISize;
|
||||
|
||||
return IE;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
*****************************************************************************/
|
||||
L3INT Q931GetUniqueCRV(Q931_TrunkInfo *pTrunk)
|
||||
{
|
||||
static L3INT crv={1};
|
||||
return crv++;
|
||||
}
|
||||
|
||||
L3INT Q931InitMesSetup(Q931mes_Setup *pMes)
|
||||
{
|
||||
pMes->ProtDisc = 0x80;
|
||||
pMes->CRV = 0; /* CRV to be allocated, might be receive*/
|
||||
pMes->MesType = Q931mes_SETUP;
|
||||
|
||||
pMes->Size = Q931GetMesSize((L3UCHAR*)pMes);
|
||||
|
||||
pMes->SendComplete =0; /* Sending Complete */
|
||||
pMes->RepeatInd =0; /* Repeat Indicator */
|
||||
pMes->BearerCap =0; /* Bearer Capability */
|
||||
pMes->ChanID =0; /* Channel ID */
|
||||
pMes->ProgInd =0; /* Progress Indicator */
|
||||
pMes->NetFac =0; /* Network-specific facilities */
|
||||
pMes->Display =0; /* Display */
|
||||
pMes->DateTime =0; /* Date/Time */
|
||||
pMes->KeypadFac =0; /* Keypad Facility */
|
||||
pMes->Signal =0; /* Signal */
|
||||
pMes->CallingNum =0; /* Calling party number */
|
||||
pMes->CallingSub =0; /* Calling party sub address */
|
||||
pMes->CalledNum =0; /* Called party number */
|
||||
pMes->CalledSub =0; /* Called party sub address */
|
||||
pMes->TransNetSel =0; /* Transit network selection */
|
||||
pMes->LLRepeatInd =0; /* Repeat Indicator 2 LLComp */
|
||||
pMes->LLComp =0; /* Low layer compatibility */
|
||||
pMes->HLComp =0; /* High layer compatibility */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitMesResume(Q931mes_Resume * pMes)
|
||||
{
|
||||
pMes->ProtDisc = 0x80;
|
||||
pMes->CRV = 0; /* CRV to be allocated, might be receive*/
|
||||
pMes->MesType = Q931mes_RESUME;
|
||||
|
||||
pMes->Size = Q931GetMesSize((L3UCHAR*)pMes);
|
||||
pMes->CallID = 0; /* Channel Identification */
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIEBearerCap(Q931ie_BearerCap *pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_BEARER_CAPABILITY;
|
||||
pIE->Size = sizeof(Q931ie_BearerCap);
|
||||
pIE->CodStand = 0;
|
||||
pIE->ITC = 0;
|
||||
pIE->TransMode = 0;
|
||||
pIE->ITR = 0x10;
|
||||
pIE->RateMul = 0;
|
||||
|
||||
pIE->Layer1Ident = 0;
|
||||
pIE->UIL1Prot = 0; /* User Information Layer 1 Protocol */
|
||||
pIE->SyncAsync = 0; /* Sync/Async */
|
||||
pIE->Negot = 0;
|
||||
pIE->UserRate = 0;
|
||||
pIE->InterRate = 0; /* Intermediate Rate */
|
||||
pIE->NIConTx = 0;
|
||||
pIE->NIConRx = 0;
|
||||
pIE->FlowCtlTx = 0; /* Flow control on Tx */
|
||||
pIE->FlowCtlRx = 0; /* Flow control on Rx */
|
||||
pIE->HDR = 0;
|
||||
pIE->MultiFrame = 0; /* Multi frame support */
|
||||
pIE->Mode = 0;
|
||||
pIE->LLInegot = 0;
|
||||
pIE->Assignor = 0; /* Assignor/assignee */
|
||||
pIE->InBandNeg = 0; /* In-band/out-band negot. */
|
||||
pIE->NumStopBits = 0; /* Number of stop bits */
|
||||
pIE->NumDataBits = 0; /* Number of data bits. */
|
||||
pIE->Parity = 0;
|
||||
pIE->DuplexMode = 0;
|
||||
pIE->ModemType = 0;
|
||||
pIE->Layer2Ident = 0;
|
||||
pIE->UIL2Prot = 0; /* User Information Layer 2 Protocol */
|
||||
pIE->Layer3Ident = 0;
|
||||
pIE->UIL3Prot = 0; /* User Information Layer 3 Protocol */
|
||||
pIE->AL3Info1 = 0;
|
||||
pIE->AL3Info2 = 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIEChanID(Q931ie_ChanID *pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_CHANNEL_IDENTIFICATION;
|
||||
pIE->Size = sizeof(Q931ie_ChanID);
|
||||
pIE->IntIDPresent = 0; /* Int. id. present */
|
||||
pIE->IntType = 0; /* Int. type */
|
||||
pIE->PrefExcl = 0; /* Pref./Excl. */
|
||||
pIE->DChanInd = 0; /* D-channel ind. */
|
||||
pIE->InfoChanSel = 0; /* Info. channel selection */
|
||||
pIE->InterfaceID = 0; /* Interface identifier */
|
||||
pIE->CodStand = 0; /* Code standard */
|
||||
pIE->NumMap = 0; /* Number/Map */
|
||||
pIE->ChanMapType = 0; /* Channel type/Map element type */
|
||||
pIE->ChanSlot = 0; /* Channel number/Slot map */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIEProgInd(Q931ie_ProgInd * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_PROGRESS_INDICATOR;
|
||||
pIE->Size = sizeof(Q931ie_ProgInd);
|
||||
pIE->CodStand = 0; /* Coding standard */
|
||||
pIE->Location = 0; /* Location */
|
||||
pIE->ProgDesc = 0; /* Progress description */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIENetFac(Q931ie_NetFac * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_NETWORK_SPECIFIC_FACILITIES;
|
||||
pIE->Size = sizeof(Q931ie_NetFac);
|
||||
pIE->LenNetID = 0; /* Length of network facilities id. */
|
||||
pIE->TypeNetID = 0; /* Type of network identification */
|
||||
pIE->NetIDPlan = 0; /* Network identification plan. */
|
||||
pIE->NetFac = 0; /* Network specific facility spec. */
|
||||
pIE->NetID[0] = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIEDisplay(Q931ie_Display * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_DISPLAY;
|
||||
pIE->Size = sizeof(Q931ie_Display);
|
||||
pIE->Display[0] = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIEDateTime(Q931ie_DateTime * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_DATETIME;
|
||||
pIE->Size = sizeof(Q931ie_DateTime);
|
||||
pIE->Year = 0; /* Year */
|
||||
pIE->Month = 0; /* Month */
|
||||
pIE->Day = 0; /* Day */
|
||||
pIE->Hour = 0; /* Hour */
|
||||
pIE->Minute = 0; /* Minute */
|
||||
pIE->Second = 0; /* Second */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIEKeypadFac(Q931ie_KeypadFac * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_KEYPAD_FACILITY;
|
||||
pIE->Size = sizeof(Q931ie_KeypadFac);
|
||||
pIE->KeypadFac[0] = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIESignal(Q931ie_Signal * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_SIGNAL;
|
||||
pIE->Size = sizeof(Q931ie_Signal);
|
||||
pIE->Signal = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIECallingNum(Q931ie_CallingNum * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_CALLING_PARTY_NUMBER;
|
||||
pIE->Size = sizeof(Q931ie_CallingNum);
|
||||
pIE->TypNum = 0; /* Type of number */
|
||||
pIE->NumPlanID = 0; /* Numbering plan identification */
|
||||
pIE->PresInd = 0; /* Presentation indicator */
|
||||
pIE->ScreenInd = 0; /* Screening indicator */
|
||||
pIE->Digit[0] = 0; /* Number digits (IA5) */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIECallingSub(Q931ie_CallingSub * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_CALLING_PARTY_SUBADDRESS;
|
||||
pIE->Size = sizeof(Q931ie_CallingSub);
|
||||
pIE->TypNum = 0; /* Type of subaddress */
|
||||
pIE->OddEvenInd = 0; /* Odd/Even indicator */
|
||||
pIE->Digit[0] = 0; /* Digits */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIECalledNum(Q931ie_CalledNum * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_CALLED_PARTY_NUMBER;
|
||||
pIE->Size = sizeof(Q931ie_CalledNum);
|
||||
pIE->TypNum = 0; /* Type of Number */
|
||||
pIE->NumPlanID = 0; /* Numbering plan identification */
|
||||
pIE->Digit[0] = 0; /* Digit (IA5) */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIECalledSub(Q931ie_CalledSub * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_CALLED_PARTY_SUBADDRESS;
|
||||
pIE->Size = sizeof(Q931ie_CalledSub);
|
||||
pIE->TypNum = 0; /* Type of subaddress */
|
||||
pIE->OddEvenInd = 0; /* Odd/Even indicator */
|
||||
pIE->Digit[0] = 0; /* Digits */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIETransNetSel(Q931ie_TransNetSel * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_TRANSIT_NETWORK_SELECTION;
|
||||
pIE->Size = sizeof(Q931ie_TransNetSel);
|
||||
pIE->Type = 0; /* Type of network identifier */
|
||||
pIE->NetIDPlan = 0; /* Network idetification plan */
|
||||
pIE->NetID[0] = 0; /* Network identification(IA5) */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIELLComp(Q931ie_LLComp * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_LOW_LAYER_COMPATIBILITY;
|
||||
pIE->Size = sizeof(Q931ie_LLComp);
|
||||
|
||||
pIE->CodStand = 0; /* Coding standard */
|
||||
pIE->ITransCap = 0; /* Information transfer capability */
|
||||
pIE->NegotInd = 0; /* Negot indic. */
|
||||
pIE->TransMode = 0; /* Transfer Mode */
|
||||
pIE->InfoRate = 0; /* Information transfer rate */
|
||||
pIE->RateMul = 0; /* Rate multiplier */
|
||||
pIE->Layer1Ident = 0; /* Layer 1 ident. */
|
||||
pIE->UIL1Prot = 0; /* User information layer 1 protocol */
|
||||
pIE->SyncAsync = 0; /* Synch/asynch */
|
||||
pIE->Negot = 0; /* Negot */
|
||||
pIE->UserRate = 0; /* User rate */
|
||||
pIE->InterRate = 0; /* Intermediate rate */
|
||||
pIE->NIConTx = 0; /* NIC on Tx */
|
||||
pIE->NIConRx = 0; /* NIC on Rx */
|
||||
pIE->FlowCtlTx = 0; /* Flow control on Tx */
|
||||
pIE->FlowCtlRx = 0; /* Flow control on Rx */
|
||||
pIE->HDR = 0; /* Hdr/no hdr */
|
||||
pIE->MultiFrame = 0; /* Multiframe */
|
||||
pIE->ModeL1 = 0; /* Mode L1 */
|
||||
pIE->NegotLLI = 0; /* Negot. LLI */
|
||||
pIE->Assignor = 0; /* Assignor/Assignor ee */
|
||||
pIE->InBandNeg = 0; /* In-band negot. */
|
||||
pIE->NumStopBits = 0; /* Number of stop bits */
|
||||
pIE->NumDataBits = 0; /* Number of data bits */
|
||||
pIE->Parity = 0; /* Parity */
|
||||
pIE->DuplexMode = 0; /* Duplex Mode */
|
||||
pIE->ModemType = 0; /* Modem type */
|
||||
pIE->Layer2Ident = 0; /* Layer 2 ident. */
|
||||
pIE->UIL2Prot = 0; /* User information layer 2 protocol */
|
||||
pIE->ModeL2 = 0; /* ModeL2 */
|
||||
pIE->Q933use = 0; /* Q.9333 use */
|
||||
pIE->UsrSpcL2Prot = 0; /* User specified layer 2 protocol info */
|
||||
pIE->WindowSize = 0; /* Window size (k) */
|
||||
pIE->Layer3Ident = 0; /* Layer 3 ident */
|
||||
pIE->OptL3Info = 0; /* Optional layer 3 protocol info. */
|
||||
pIE->ModeL3 = 0; /* Mode of operation */
|
||||
// pIE->ModeX25op = 0; /* Mode of operation X.25 */
|
||||
pIE->DefPackSize = 0; /* Default packet size */
|
||||
pIE->PackWinSize = 0; /* Packet window size */
|
||||
pIE->AddL3Info = 0; /* Additional Layer 3 protocol info */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931InitIEHLComp(Q931ie_HLComp * pIE)
|
||||
{
|
||||
pIE->IEId = Q931ie_HIGH_LAYER_COMPATIBILITY;
|
||||
pIE->Size = sizeof(Q931ie_HLComp);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931ProcUnknownMessage(Q931_TrunkInfo *pTrunk,L3UCHAR * b, L3INT iFrom)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931ProcUnexpectedMessage(Q931_TrunkInfo *pTrunk,L3UCHAR * b, L3INT iFrom)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931Disconnect(Q931_TrunkInfo *pTrunk, L3INT iTo, L3INT iCRV, L3INT iCause)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
L3INT Q931ReleaseComplete(Q931_TrunkInfo *pTrunk, L3INT iTo)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
|
|
@ -0,0 +1,311 @@
|
|||
/*****************************************************************************
|
||||
|
||||
FileName: Q932mes.c
|
||||
|
||||
Contents: Q.932 Message Encoders/Decoders
|
||||
|
||||
License/Copyright:
|
||||
|
||||
Copyright (c) 2007, Jan Vidar Berger, Case Labs, Ltd. All rights reserved.
|
||||
email:janvb@caselaboratories.com
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are
|
||||
met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright notice,
|
||||
this list of conditions and the following disclaimer.
|
||||
* Redistributions in binary form must reproduce the above copyright notice,
|
||||
this list of conditions and the following disclaimer in the documentation
|
||||
and/or other materials provided with the distribution.
|
||||
* Neither the name of the Case Labs, Ltd nor the names of its contributors
|
||||
may be used to endorse or promote products derived from this software
|
||||
without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE.
|
||||
*****************************************************************************/
|
||||
|
||||
#include "Q931.h"
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q932Umes_Facility
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
L3INT Q932Umes_Facility(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size)
|
||||
{
|
||||
L3INT i = IOff;
|
||||
L3INT ir=0;
|
||||
L3INT OOff=0;
|
||||
L3INT rc=Q931E_NO_ERROR;
|
||||
Q932mes_Facility *mes = (Q932mes_Facility*)IBuf;
|
||||
|
||||
//TODO
|
||||
|
||||
mes->Size = sizeof(Q932mes_Facility) - 1 + OOff;
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Pmes_Facility
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q932Pmes_Facility(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize)
|
||||
{
|
||||
L3BOOL RetCode = L3FALSE;
|
||||
|
||||
NoWarning(OBuf);
|
||||
NoWarning(IBuf);
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q932Umes_Hold
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
L3INT Q932Umes_Hold(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size)
|
||||
{
|
||||
L3INT i = IOff;
|
||||
L3INT ir=0;
|
||||
L3INT OOff=0;
|
||||
Q932mes_Hold *mes = (Q932mes_Hold*)IBuf;
|
||||
|
||||
//TODO
|
||||
|
||||
mes->Size = sizeof(Q932mes_Hold) - 1 + OOff;
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Pmes_Hold
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q932Pmes_Hold(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize)
|
||||
{
|
||||
L3BOOL RetCode = L3FALSE;
|
||||
|
||||
NoWarning(OBuf);
|
||||
NoWarning(IBuf);
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q932Umes_HoldAck
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
L3INT Q932Umes_HoldAck(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size)
|
||||
{
|
||||
L3INT i = IOff;
|
||||
L3INT ir=0;
|
||||
L3INT OOff=0;
|
||||
Q932mes_HoldAck *mes = (Q932mes_HoldAck*)IBuf;
|
||||
|
||||
//TODO
|
||||
|
||||
mes->Size = sizeof(Q932mes_HoldAck) - 1 + OOff;
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Pmes_HoldAck
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q932Pmes_HoldAck(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize)
|
||||
{
|
||||
L3BOOL RetCode = L3FALSE;
|
||||
|
||||
NoWarning(OBuf);
|
||||
NoWarning(IBuf);
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q932Umes_HoldReject
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
L3INT Q932Umes_HoldReject(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size)
|
||||
{
|
||||
L3INT i = IOff;
|
||||
L3INT ir=0;
|
||||
L3INT OOff=0;
|
||||
Q932mes_HoldReject *mes = (Q932mes_HoldReject*)IBuf;
|
||||
|
||||
//TODO
|
||||
|
||||
mes->Size = sizeof(Q932mes_HoldReject) - 1 + OOff;
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Pmes_HoldReject
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q932Pmes_HoldReject(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize)
|
||||
{
|
||||
L3BOOL RetCode = L3FALSE;
|
||||
|
||||
NoWarning(OBuf);
|
||||
NoWarning(IBuf);
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q932Umes_Register
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
L3INT Q932Umes_Register(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size)
|
||||
{
|
||||
L3INT i = IOff;
|
||||
L3INT ir=0;
|
||||
L3INT OOff=0;
|
||||
Q932mes_Register *mes = (Q932mes_Register*)IBuf;
|
||||
|
||||
//TODO
|
||||
|
||||
mes->Size = sizeof(Q932mes_Register) - 1 + OOff;
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Pmes_Register
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q932Pmes_Register(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize)
|
||||
{
|
||||
L3BOOL RetCode = L3FALSE;
|
||||
|
||||
NoWarning(OBuf);
|
||||
NoWarning(IBuf);
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q932Umes_Retrieve
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
L3INT Q932Umes_Retrieve(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size)
|
||||
{
|
||||
L3INT i = IOff;
|
||||
L3INT ir=0;
|
||||
L3INT OOff=0;
|
||||
Q932mes_Retrieve *mes = (Q932mes_Retrieve*)IBuf;
|
||||
|
||||
//TODO
|
||||
|
||||
mes->Size = sizeof(Q932mes_Retrieve) - 1 + OOff;
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Pmes_Retrieve
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q932Pmes_Retrieve(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize)
|
||||
{
|
||||
L3BOOL RetCode = L3FALSE;
|
||||
|
||||
NoWarning(OBuf);
|
||||
NoWarning(IBuf);
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q932Umes_RetrieveAck
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
L3INT Q932Umes_RetrieveAck(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size)
|
||||
{
|
||||
L3INT i = IOff;
|
||||
L3INT ir=0;
|
||||
L3INT OOff=0;
|
||||
Q932mes_RetrieveAck *mes = (Q932mes_RetrieveAck*)IBuf;
|
||||
|
||||
//TODO
|
||||
|
||||
mes->Size = sizeof(Q932mes_RetrieveAck) - 1 + OOff;
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Pmes_RetrieveAck
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q932Pmes_RetrieveAck(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize)
|
||||
{
|
||||
L3BOOL RetCode = L3FALSE;
|
||||
|
||||
NoWarning(OBuf);
|
||||
NoWarning(IBuf);
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q932Umes_RetrieveReject
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
L3INT Q932Umes_RetrieveReject(Q931_TrunkInfo *pTrunk,L3UCHAR *IBuf, L3UCHAR *OBuf, L3INT IOff, L3INT Size)
|
||||
{
|
||||
L3INT i = IOff;
|
||||
L3INT ir=0;
|
||||
L3INT OOff=0;
|
||||
Q932mes_RetrieveReject *mes = (Q932mes_RetrieveReject*)IBuf;
|
||||
|
||||
//TODO
|
||||
|
||||
mes->Size = sizeof(Q932mes_RetrieveReject) - 1 + OOff;
|
||||
return Q931E_NO_ERROR;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: Q931Pmes_RetrieveReject
|
||||
|
||||
*****************************************************************************/
|
||||
L3INT Q932Pmes_RetrieveReject(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize)
|
||||
{
|
||||
L3BOOL RetCode = L3FALSE;
|
||||
|
||||
NoWarning(OBuf);
|
||||
NoWarning(IBuf);
|
||||
|
||||
return RetCode;
|
||||
}
|
||||
|
|
@ -0,0 +1,102 @@
|
|||
/*****************************************************************************
|
||||
|
||||
FileName: q921.h
|
||||
|
||||
Description: Contains headers of a Q.921 protocol on top of the Comet
|
||||
Driver.
|
||||
|
||||
Most of the work required to execute a Q.921 protocol is
|
||||
taken care of by the Comet ship and it's driver. This layer
|
||||
will simply configure and make use of these features to
|
||||
complete a Q.921 implementation.
|
||||
|
||||
Note: This header file is the only include file that should be
|
||||
acessed by users of the Q.921 stack.
|
||||
|
||||
Interface: The Q.921 stack contains 2 layers.
|
||||
|
||||
- One interface layer.
|
||||
- One driver layer.
|
||||
|
||||
The interface layer contains the interface functions required
|
||||
for a layer 3 stack to be able to send and receive messages.
|
||||
|
||||
The driver layer will simply feed bytes into the ship as
|
||||
required and queue messages received out from the ship.
|
||||
|
||||
Q921TimeTick The Q.921 like any other blackbox
|
||||
modules contains no thread by it's own
|
||||
and must therefore be called regularly
|
||||
by an external 'thread' to do maintenance
|
||||
etc.
|
||||
|
||||
Q921Rx32 Receive message from layer 3. Called by
|
||||
the layer 3 stack to send a message.
|
||||
|
||||
Q921Tx23 Send a message to layer 3.
|
||||
|
||||
OnQ921Error Function called every if an error is
|
||||
deteceted.
|
||||
|
||||
OnQ921Log Function called if logging is active.
|
||||
|
||||
|
||||
<TODO> Maintenance/Configuration interface
|
||||
|
||||
Created: 27.dec.2000/JVB
|
||||
|
||||
License/Copyright:
|
||||
|
||||
Copyright (c) 2007, Jan Vidar Berger, Case Labs, Ltd. All rights reserved.
|
||||
email:janvb@caselaboratories.com
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are
|
||||
met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright notice,
|
||||
this list of conditions and the following disclaimer.
|
||||
* Redistributions in binary form must reproduce the above copyright notice,
|
||||
this list of conditions and the following disclaimer in the documentation
|
||||
and/or other materials provided with the distribution.
|
||||
* Neither the name of the Case Labs, Ltd nor the names of its contributors
|
||||
may be used to endorse or promote products derived from this software
|
||||
without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE.
|
||||
|
||||
*****************************************************************************/
|
||||
|
||||
#ifndef _Q921
|
||||
#define _Q921
|
||||
|
||||
#define Q921MAXTRUNK 4
|
||||
#define Q921MAXHDLCSPACE 3000
|
||||
|
||||
typedef struct
|
||||
{
|
||||
char HDLCInQueue[Q921MAXHDLCSPACE];
|
||||
unsigned char vs;
|
||||
unsigned char vr;
|
||||
int state;
|
||||
}Q921Data;
|
||||
|
||||
void Q921Init();
|
||||
void Q921SetHeaderSpace(int hspace);
|
||||
void Q921SetTx21CB(int (*callback)(int dev, unsigned char *, int));
|
||||
void Q921SetTx23CB(int (*callback)(int dev, unsigned char *, int));
|
||||
int Q921QueueHDLCFrame(int trunk, char *b, int size);
|
||||
int Q921Rx12(long trunk);
|
||||
|
||||
#endif
|
||||
|
||||
File diff suppressed because it is too large
Load Diff
|
|
@ -0,0 +1,191 @@
|
|||
/*****************************************************************************
|
||||
|
||||
FileName: Q932.h
|
||||
|
||||
Contents: Header w/structs for Q932 Suplementary Services.
|
||||
|
||||
NB: Do NOT include this header directly, include Q931.h
|
||||
|
||||
License/Copyright:
|
||||
|
||||
Copyright (c) 2007, Jan Vidar Berger, Case Labs, Ltd. All rights reserved.
|
||||
email:janvb@caselaboratories.com
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are
|
||||
met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright notice,
|
||||
this list of conditions and the following disclaimer.
|
||||
* Redistributions in binary form must reproduce the above copyright notice,
|
||||
this list of conditions and the following disclaimer in the documentation
|
||||
and/or other materials provided with the distribution.
|
||||
* Neither the name of the Case Labs, Ltd nor the names of its contributors
|
||||
may be used to endorse or promote products derived from this software
|
||||
without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE.
|
||||
*****************************************************************************/
|
||||
|
||||
/*****************************************************************************
|
||||
Q.932 Additional Message codes
|
||||
*****************************************************************************/
|
||||
|
||||
#define Q932mes_HOLD 0x24 /* 0010 0100 */
|
||||
#define Q932mes_HOLD_ACKNOWLEDGE 0x28 /* 0010 1000 */
|
||||
#define Q932mes_HOLD_REJECT 0x30 /* 0011 0000 */
|
||||
#define Q932mes_RETRIEVE 0x31 /* 0011 0001 */
|
||||
#define Q932mes_RETRIEVE_ACKNOWLEDGE 0x33 /* 0011 0011 */
|
||||
#define Q932mes_RETRIEVE_REJECT 0x37 /* 0011 0111 */
|
||||
#define Q932mes_FACILITY 0x62 /* 0110 0010 */
|
||||
#define Q932mes_REGISTER 0x64 /* 0110 0100 */
|
||||
|
||||
/*****************************************************************************
|
||||
Q.932 Additional EI Codes
|
||||
*****************************************************************************/
|
||||
#define Q932ie_FACILITY 0x1c /* 0001 1100 */
|
||||
|
||||
/*****************************************************************************
|
||||
Struct: Q932ie_Facility
|
||||
*****************************************************************************/
|
||||
typedef struct
|
||||
{
|
||||
L3UINT Size; /* Size of message in bytes */
|
||||
L3UCHAR ProtDisc; /* Protocol Discriminator */
|
||||
L3UCHAR MesType; /* Message type */
|
||||
L3USHORT CRV; /* Call reference value */
|
||||
L3UCHAR buf[1]; /* Dynamic buffer */
|
||||
}Q932mes_Facility;
|
||||
|
||||
/*****************************************************************************
|
||||
Struct: Q932ie_Hold
|
||||
*****************************************************************************/
|
||||
typedef struct
|
||||
{
|
||||
L3UINT Size; /* Size of message in bytes */
|
||||
L3UCHAR ProtDisc; /* Protocol Discriminator */
|
||||
L3UCHAR MesType; /* Message type */
|
||||
L3USHORT CRV; /* Call reference value */
|
||||
L3UCHAR buf[1]; /* Dynamic buffer */
|
||||
}Q932mes_Hold;
|
||||
|
||||
/*****************************************************************************
|
||||
Struct: Q932ie_HoldAck
|
||||
*****************************************************************************/
|
||||
typedef struct
|
||||
{
|
||||
L3UINT Size; /* Size of message in bytes */
|
||||
L3UCHAR ProtDisc; /* Protocol Discriminator */
|
||||
L3UCHAR MesType; /* Message type */
|
||||
L3USHORT CRV; /* Call reference value */
|
||||
L3UCHAR buf[1]; /* Dynamic buffer */
|
||||
}Q932mes_HoldAck;
|
||||
|
||||
/*****************************************************************************
|
||||
Struct: Q932ie_HoldReject
|
||||
*****************************************************************************/
|
||||
typedef struct
|
||||
{
|
||||
L3UINT Size; /* Size of message in bytes */
|
||||
L3UCHAR ProtDisc; /* Protocol Discriminator */
|
||||
L3UCHAR MesType; /* Message type */
|
||||
L3USHORT CRV; /* Call reference value */
|
||||
L3UCHAR buf[1]; /* Dynamic buffer */
|
||||
}Q932mes_HoldReject;
|
||||
|
||||
/*****************************************************************************
|
||||
Struct: Q932ie_Register
|
||||
*****************************************************************************/
|
||||
typedef struct
|
||||
{
|
||||
L3UINT Size; /* Size of message in bytes */
|
||||
L3UCHAR ProtDisc; /* Protocol Discriminator */
|
||||
L3UCHAR MesType; /* Message type */
|
||||
L3USHORT CRV; /* Call reference value */
|
||||
L3UCHAR buf[1]; /* Dynamic buffer */
|
||||
}Q932mes_Register;
|
||||
|
||||
/*****************************************************************************
|
||||
Struct: Q932ie_Retrieve
|
||||
*****************************************************************************/
|
||||
typedef struct
|
||||
{
|
||||
L3UINT Size; /* Size of message in bytes */
|
||||
L3UCHAR ProtDisc; /* Protocol Discriminator */
|
||||
L3UCHAR MesType; /* Message type */
|
||||
L3USHORT CRV; /* Call reference value */
|
||||
L3UCHAR buf[1]; /* Dynamic buffer */
|
||||
}Q932mes_Retrieve;
|
||||
|
||||
/*****************************************************************************
|
||||
Struct: Q932ie_RetrieveAck
|
||||
*****************************************************************************/
|
||||
typedef struct
|
||||
{
|
||||
L3UINT Size; /* Size of message in bytes */
|
||||
L3UCHAR ProtDisc; /* Protocol Discriminator */
|
||||
L3UCHAR MesType; /* Message type */
|
||||
L3USHORT CRV; /* Call reference value */
|
||||
L3UCHAR buf[1]; /* Dynamic buffer */
|
||||
}Q932mes_RetrieveAck;
|
||||
|
||||
/*****************************************************************************
|
||||
Struct: Q932ie_RetrieveReject
|
||||
*****************************************************************************/
|
||||
typedef struct
|
||||
{
|
||||
L3UINT Size; /* Size of message in bytes */
|
||||
L3UCHAR ProtDisc; /* Protocol Discriminator */
|
||||
L3UCHAR MesType; /* Message type */
|
||||
L3USHORT CRV; /* Call reference value */
|
||||
L3UCHAR buf[1]; /* Dynamic buffer */
|
||||
}Q932mes_RetrieveReject;
|
||||
|
||||
/*****************************************************************************
|
||||
Function Prototypes.
|
||||
*****************************************************************************/
|
||||
L3INT Q932ProcFacilityTE(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcHoldTE(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcHoldAckTE(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcHoldRejectTE(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcRegisterTE(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcRetrieveTE(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcRetrieveAckTE(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcRetrieveRejectTE(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
|
||||
L3INT Q932ProcFacilityNT(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcHoldNT(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcHoldAckNT(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcHoldRejectNT(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcRegisterNT(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcRetrieveNT(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcRetrieveAckNT(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
L3INT Q932ProcRetrieveRejectNT(Q931_TrunkInfo *pTrunk, L3UCHAR * b, L3INT iFrom);
|
||||
|
||||
L3INT Q932Pmes_Facility(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize);
|
||||
L3INT Q932Pmes_Hold(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize);
|
||||
L3INT Q932Pmes_HoldAck(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize);
|
||||
L3INT Q932Pmes_HoldReject(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize);
|
||||
L3INT Q932Pmes_Register(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize);
|
||||
L3INT Q932Pmes_Retrieve(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize);
|
||||
L3INT Q932Pmes_RetrieveAck(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize);
|
||||
L3INT Q932Pmes_RetrieveReject(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3INT ISize, L3UCHAR *OBuf, L3INT *OSize);
|
||||
|
||||
L3INT Q932Umes_Facility(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR * OBuf, L3INT I, L3INT O);
|
||||
L3INT Q932Umes_Hold(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR * OBuf, L3INT I, L3INT O);
|
||||
L3INT Q932Umes_HoldAck(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR * OBuf, L3INT I, L3INT O);
|
||||
L3INT Q932Umes_HoldReject(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR * OBuf, L3INT I, L3INT O);
|
||||
L3INT Q932Umes_Register(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR * OBuf, L3INT I, L3INT O);
|
||||
L3INT Q932Umes_Retrieve(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR * OBuf, L3INT I, L3INT O);
|
||||
L3INT Q932Umes_RetrieveAck(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR * OBuf, L3INT I, L3INT O);
|
||||
L3INT Q932Umes_RetrieveReject(Q931_TrunkInfo *pTrunk, L3UCHAR *IBuf, L3UCHAR * OBuf, L3INT I, L3INT O);
|
||||
|
|
@ -0,0 +1,83 @@
|
|||
/*****************************************************************************
|
||||
|
||||
Filename: mfifo.h
|
||||
|
||||
Contents: header for MFIFO
|
||||
|
||||
License/Copyright:
|
||||
|
||||
Copyright (c) 2007, Jan Vidar Berger, Case Labs, Ltd. All rights reserved.
|
||||
email:janvb@caselaboratories.com
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are
|
||||
met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright notice,
|
||||
this list of conditions and the following disclaimer.
|
||||
* Redistributions in binary form must reproduce the above copyright notice,
|
||||
this list of conditions and the following disclaimer in the documentation
|
||||
and/or other materials provided with the distribution.
|
||||
* Neither the name of the Case Labs, Ltd nor the names of its contributors
|
||||
may be used to endorse or promote products derived from this software
|
||||
without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE.
|
||||
*****************************************************************************/
|
||||
#ifndef _MFIFO
|
||||
#define _MFIFO
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Struct: MINDEX
|
||||
|
||||
Description: Message Index used to index a dynamic size Message FIFO.
|
||||
|
||||
*****************************************************************************/
|
||||
typedef struct _mindex
|
||||
{
|
||||
int offset; /* offset to message in buf */
|
||||
int size; /* size of message in bytes */
|
||||
}MINDEX;
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Struct: MFIFO
|
||||
|
||||
Description: Message FIFO. Provides a dynamic sized message based FIFO
|
||||
queue.
|
||||
|
||||
*****************************************************************************/
|
||||
typedef struct _mfifo
|
||||
{
|
||||
int first; /* first out */
|
||||
int last; /* last in + 1 */
|
||||
int bsize; /* buffer size */
|
||||
char *buf; /* ptr to start of buffer */
|
||||
int ixsize; /* index size */
|
||||
MINDEX ix[1]; /* message index */
|
||||
}MFIFO;
|
||||
|
||||
/*****************************************************************************
|
||||
Function prototypes.
|
||||
*****************************************************************************/
|
||||
int MFIFOCreate(char *buf, int size, int index);
|
||||
void MFIFOClear(char * buf);
|
||||
int MFIFOGetLBOffset(char *buf);
|
||||
int MFIFOGetFBOffset(char *buf);
|
||||
void MFIFOWriteIX(char *buf, char *mes, int size, int ix, int off);
|
||||
int MFIFOWriteMes(char *buf, char *mes, int size);
|
||||
char * MFIFOGetMesPtr(char *buf, int *size);
|
||||
void MFIFOKillNext(char *buf);
|
||||
|
||||
#endif
|
||||
|
|
@ -0,0 +1,296 @@
|
|||
/*****************************************************************************
|
||||
|
||||
Filename: mfifo.c
|
||||
|
||||
Description: mfifo is a message orriented fifo system with support of
|
||||
both message and byte per byte retriaval of messages.
|
||||
|
||||
The fifo has been designed with two usages in mind:
|
||||
|
||||
- Queueing of frames for hdlc and feeding out byte per byte
|
||||
with the possibility of re-sending of frames etc.
|
||||
|
||||
- fifo for messages of dynamic size.
|
||||
|
||||
The fifo is allocated on top of any buffer and creates an
|
||||
index of message in the queue. The user can write/read
|
||||
messages or write messages and read the message one byte
|
||||
at the time.
|
||||
|
||||
Interface:
|
||||
MFIFOCreate Create/reset/initialize fifo.
|
||||
MFIFOClear Clear FIFO.
|
||||
MFIFOWriteMes Write message into fifo
|
||||
* MFIFOReadMes Read message from fifo.
|
||||
MFIFOGetMesPtr Get ptr to next message.
|
||||
MFIFOKillNext Kill next message.
|
||||
|
||||
* currently not implemented.
|
||||
|
||||
Note: The message will always be saved continuously. If there is not
|
||||
sufficient space at the end of the buffer, the fifo will skip
|
||||
the last bytes and save the message at the top of the buffer.
|
||||
|
||||
This is required to allow direct ptr access to messages
|
||||
stored in the queue.
|
||||
|
||||
License/Copyright:
|
||||
|
||||
Copyright (c) 2007, Jan Vidar Berger, Case Labs, Ltd. All rights reserved.
|
||||
email:janvb@caselaboratories.com
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are
|
||||
met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright notice,
|
||||
this list of conditions and the following disclaimer.
|
||||
* Redistributions in binary form must reproduce the above copyright notice,
|
||||
this list of conditions and the following disclaimer in the documentation
|
||||
and/or other materials provided with the distribution.
|
||||
* Neither the name of the Case Labs, Ltd nor the names of its contributors
|
||||
may be used to endorse or promote products derived from this software
|
||||
without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE.
|
||||
*****************************************************************************/
|
||||
|
||||
#include "mfifo.h"
|
||||
#include <memory.h>
|
||||
#include <stdlib.h>
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: MFIFOCreate
|
||||
|
||||
Description: Creates a fifo on top of an existing buffer.
|
||||
|
||||
Parameters: buf ptr to buffer.
|
||||
size size of buffer in bytes.
|
||||
index size of index entries (max no messages).
|
||||
|
||||
Return value: 0 if failure, 1 if ok.
|
||||
|
||||
*****************************************************************************/
|
||||
int MFIFOCreate(char *buf, int size, int index)
|
||||
{
|
||||
MFIFO * mf;
|
||||
mf = (MFIFO*)buf;
|
||||
|
||||
mf->first = mf->last = 0;
|
||||
mf->ixsize = index;
|
||||
mf->buf = &buf[sizeof(MFIFO) + (sizeof(MINDEX) * (index-1))];
|
||||
|
||||
if(mf->buf > & buf[size])
|
||||
return 0;
|
||||
|
||||
mf->bsize = size - sizeof(MFIFO) - (sizeof(MINDEX) * (index-1));
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: MFIFOClear
|
||||
|
||||
Description: Clear the FIFO
|
||||
|
||||
Paremeters: buf ptr to fifo
|
||||
|
||||
Return Value: none
|
||||
|
||||
*****************************************************************************/
|
||||
void MFIFOClear(char * buf)
|
||||
{
|
||||
MFIFO * mf;
|
||||
mf = (MFIFO*)buf;
|
||||
mf->first = mf->last = 0;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: MFIFOGetLBOffset
|
||||
|
||||
Description: Helper function caclulating offset to the 'first out' byte.
|
||||
|
||||
Paremeters: buf ptr to fifo
|
||||
|
||||
Return Value: offset.
|
||||
|
||||
*****************************************************************************/
|
||||
int MFIFOGetLBOffset(char *buf)
|
||||
{
|
||||
MFIFO * mf;
|
||||
mf = (MFIFO*)buf;
|
||||
if(mf->last != mf->first)
|
||||
return mf->ix[mf->last].offset;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: MFIFOGetFBOffset
|
||||
|
||||
Description: Helper function calculating the offset to the 'first in'
|
||||
byte in the buffer. This is the position the next byte
|
||||
entering the fifo will occupy.
|
||||
|
||||
Paremeters: buf ptr to fifo
|
||||
|
||||
Return Value: offset
|
||||
|
||||
*****************************************************************************/
|
||||
int MFIFOGetFBOffset(char *buf)
|
||||
{
|
||||
int x;
|
||||
MFIFO * mf;
|
||||
mf = (MFIFO*)buf;
|
||||
if(mf->last == mf->first)
|
||||
return 0;
|
||||
x=mf->first;
|
||||
x--;
|
||||
if(x<0)
|
||||
x=mf->ixsize;
|
||||
return mf->ix[x].offset + mf->ix[x].size;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: MFIFOWriteIX
|
||||
|
||||
Description: Helper function writing a calculated entry. The function
|
||||
will perform a memcpy to move the message and set the index
|
||||
values as well as increase the 'first in' index.
|
||||
|
||||
Paremeters: buf ptr to fifo
|
||||
mes ptr to message
|
||||
size size of message in bytes.
|
||||
ix index to index entry.
|
||||
off offset to position to receive the message
|
||||
|
||||
Return Value: none
|
||||
|
||||
*****************************************************************************/
|
||||
void MFIFOWriteIX(char *buf, char *mes, int size, int ix, int off)
|
||||
{
|
||||
int x;
|
||||
MFIFO * mf;
|
||||
mf = (MFIFO*)buf;
|
||||
memcpy(&mf->buf[off],mes,size);
|
||||
mf->ix[ix].offset=off;
|
||||
mf->ix[ix].size=size;
|
||||
x = mf->first+1;
|
||||
if(x > mf->ixsize)
|
||||
x=0;
|
||||
mf->first=x;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: MFIFOWriteMes
|
||||
|
||||
Description:
|
||||
|
||||
Paremeters:
|
||||
|
||||
Return Value:
|
||||
|
||||
*****************************************************************************/
|
||||
int MFIFOWriteMes(char *buf, char *mes, int size)
|
||||
{
|
||||
int of,ol,x;
|
||||
MFIFO * mf;
|
||||
mf = (MFIFO*)buf;
|
||||
|
||||
x = mf->first+1;
|
||||
if(x > mf->ixsize)
|
||||
x=0;
|
||||
if(x == mf->last)
|
||||
return 0; /* full queue */
|
||||
|
||||
of = MFIFOGetFBOffset(buf);
|
||||
ol = MFIFOGetLBOffset(buf);
|
||||
if(mf->last == mf->first) /* empty queue */
|
||||
{
|
||||
mf->first = mf->last = 0; /* optimize */
|
||||
MFIFOWriteIX(buf, mes, size, mf->first, 0);
|
||||
return 1;
|
||||
}
|
||||
else if(of > ol)
|
||||
{
|
||||
if(mf->bsize - of >= size)
|
||||
{
|
||||
MFIFOWriteIX(buf,mes,size,mf->first,of);
|
||||
return 1;
|
||||
}
|
||||
else if(ol > size)
|
||||
{
|
||||
MFIFOWriteIX(buf,mes,size,mf->first,ol);
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
else if(ol - of > size)
|
||||
{
|
||||
MFIFOWriteIX(buf,mes,size,mf->first,of);
|
||||
return 1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: MFIFOGetMesPtr
|
||||
|
||||
Description:
|
||||
|
||||
Paremeters:
|
||||
|
||||
Return Value:
|
||||
|
||||
*****************************************************************************/
|
||||
char * MFIFOGetMesPtr(char *buf, int *size)
|
||||
{
|
||||
MFIFO * mf;
|
||||
mf = (MFIFO*)buf;
|
||||
if(mf->first==mf->last)
|
||||
return NULL;
|
||||
*size = mf->ix[mf->last].size;
|
||||
return &mf->buf[mf->ix[mf->last].offset];
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
|
||||
Function: MFIFOKillNext
|
||||
|
||||
Description:
|
||||
|
||||
Paremeters:
|
||||
|
||||
Return Value:
|
||||
|
||||
*****************************************************************************/
|
||||
void MFIFOKillNext(char *buf)
|
||||
{
|
||||
int x;
|
||||
MFIFO * mf;
|
||||
mf = (MFIFO*)buf;
|
||||
if(mf->first!=mf->last)
|
||||
{
|
||||
x = mf->last+1;
|
||||
if(x > mf->ixsize)
|
||||
x=0;
|
||||
mf->last=x;
|
||||
}
|
||||
}
|
||||
Loading…
Reference in New Issue