-
Notifications
You must be signed in to change notification settings - Fork 3
/
Copy pathuint16.h
148 lines (111 loc) · 3.66 KB
/
uint16.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
/* this header file comes from libowfat, http://www.fefe.de/libowfat/ */
#ifndef UINT16_H
#define UINT16_H
#include <inttypes.h> // uint16_t, int16_t
#include <stddef.h> // size_t
#ifdef __cplusplus
extern "C" {
#endif
typedef uint16_t uint16;
typedef int16_t int16;
#if (defined(__i386__) || defined(__x86_64__)) && !defined(NO_UINT16_MACROS)
/* On x86 and x64 unaligned access are OK and the compiler knows it and
* will collapse this long-looking code into a single load or store
* instruction, so turn it into inline functions */
static inline void uint16_pack(char* out,uint16 in) {
out[0]=in;
out[1]=in>>8;
}
static inline void uint16_unpack(const char *in,uint16* out) {
const unsigned char* i = (const unsigned char*)in;
*out=i[0] | (i[1]<<8);
}
static inline uint16 uint16_read(const char* in) {
const unsigned char* i = (const unsigned char*)in;
return i[0] | (i[1]<<8);
}
static inline void uint16_pack_big(char* out,uint16 in) {
out[0]=in>>8;
out[1]=in;
}
static inline void uint16_unpack_big(const char *in,uint16* out) {
const unsigned char* i = (const unsigned char*)in;
*out=(i[0]<<8) | i[1];
}
static inline uint16 uint16_read_big(const char* in) {
const unsigned char* i = (const unsigned char*)in;
return (i[0]<<8) | i[1];
}
#else
#include <libowfat/compiler.h>
void uint16_pack(char out[2],uint16 in);
void uint16_pack_big(char out[2],uint16 in);
void uint16_unpack(const char in[2],uint16* out);
void uint16_unpack_big(const char in[2],uint16* out);
uint16 uint16_read(const char in[2]);
uint16 uint16_read_big(const char in[2]);
#endif
static inline size_t fmt_uint16(char out[2], uint16 in) {
if (out) uint16_pack(out,in);
return 2;
}
static inline size_t fmt_uint16_big(char out[2], uint16 in) {
if (out) uint16_pack_big(out,in);
return 2;
}
static inline size_t scan_uint16(const char in[2], size_t len, uint16_t* b) {
if (len<2) return 0;
*b = uint16_read(in);
return 2;
}
static inline size_t scan_uint16_big(const char in[2], size_t len, uint16_t* b) {
if (len<2) return 0;
*b = uint16_read_big(in);
return 2;
}
#ifdef __cplusplus
}
inline void uint16_pack(unsigned char out[2],uint16 in) {
uint16_pack(reinterpret_cast<char*>(out), in);
}
inline void uint16_pack_big(unsigned char out[2],uint16 in) {
uint16_pack_big(reinterpret_cast<char*>(out), in);
}
inline void uint16_unpack(const unsigned char in[2],uint16* out) {
uint16_unpack(reinterpret_cast<const char*>(in), out);
}
inline void uint16_unpack_big(const unsigned char in[2],uint16* out) {
uint16_unpack_big(reinterpret_cast<const char*>(in), out);
}
inline void uint16_pack(uint16* out,uint16 in) {
uint16_pack(reinterpret_cast<char*>(out), in);
}
inline void uint16_pack_big(uint16* out,uint16 in) {
uint16_pack_big(reinterpret_cast<char*>(out), in);
}
inline void uint16_unpack(uint16* *in,uint16* out) {
uint16_unpack(reinterpret_cast<const char*>(in), out);
}
inline void uint16_unpack_big(uint16* *in,uint16* out) {
uint16_unpack_big(reinterpret_cast<const char*>(in), out);
}
inline uint16 uint16_read(const unsigned char in[2]) {
return uint16_read(reinterpret_cast<const char*>(in));
}
inline uint16 uint16_read_big(const unsigned char in[2]) {
return uint16_read_big(reinterpret_cast<const char*>(in));
}
inline uint16 uint16_read(const uint16 *in) {
return uint16_read(reinterpret_cast<const char*>(in));
}
inline uint16 uint16_read_big(const uint16 *in) {
return uint16_read_big(reinterpret_cast<const char*>(in));
}
inline uint16 uint_read(const uint16* in) {
return uint16_read(reinterpret_cast<const char*>(in));
}
inline uint16 uint_read_big(const uint16* in) {
return uint16_read_big(reinterpret_cast<const char*>(in));
}
#endif
#endif