freebsd-dev/sys/netatm/uni/sscop_upper.c
Andrew R. Reiter 2575dfa6d9 - Change KM_ macro calls to the appropriate function call.
- Nuke KM_ macros from port.h

  This is a leadin step towards cleaning up this code as I wait for some
  ATM cards and a ATM switch to arrive.
2002-04-19 17:45:22 +00:00

429 lines
10 KiB
C

/*
*
* ===================================
* HARP | Host ATM Research Platform
* ===================================
*
*
* This Host ATM Research Platform ("HARP") file (the "Software") is
* made available by Network Computing Services, Inc. ("NetworkCS")
* "AS IS". NetworkCS does not provide maintenance, improvements or
* support of any kind.
*
* NETWORKCS MAKES NO WARRANTIES OR REPRESENTATIONS, EXPRESS OR IMPLIED,
* INCLUDING, BUT NOT LIMITED TO, IMPLIED WARRANTIES OF MERCHANTABILITY
* AND FITNESS FOR A PARTICULAR PURPOSE, AS TO ANY ELEMENT OF THE
* SOFTWARE OR ANY SUPPORT PROVIDED IN CONNECTION WITH THIS SOFTWARE.
* In no event shall NetworkCS be responsible for any damages, including
* but not limited to consequential damages, arising from or relating to
* any use of the Software or related support.
*
* Copyright 1994-1998 Network Computing Services, Inc.
*
* Copies of this Software may be made, however, the above copyright
* notice must be reproduced on all copies.
*
* @(#) $FreeBSD$
*
*/
/*
* ATM Forum UNI Support
* ---------------------
*
* SSCOP - CPCS SAP interface processing
*
*/
#include <sys/param.h>
#include <sys/types.h>
#include <sys/systm.h>
#include <sys/time.h>
#include <sys/socket.h>
#include <sys/socketvar.h>
#include <sys/syslog.h>
#include <net/if.h>
#include <netatm/port.h>
#include <netatm/queue.h>
#include <netatm/atm.h>
#include <netatm/atm_sys.h>
#include <netatm/atm_sap.h>
#include <netatm/atm_cm.h>
#include <netatm/atm_if.h>
#include <netatm/atm_stack.h>
#include <netatm/atm_pcb.h>
#include <netatm/atm_var.h>
#include <netatm/uni/sscop.h>
#include <netatm/uni/sscop_misc.h>
#include <netatm/uni/sscop_pdu.h>
#include <netatm/uni/sscop_var.h>
#ifndef lint
__RCSID("@(#) $FreeBSD$");
#endif
/*
* Local functions
*/
static caddr_t sscop_pdu_receive(KBuffer *, struct sscop *, int *);
/*
* Local variables
*/
static union {
struct bgn_pdu t_bgn;
struct bgak_pdu t_bgak;
struct end_pdu t_end;
struct endak_q2110_pdu t_endak_q2110;
struct endak_qsaal_pdu t_endak_qsaal;
struct rs_pdu t_rs;
struct rsak_q2110_pdu t_rsak_q2110;
struct rsak_qsaal_pdu t_rsak_qsaal;
struct bgrej_pdu t_bgrej;
struct sd_pdu t_sd;
struct sdp_pdu t_sdp;
struct er_pdu t_er;
struct poll_pdu t_poll;
struct stat_pdu t_stat;
struct ustat_pdu t_ustat;
struct ud_pdu t_ud;
struct md_pdu t_md;
struct erak_pdu t_erak;
} sscop_trailer;
/*
* PDU length validation table
*/
struct pdulen {
int min;
int max;
};
static struct pdulen qsaal_pdulen[] = {
{0, 0},
{sizeof(struct bgn_pdu), sizeof(struct bgn_pdu)},
{sizeof(struct bgak_pdu), sizeof(struct bgak_pdu)},
{sizeof(struct end_pdu), sizeof(struct end_pdu)},
{sizeof(struct endak_qsaal_pdu),sizeof(struct endak_qsaal_pdu)},
{sizeof(struct rs_pdu), sizeof(struct rs_pdu)},
{sizeof(struct rsak_qsaal_pdu), sizeof(struct rsak_qsaal_pdu)},
{sizeof(struct bgrej_pdu), sizeof(struct bgrej_pdu)},
{sizeof(struct sd_pdu), sizeof(struct sd_pdu) + PDU_MAX_INFO},
{sizeof(struct sdp_pdu), sizeof(struct sdp_pdu) + PDU_MAX_INFO},
{sizeof(struct poll_pdu), sizeof(struct poll_pdu)},
{sizeof(struct stat_pdu), sizeof(struct stat_pdu) + PDU_MAX_STAT},
{sizeof(struct ustat_pdu), sizeof(struct ustat_pdu)},
{sizeof(struct ud_pdu), sizeof(struct ud_pdu) + PDU_MAX_INFO},
{sizeof(struct md_pdu), sizeof(struct md_pdu) + PDU_MAX_INFO},
{0, 0}
};
static struct pdulen q2110_pdulen[] = {
{0, 0},
{sizeof(struct bgn_pdu), sizeof(struct bgn_pdu) + PDU_MAX_UU},
{sizeof(struct bgak_pdu), sizeof(struct bgak_pdu) + PDU_MAX_UU},
{sizeof(struct end_pdu), sizeof(struct end_pdu) + PDU_MAX_UU},
{sizeof(struct endak_q2110_pdu),sizeof(struct endak_q2110_pdu)},
{sizeof(struct rs_pdu), sizeof(struct rs_pdu) + PDU_MAX_UU},
{sizeof(struct rsak_q2110_pdu), sizeof(struct rsak_q2110_pdu)},
{sizeof(struct bgrej_pdu), sizeof(struct bgrej_pdu) + PDU_MAX_UU},
{sizeof(struct sd_pdu), sizeof(struct sd_pdu) + PDU_MAX_INFO},
{sizeof(struct er_pdu), sizeof(struct er_pdu)},
{sizeof(struct poll_pdu), sizeof(struct poll_pdu)},
{sizeof(struct stat_pdu), sizeof(struct stat_pdu) + PDU_MAX_STAT},
{sizeof(struct ustat_pdu), sizeof(struct ustat_pdu)},
{sizeof(struct ud_pdu), sizeof(struct ud_pdu) + PDU_MAX_INFO},
{sizeof(struct md_pdu), sizeof(struct md_pdu) + PDU_MAX_INFO},
{sizeof(struct erak_pdu), sizeof(struct erak_pdu)}
};
/*
* PDUs with Pad Length Fields
*/
static u_char qsaal_padlen[] = {
0, /* --- */
0, /* BGN */
0, /* BGAK */
0, /* END */
0, /* ENDAK */
0, /* RS */
0, /* RSAK */
0, /* BGREJ */
1, /* SD */
1, /* SDP */
0, /* POLL */
0, /* STAT */
0, /* USTAT */
1, /* UD */
1, /* MD */
0 /* --- */
};
static u_char q2110_padlen[] = {
0, /* --- */
1, /* BGN */
1, /* BGAK */
1, /* END */
0, /* ENDAK */
1, /* RS */
0, /* RSAK */
1, /* BGREJ */
1, /* SD */
0, /* ER */
0, /* POLL */
0, /* STAT */
0, /* USTAT */
1, /* UD */
1, /* MD */
0 /* ERAK */
};
/*
* SSCOP Upper Stack Command Handler
*
* This function will receive all of the stack commands issued from the
* layer below SSCOP (ie. CPCS). Currently, only incoming PDUs will be
* received here. The appropriate processing function will be determined
* based on the received PDU type and the current sscop control block state.
*
* Arguments:
* cmd stack command code
* tok session token
* arg1 command specific argument
* arg2 command specific argument
*
* Returns:
* none
*
*/
void
sscop_upper(cmd, tok, arg1, arg2)
int cmd;
void *tok;
int arg1;
int arg2;
{
struct sscop *sop = (struct sscop *)tok;
void (**ptab)(struct sscop *, KBuffer *, caddr_t);
void (*func)(struct sscop *, KBuffer *, caddr_t);
caddr_t trlr;
int type;
ATM_DEBUG5("sscop_upper: cmd=0x%x, sop=%p, state=%d, arg1=0x%x, arg2=0x%x\n",
cmd, sop, sop->so_state, arg1, arg2);
switch (cmd) {
case CPCS_UNITDATA_SIG:
/*
* Decode/validate received PDU
*/
trlr = sscop_pdu_receive((KBuffer *)arg1, sop, &type);
if (trlr == NULL) {
return;
}
/*
* Validate sscop state
*/
if (sop->so_state > SOS_MAXSTATE) {
log(LOG_ERR,
"sscop_upper: invalid state sop=%p, state=%d\n",
sop, sop->so_state);
KB_FREEALL((KBuffer *)arg1);
return;
}
/*
* Call event processing function
*/
ptab = sop->so_vers == SSCOP_VERS_QSAAL ?
sscop_qsaal_pdutab[type]:
sscop_q2110_pdutab[type];
func = ptab[sop->so_state];
if (func == NULL) {
log(LOG_ERR,
"sscop_upper: unsupported pdu=%d, state=%d\n",
type, sop->so_state);
break;
}
(*func)(sop, (KBuffer *)arg1, trlr);
break;
default:
log(LOG_ERR, "sscop_upper: unknown cmd 0x%x, sop=%p\n",
cmd, sop);
}
return;
}
/*
* Decode and Validate Received PDU
*
* This function will process all received SSCOP PDUs. The PDU type will be
* determined and PDU format validation will be performed. If the PDU is
* successfully decoded and validated, the buffer chain will have the PDU
* trailer removed, but any resultant zero-length buffers will NOT be freed.
* If the PDU fails validation, then the buffer chain will be freed.
*
* Arguments:
* m pointer to PDU buffer chain
* sop pointer to sscop connection block
* typep address to store PDU type
*
* Returns:
* addr pointer to (contiguous) PDU trailer
* 0 invalid PDU, buffer chain freed
*
*/
static caddr_t
sscop_pdu_receive(m, sop, typep)
KBuffer *m;
struct sscop *sop;
int *typep;
{
KBuffer *m0, *ml, *mn;
caddr_t cp, tp;
int len, tlen, type, plen;
/*
* Calculate PDU length and find the last two buffers in the chain
*/
len = 0;
for (m0 = m, ml = mn = NULL; m0; m0 = KB_NEXT(m0)) {
len += KB_LEN(m0);
mn = ml;
ml = m0;
}
/*
* Make sure we've got a minimum sized PDU
*/
if (len < PDU_MIN_LEN)
goto badpdu;
/*
* Get PDU type field
*/
if (KB_LEN(ml) >= PDU_MIN_LEN) {
KB_DATAEND(ml, tp, caddr_t);
tp -= PDU_MIN_LEN;
} else {
KB_DATAEND(mn, tp, caddr_t);
tp -= (PDU_MIN_LEN - KB_LEN(ml));
}
*typep = type = *tp & PT_TYPE_MASK;
/*
* Check up on PDU length
*/
if (sop->so_vers == SSCOP_VERS_QSAAL) {
if ((len < (tlen = qsaal_pdulen[type].min)) ||
(len > qsaal_pdulen[type].max) ||
(len & PDU_LEN_MASK))
goto badpdu;
} else {
if ((len < (tlen = q2110_pdulen[type].min)) ||
(len > q2110_pdulen[type].max) ||
(len & PDU_LEN_MASK))
goto badpdu;
}
/*
* Get a contiguous, aligned PDU trailer and adjust buffer
* controls to remove trailer
*/
if (KB_LEN(ml) >= tlen) {
/*
* Trailer is contained in last buffer
*/
KB_TAILADJ(ml, -tlen);
KB_DATAEND(ml, cp, caddr_t);
if ((int)cp & PDU_ADDR_MASK) {
/*
* Trailer not aligned in buffer, use local memory
*/
bcopy(cp, (caddr_t)&sscop_trailer, tlen);
cp = (caddr_t)&sscop_trailer;
}
} else {
/*
* Trailer is split across buffers, use local memory
*/
caddr_t cp1;
int off = tlen - KB_LEN(ml);
cp = (caddr_t)&sscop_trailer;
/*
* Ensure trailer is within last two buffers
*/
if ((mn == NULL) || (KB_LEN(mn) < off))
goto badpdu;
KB_DATASTART(ml, cp1, caddr_t);
bcopy(cp1, cp + off, KB_LEN(ml));
KB_LEN(ml) = 0;
KB_TAILADJ(mn, -off);
KB_DATAEND(mn, cp1, caddr_t);
bcopy(cp1, cp, off);
}
/*
* Get possible PDU Pad Length
*/
if (sop->so_vers == SSCOP_VERS_QSAAL) {
if (qsaal_padlen[type])
plen = (*tp & PT_PAD_MASK) >> PT_PAD_SHIFT;
else
plen = 0;
} else {
if (q2110_padlen[type])
plen = (*tp & PT_PAD_MASK) >> PT_PAD_SHIFT;
else
plen = 0;
}
/*
* Perform Pad Length adjustments
*/
if (plen) {
if (KB_LEN(ml) >= plen) {
/*
* All pad bytes in last buffer
*/
KB_TAILADJ(ml, -plen);
} else {
/*
* Pad bytes split between buffers
*/
plen -= KB_LEN(ml);
if ((mn == NULL) || (KB_LEN(mn) < plen))
goto badpdu;
KB_LEN(ml) = 0;
KB_TAILADJ(mn, -plen);
}
}
return (cp);
badpdu:
/*
* This MAA Error is only supposed to be for a PDU length violation,
* but we use it for any PDU format error.
*/
sscop_maa_error(sop, 'U');
sscop_pdu_print(sop, m, "badpdu received");
KB_FREEALL(m);
return (NULL);
}