NetBSD/usr.sbin/mopd/common/get.c

151 lines
3.6 KiB
C

/* $NetBSD: get.c,v 1.2 1997/03/25 03:07:15 thorpej Exp $ */
/*
* Copyright (c) 1993-95 Mats O Jansson. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. 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.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by Mats O Jansson.
* 4. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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 LINT
static char rcsid[] = "$NetBSD: get.c,v 1.2 1997/03/25 03:07:15 thorpej Exp $";
#endif
#include <sys/types.h>
#include "common/mopdef.h"
u_char
mopGetChar(pkt, index)
register u_char *pkt;
register int *index;
{
u_char ret;
ret = pkt[*index];
*index = *index + 1;
return(ret);
}
u_short
mopGetShort(pkt, index)
register u_char *pkt;
register int *index;
{
u_short ret;
ret = pkt[*index] + pkt[*index+1]*256;
*index = *index + 2;
return(ret);
}
u_long
mopGetLong(pkt, index)
register u_char *pkt;
register int *index;
{
u_long ret;
ret = pkt[*index] +
pkt[*index+1]*0x100 +
pkt[*index+2]*0x10000 +
pkt[*index+3]*0x1000000;
*index = *index + 4;
return(ret);
}
void
mopGetMulti(pkt, index, dest, size)
register u_char *pkt,*dest;
register int *index,size;
{
int i;
for (i = 0; i < size; i++) {
dest[i] = pkt[*index+i];
}
*index = *index + size;
}
int
mopGetTrans(pkt, trans)
u_char *pkt;
int trans;
{
u_short *ptype;
if (trans == 0) {
ptype = (u_short *)(pkt+12);
if (ntohs(*ptype) < 1600) {
trans = TRANS_8023;
} else {
trans = TRANS_ETHER;
}
}
return(trans);
}
void
mopGetHeader(pkt, index, dst, src, proto, len, trans)
u_char *pkt, **dst, **src;
int *index, *len, trans;
u_short *proto;
{
*dst = pkt;
*src = pkt + 6;
*index = *index + 12;
switch(trans) {
case TRANS_ETHER:
*proto = (u_short)(pkt[*index]*256 + pkt[*index+1]);
*index = *index + 2;
*len = (int)(pkt[*index+1]*256 + pkt[*index]);
*index = *index + 2;
break;
case TRANS_8023:
*len = (int)(pkt[*index]*256 + pkt[*index+1]);
*index = *index + 8;
*proto = (u_short)(pkt[*index]*256 + pkt[*index+1]);
*index = *index + 2;
break;
}
}
u_short
mopGetLength(pkt, trans)
u_char *pkt;
int trans;
{
switch(trans) {
case TRANS_ETHER:
return(pkt[15]*256 + pkt[14]);
break;
case TRANS_8023:
return(pkt[12]*256 + pkt[13]);
break;
}
return(0);
}