xref: /netbsd-src/external/bsd/ntp/dist/libparse/binio.c (revision cdfa2a7ef92791ba9db70a584a1d904730e6fb46)
1*cdfa2a7eSchristos /*	$NetBSD: binio.c,v 1.5 2020/05/25 20:47:25 christos Exp $	*/
2abb0f93cSkardel 
3abb0f93cSkardel /*
4abb0f93cSkardel  * /src/NTP/ntp4-dev/libntp/binio.c,v 4.5 2005/04/16 17:32:10 kardel RELEASE_20050508_A
5abb0f93cSkardel  *
6abb0f93cSkardel  * binio.c,v 4.5 2005/04/16 17:32:10 kardel RELEASE_20050508_A
7abb0f93cSkardel  *
88585484eSchristos  * $Created: Sun Jul 20 12:55:33 1997 $
9abb0f93cSkardel  *
10abb0f93cSkardel  * Copyright (c) 1997-2005 by Frank Kardel <kardel <AT> ntp.org>
11abb0f93cSkardel  *
12abb0f93cSkardel  * Redistribution and use in source and binary forms, with or without
13abb0f93cSkardel  * modification, are permitted provided that the following conditions
14abb0f93cSkardel  * are met:
15abb0f93cSkardel  * 1. Redistributions of source code must retain the above copyright
16abb0f93cSkardel  *    notice, this list of conditions and the following disclaimer.
17abb0f93cSkardel  * 2. Redistributions in binary form must reproduce the above copyright
18abb0f93cSkardel  *    notice, this list of conditions and the following disclaimer in the
19abb0f93cSkardel  *    documentation and/or other materials provided with the distribution.
20abb0f93cSkardel  * 3. Neither the name of the author nor the names of its contributors
21abb0f93cSkardel  *    may be used to endorse or promote products derived from this software
22abb0f93cSkardel  *    without specific prior written permission.
23abb0f93cSkardel  *
24abb0f93cSkardel  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
25abb0f93cSkardel  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26abb0f93cSkardel  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27abb0f93cSkardel  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
28abb0f93cSkardel  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
29abb0f93cSkardel  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
30abb0f93cSkardel  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
31abb0f93cSkardel  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
32abb0f93cSkardel  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
33abb0f93cSkardel  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
34abb0f93cSkardel  * SUCH DAMAGE.
35abb0f93cSkardel  *
36abb0f93cSkardel  */
37abb0f93cSkardel 
388585484eSchristos #include <config.h>
39abb0f93cSkardel #include "binio.h"
40abb0f93cSkardel 
41abb0f93cSkardel long
get_lsb_short(unsigned char ** bufpp)42abb0f93cSkardel get_lsb_short(
43abb0f93cSkardel 	unsigned char **bufpp
44abb0f93cSkardel 	)
45abb0f93cSkardel {
46abb0f93cSkardel   long retval;
47abb0f93cSkardel 
48abb0f93cSkardel   retval  = *((*bufpp)++);
49abb0f93cSkardel   retval |= *((*bufpp)++) << 8;
50abb0f93cSkardel 
51abb0f93cSkardel   return (retval & 0x8000) ? (~0xFFFF | retval) : retval;
52abb0f93cSkardel }
53abb0f93cSkardel 
54abb0f93cSkardel void
put_lsb_short(unsigned char ** bufpp,long val)55abb0f93cSkardel put_lsb_short(
56abb0f93cSkardel 	unsigned char **bufpp,
57abb0f93cSkardel 	long val
58abb0f93cSkardel 	)
59abb0f93cSkardel {
60abb0f93cSkardel   *((*bufpp)++) = (unsigned char) (val        & 0xFF);
61abb0f93cSkardel   *((*bufpp)++) = (unsigned char) ((val >> 8) & 0xFF);
62abb0f93cSkardel }
63abb0f93cSkardel 
64abb0f93cSkardel long
get_lsb_long(unsigned char ** bufpp)65abb0f93cSkardel get_lsb_long(
66abb0f93cSkardel 	unsigned char **bufpp
67abb0f93cSkardel 	)
68abb0f93cSkardel {
69abb0f93cSkardel   long retval;
70abb0f93cSkardel 
71abb0f93cSkardel   retval  = *((*bufpp)++);
72abb0f93cSkardel   retval |= *((*bufpp)++) << 8;
73abb0f93cSkardel   retval |= *((*bufpp)++) << 16;
748585484eSchristos   retval |= (u_long)*((*bufpp)++) << 24;
75abb0f93cSkardel 
76abb0f93cSkardel   return retval;
77abb0f93cSkardel }
78abb0f93cSkardel 
79abb0f93cSkardel void
put_lsb_long(unsigned char ** bufpp,long val)80abb0f93cSkardel put_lsb_long(
81abb0f93cSkardel 	unsigned char **bufpp,
82abb0f93cSkardel 	long val
83abb0f93cSkardel 	)
84abb0f93cSkardel {
85abb0f93cSkardel   *((*bufpp)++) = (unsigned char)(val         & 0xFF);
86abb0f93cSkardel   *((*bufpp)++) = (unsigned char)((val >> 8)  & 0xFF);
87abb0f93cSkardel   *((*bufpp)++) = (unsigned char)((val >> 16) & 0xFF);
88abb0f93cSkardel   *((*bufpp)++) = (unsigned char)((val >> 24) & 0xFF);
89abb0f93cSkardel }
90abb0f93cSkardel 
91abb0f93cSkardel long
get_msb_short(unsigned char ** bufpp)92abb0f93cSkardel get_msb_short(
93abb0f93cSkardel 	unsigned char **bufpp
94abb0f93cSkardel 	)
95abb0f93cSkardel {
96abb0f93cSkardel   long retval;
97abb0f93cSkardel 
98abb0f93cSkardel   retval  = *((*bufpp)++) << 8;
99abb0f93cSkardel   retval |= *((*bufpp)++);
100abb0f93cSkardel 
101abb0f93cSkardel   return (retval & 0x8000) ? (~0xFFFF | retval) : retval;
102abb0f93cSkardel }
103abb0f93cSkardel 
104abb0f93cSkardel void
put_msb_short(unsigned char ** bufpp,long val)105abb0f93cSkardel put_msb_short(
106abb0f93cSkardel 	unsigned char **bufpp,
107abb0f93cSkardel 	long val
108abb0f93cSkardel 	)
109abb0f93cSkardel {
110abb0f93cSkardel   *((*bufpp)++) = (unsigned char)((val >> 8) & 0xFF);
111abb0f93cSkardel   *((*bufpp)++) = (unsigned char)( val       & 0xFF);
112abb0f93cSkardel }
113abb0f93cSkardel 
114abb0f93cSkardel long
get_msb_long(unsigned char ** bufpp)115abb0f93cSkardel get_msb_long(
116abb0f93cSkardel 	unsigned char **bufpp
117abb0f93cSkardel 	)
118abb0f93cSkardel {
119abb0f93cSkardel   long retval;
120abb0f93cSkardel 
1218585484eSchristos   retval  = (u_long)*((*bufpp)++) << 24;
122abb0f93cSkardel   retval |= *((*bufpp)++) << 16;
123abb0f93cSkardel   retval |= *((*bufpp)++) << 8;
124abb0f93cSkardel   retval |= *((*bufpp)++);
125abb0f93cSkardel 
126abb0f93cSkardel   return retval;
127abb0f93cSkardel }
128abb0f93cSkardel 
129abb0f93cSkardel void
put_msb_long(unsigned char ** bufpp,long val)130abb0f93cSkardel put_msb_long(
131abb0f93cSkardel 	unsigned char **bufpp,
132abb0f93cSkardel 	long val
133abb0f93cSkardel 	)
134abb0f93cSkardel {
135abb0f93cSkardel   *((*bufpp)++) = (unsigned char)((val >> 24) & 0xFF);
136abb0f93cSkardel   *((*bufpp)++) = (unsigned char)((val >> 16) & 0xFF);
137abb0f93cSkardel   *((*bufpp)++) = (unsigned char)((val >> 8 ) & 0xFF);
138abb0f93cSkardel   *((*bufpp)++) = (unsigned char)( val        & 0xFF);
139abb0f93cSkardel }
140abb0f93cSkardel 
141abb0f93cSkardel /*
142abb0f93cSkardel  * binio.c,v
143abb0f93cSkardel  * Revision 4.2  1999/02/21 12:17:34  kardel
144abb0f93cSkardel  * 4.91f reconcilation
145abb0f93cSkardel  *
146abb0f93cSkardel  * Revision 4.1  1998/06/28 16:47:50  kardel
147abb0f93cSkardel  * added {get,put}_msb_{short,long} functions
148abb0f93cSkardel  *
149abb0f93cSkardel  * Revision 4.0  1998/04/10 19:46:16  kardel
150abb0f93cSkardel  * Start 4.0 release version numbering
151abb0f93cSkardel  *
152abb0f93cSkardel  * Revision 1.1  1998/04/10 19:27:46  kardel
153abb0f93cSkardel  * initial NTP VERSION 4 integration of PARSE with GPS166 binary support
154abb0f93cSkardel  *
155abb0f93cSkardel  * Revision 1.1  1997/10/06 21:05:46  kardel
156abb0f93cSkardel  * new parse structure
157abb0f93cSkardel  *
158abb0f93cSkardel  */
159