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