dist/ntp/libparse/binio.c

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