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

186 lines
4.6 KiB
C

/* $NetBSD: put.c,v 1.3 1997/10/16 23:25:01 lukem 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.
*/
#include <sys/cdefs.h>
#ifndef lint
__RCSID("$NetBSD: put.c,v 1.3 1997/10/16 23:25:01 lukem Exp $");
#endif
#include "os.h"
#include "mopdef.h"
#include "put.h"
void
mopPutChar(pkt, index, value)
u_char *pkt;
int *index;
u_char value;
{
pkt[*index] = value;
*index = *index + 1;
}
void
mopPutShort(pkt, index, value)
u_char *pkt;
int *index;
u_short value;
{
int i;
for (i = 0; i < 2; i++) {
pkt[*index+i] = value % 256;
value = value / 256;
}
*index = *index + 2;
}
void
mopPutLong(pkt, index, value)
u_char *pkt;
int *index;
u_int32_t value;
{
int i;
for (i = 0; i < 4; i++) {
pkt[*index+i] = value % 256;
value = value / 256;
}
*index = *index + 4;
}
void
mopPutMulti(pkt, index, value, size)
u_char *pkt,*value;
int *index,size;
{
int i;
for (i = 0; i < size; i++) {
pkt[*index+i] = value[i];
}
*index = *index + size;
}
void
mopPutTime(pkt, index, value)
u_char *pkt;
int *index;
time_t value;
{
time_t tnow;
struct tm *timenow;
if ((value == 0)) {
tnow = time(NULL);
} else {
tnow = value;
}
timenow = localtime(&tnow);
mopPutChar (pkt,index,10);
mopPutChar (pkt,index,(timenow->tm_year / 100) + 19);
mopPutChar (pkt,index,(timenow->tm_year % 100));
mopPutChar (pkt,index,(timenow->tm_mon + 1));
mopPutChar (pkt,index,(timenow->tm_mday));
mopPutChar (pkt,index,(timenow->tm_hour));
mopPutChar (pkt,index,(timenow->tm_min));
mopPutChar (pkt,index,(timenow->tm_sec));
mopPutChar (pkt,index,0x00);
mopPutChar (pkt,index,0x00);
mopPutChar (pkt,index,0x00);
}
void
mopPutHeader(pkt, index, dst, src, proto, trans)
u_char *pkt;
int *index;
u_char dst[], src[];
u_short proto;
int trans;
{
mopPutMulti(pkt, index, dst, 6);
mopPutMulti(pkt, index, src, 6);
if (trans == TRANS_8023) {
mopPutShort(pkt, index, 0);
mopPutChar (pkt, index, MOP_K_PROTO_802_DSAP);
mopPutChar (pkt, index, MOP_K_PROTO_802_SSAP);
mopPutChar (pkt, index, MOP_K_PROTO_802_CNTL);
mopPutChar (pkt, index, 0x08);
mopPutChar (pkt, index, 0x00);
mopPutChar (pkt, index, 0x2b);
}
#if !defined(__FreeBSD__)
mopPutChar(pkt, index, (proto / 256));
mopPutChar(pkt, index, (proto % 256));
#else
if (trans == TRANS_8023) {
mopPutChar(pkt, index, (proto / 256));
mopPutChar(pkt, index, (proto % 256));
} else {
mopPutChar(pkt, index, (proto % 256));
mopPutChar(pkt, index, (proto / 256));
}
#endif
if (trans == TRANS_ETHER)
mopPutShort(pkt, index, 0);
}
void
mopPutLength(pkt, trans, len)
u_char *pkt;
int trans;
u_short len;
{
int index = 0;
switch(trans) {
case TRANS_ETHER:
index = 14;
mopPutChar(pkt, &index, ((len - 16) % 256));
mopPutChar(pkt, &index, ((len - 16) / 256));
break;
case TRANS_8023:
index = 12;
#if !defined(__FreeBSD__)
mopPutChar(pkt, &index, ((len - 14) / 256));
mopPutChar(pkt, &index, ((len - 14) % 256));
#else
mopPutChar(pkt, &index, ((len - 14) % 256));
mopPutChar(pkt, &index, ((len - 14) / 256));
#endif
break;
}
}