1/* 2 * Copyright (c) 1992, 1993, 1994, 1995, 1996 3 * The Regents of the University of California. All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that: (1) source code distributions 7 * retain the above copyright notice and this paragraph in its entirety, (2) 8 * distributions including binary code include the above copyright notice and 9 * this paragraph in its entirety in the documentation or other materials 10 * provided with the distribution, and (3) all advertising materials mentioning 11 * features or use of this software display the following acknowledgement: 12 * ``This product includes software developed by the University of California, 13 * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of 14 * the University nor the names of its contributors may be used to endorse 15 * or promote products derived from this software without specific prior 16 * written permission. 17 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED 18 * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF 19 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. 20 */ 21 22/* 23 * Macros to extract possibly-unaligned big-endian integral values. 24 */ 25#ifdef LBL_ALIGN 26/* 27 * The processor doesn't natively handle unaligned loads. 28 */ 29#if defined(__GNUC__) && defined(HAVE___ATTRIBUTE__) && \ 30 (defined(__alpha) || defined(__alpha__) || \ 31 defined(__mips) || defined(__mips__)) 32 33/* 34 * This is a GCC-compatible compiler and we have __attribute__, which 35 * we assume that mean we have __attribute__((packed)), and this is 36 * MIPS or Alpha, which has instructions that can help when doing 37 * unaligned loads. 38 * 39 * Declare packed structures containing a uint16_t and a uint32_t, 40 * cast the pointer to point to one of those, and fetch through it; 41 * the GCC manual doesn't appear to explicitly say that 42 * __attribute__((packed)) causes the compiler to generate unaligned-safe 43 * code, but it apppears to do so. 44 * 45 * We do this in case the compiler can generate code using those 46 * instructions to do an unaligned load and pass stuff to "ntohs()" or 47 * "ntohl()", which might be better than than the code to fetch the 48 * bytes one at a time and assemble them. (That might not be the 49 * case on a little-endian platform, such as DEC's MIPS machines and 50 * Alpha machines, where "ntohs()" and "ntohl()" might not be done 51 * inline.) 52 * 53 * We do this only for specific architectures because, for example, 54 * at least some versions of GCC, when compiling for 64-bit SPARC, 55 * generate code that assumes alignment if we do this. 56 * 57 * XXX - add other architectures and compilers as possible and 58 * appropriate. 59 * 60 * HP's C compiler, indicated by __HP_cc being defined, supports 61 * "#pragma unaligned N" in version A.05.50 and later, where "N" 62 * specifies a number of bytes at which the typedef on the next 63 * line is aligned, e.g. 64 * 65 * #pragma unalign 1 66 * typedef uint16_t unaligned_uint16_t; 67 * 68 * to define unaligned_uint16_t as a 16-bit unaligned data type. 69 * This could be presumably used, in sufficiently recent versions of 70 * the compiler, with macros similar to those below. This would be 71 * useful only if that compiler could generate better code for PA-RISC 72 * or Itanium than would be generated by a bunch of shifts-and-ORs. 73 * 74 * DEC C, indicated by __DECC being defined, has, at least on Alpha, 75 * an __unaligned qualifier that can be applied to pointers to get the 76 * compiler to generate code that does unaligned loads and stores when 77 * dereferencing the pointer in question. 78 * 79 * XXX - what if the native C compiler doesn't support 80 * __attribute__((packed))? How can we get it to generate unaligned 81 * accesses for *specific* items? 82 */ 83typedef struct { 84 uint16_t val; 85} __attribute__((packed)) unaligned_uint16_t; 86 87typedef struct { 88 uint32_t val; 89} __attribute__((packed)) unaligned_uint32_t; 90 91static inline uint16_t 92EXTRACT_16BITS(const void *p) 93{ 94 return ((uint16_t)ntohs(((const unaligned_uint16_t *)(p))->val)); 95} 96 97static inline uint32_t 98EXTRACT_32BITS(const void *p) 99{ 100 return ((uint32_t)ntohl(((const unaligned_uint32_t *)(p))->val)); 101} 102 103static inline uint64_t 104EXTRACT_64BITS(const void *p) 105{ 106 return ((uint64_t)(((uint64_t)ntohl(((const unaligned_uint32_t *)(p) + 0)->val)) << 32 | \ 107 ((uint64_t)ntohl(((const unaligned_uint32_t *)(p) + 1)->val)) << 0)); 108} 109 110#else /* have to do it a byte at a time */ 111/* 112 * This isn't a GCC-compatible compiler, we don't have __attribute__, 113 * or we do but we don't know of any better way with this instruction 114 * set to do unaligned loads, so do unaligned loads of big-endian 115 * quantities the hard way - fetch the bytes one at a time and 116 * assemble them. 117 */ 118#define EXTRACT_16BITS(p) \ 119 ((uint16_t)(((uint16_t)(*((const uint8_t *)(p) + 0)) << 8) | \ 120 ((uint16_t)(*((const uint8_t *)(p) + 1)) << 0))) 121#define EXTRACT_32BITS(p) \ 122 ((uint32_t)(((uint32_t)(*((const uint8_t *)(p) + 0)) << 24) | \ 123 ((uint32_t)(*((const uint8_t *)(p) + 1)) << 16) | \ 124 ((uint32_t)(*((const uint8_t *)(p) + 2)) << 8) | \ 125 ((uint32_t)(*((const uint8_t *)(p) + 3)) << 0))) 126#define EXTRACT_64BITS(p) \ 127 ((uint64_t)(((uint64_t)(*((const uint8_t *)(p) + 0)) << 56) | \ 128 ((uint64_t)(*((const uint8_t *)(p) + 1)) << 48) | \ 129 ((uint64_t)(*((const uint8_t *)(p) + 2)) << 40) | \ 130 ((uint64_t)(*((const uint8_t *)(p) + 3)) << 32) | \ 131 ((uint64_t)(*((const uint8_t *)(p) + 4)) << 24) | \ 132 ((uint64_t)(*((const uint8_t *)(p) + 5)) << 16) | \ 133 ((uint64_t)(*((const uint8_t *)(p) + 6)) << 8) | \ 134 ((uint64_t)(*((const uint8_t *)(p) + 7)) << 0))) 135#endif /* must special-case unaligned accesses */ 136#else /* LBL_ALIGN */ 137/* 138 * The processor natively handles unaligned loads, so we can just 139 * cast the pointer and fetch through it. 140 */ 141static inline uint16_t 142EXTRACT_16BITS(const void *p) 143{ 144 return ((uint16_t)ntohs(*(const uint16_t *)(p))); 145} 146 147static inline uint32_t 148EXTRACT_32BITS(const void *p) 149{ 150 return ((uint32_t)ntohl(*(const uint32_t *)(p))); 151} 152 153static inline uint64_t 154EXTRACT_64BITS(const void *p) 155{ 156 return ((uint64_t)(((uint64_t)ntohl(*((const uint32_t *)(p) + 0))) << 32 | \ 157 ((uint64_t)ntohl(*((const uint32_t *)(p) + 1))) << 0)); 158 159} 160 161#endif /* LBL_ALIGN */ 162 163#define EXTRACT_24BITS(p) \ 164 ((uint32_t)(((uint32_t)(*((const uint8_t *)(p) + 0)) << 16) | \ 165 ((uint32_t)(*((const uint8_t *)(p) + 1)) << 8) | \ 166 ((uint32_t)(*((const uint8_t *)(p) + 2)) << 0))) 167 168#define EXTRACT_40BITS(p) \ 169 ((uint64_t)(((uint64_t)(*((const uint8_t *)(p) + 0)) << 32) | \ 170 ((uint64_t)(*((const uint8_t *)(p) + 1)) << 24) | \ 171 ((uint64_t)(*((const uint8_t *)(p) + 2)) << 16) | \ 172 ((uint64_t)(*((const uint8_t *)(p) + 3)) << 8) | \ 173 ((uint64_t)(*((const uint8_t *)(p) + 4)) << 0))) 174 175#define EXTRACT_48BITS(p) \ 176 ((uint64_t)(((uint64_t)(*((const uint8_t *)(p) + 0)) << 40) | \ 177 ((uint64_t)(*((const uint8_t *)(p) + 1)) << 32) | \ 178 ((uint64_t)(*((const uint8_t *)(p) + 2)) << 24) | \ 179 ((uint64_t)(*((const uint8_t *)(p) + 3)) << 16) | \ 180 ((uint64_t)(*((const uint8_t *)(p) + 4)) << 8) | \ 181 ((uint64_t)(*((const uint8_t *)(p) + 5)) << 0))) 182 183#define EXTRACT_56BITS(p) \ 184 ((uint64_t)(((uint64_t)(*((const uint8_t *)(p) + 0)) << 48) | \ 185 ((uint64_t)(*((const uint8_t *)(p) + 1)) << 40) | \ 186 ((uint64_t)(*((const uint8_t *)(p) + 2)) << 32) | \ 187 ((uint64_t)(*((const uint8_t *)(p) + 3)) << 24) | \ 188 ((uint64_t)(*((const uint8_t *)(p) + 4)) << 16) | \ 189 ((uint64_t)(*((const uint8_t *)(p) + 5)) << 8) | \ 190 ((uint64_t)(*((const uint8_t *)(p) + 6)) << 0))) 191 192/* 193 * Macros to extract possibly-unaligned little-endian integral values. 194 * XXX - do loads on little-endian machines that support unaligned loads? 195 */ 196#define EXTRACT_LE_8BITS(p) (*(p)) 197#define EXTRACT_LE_16BITS(p) \ 198 ((uint16_t)(((uint16_t)(*((const uint8_t *)(p) + 1)) << 8) | \ 199 ((uint16_t)(*((const uint8_t *)(p) + 0)) << 0))) 200#define EXTRACT_LE_32BITS(p) \ 201 ((uint32_t)(((uint32_t)(*((const uint8_t *)(p) + 3)) << 24) | \ 202 ((uint32_t)(*((const uint8_t *)(p) + 2)) << 16) | \ 203 ((uint32_t)(*((const uint8_t *)(p) + 1)) << 8) | \ 204 ((uint32_t)(*((const uint8_t *)(p) + 0)) << 0))) 205#define EXTRACT_LE_24BITS(p) \ 206 ((uint32_t)(((uint32_t)(*((const uint8_t *)(p) + 2)) << 16) | \ 207 ((uint32_t)(*((const uint8_t *)(p) + 1)) << 8) | \ 208 ((uint32_t)(*((const uint8_t *)(p) + 0)) << 0))) 209#define EXTRACT_LE_64BITS(p) \ 210 ((uint64_t)(((uint64_t)(*((const uint8_t *)(p) + 7)) << 56) | \ 211 ((uint64_t)(*((const uint8_t *)(p) + 6)) << 48) | \ 212 ((uint64_t)(*((const uint8_t *)(p) + 5)) << 40) | \ 213 ((uint64_t)(*((const uint8_t *)(p) + 4)) << 32) | \ 214 ((uint64_t)(*((const uint8_t *)(p) + 3)) << 24) | \ 215 ((uint64_t)(*((const uint8_t *)(p) + 2)) << 16) | \ 216 ((uint64_t)(*((const uint8_t *)(p) + 1)) << 8) | \ 217 ((uint64_t)(*((const uint8_t *)(p) + 0)) << 0))) 218