summaryrefslogtreecommitdiff
path: root/robot/bin.c
blob: 4242edcf252325c7a96f24e4b1b1dbbe9f2ed5db (plain)
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
#include "bin.h"

#define W2_ENDIAN_LITTLE (1)
#define W2_ENDIAN_BIG (0)

#define _SHIFT_0B (8 * 0)
#define _SHIFT_1B (8 * 1)
#define _SHIFT_2B (8 * 2)
#define _SHIFT_3B (8 * 3)
#define _BYTE_0 ((uint32_t)(0xff << (_SHIFT_0B)))
#define _BYTE_1 ((uint32_t)(0xff << (_SHIFT_1B)))
#define _BYTE_2 ((uint32_t)(0xff << (_SHIFT_2B)))
#define _BYTE_3 ((uint32_t)(0xff << (_SHIFT_3B)))

#pragma GCC diagnostic push
#pragma GCC diagnostic ignored "-Wshift-count-overflow"
uint32_t w2_bin_hton32(uint32_t h32) {
	if (g_w2_endianness == W2_ENDIAN_BIG) return h32;
	return ((h32 & _BYTE_0) << _SHIFT_3B) | ((h32 & _BYTE_1) << _SHIFT_1B) |
		   ((h32 & _BYTE_2) >> _SHIFT_1B) | ((h32 & _BYTE_3) >> _SHIFT_3B);
}
#pragma GCC diagnostic pop

uint16_t w2_bin_hton16(uint16_t h16) {
	if (g_w2_endianness == W2_ENDIAN_BIG) return h16;
	return ((h16 & _BYTE_0) << _SHIFT_1B) | ((h16 & _BYTE_1) >> _SHIFT_1B);
}

uint32_t w2_bin_ntoh32(uint32_t n32) { return w2_bin_hton32(n32); }
uint16_t w2_bin_ntoh16(uint16_t n16) { return w2_bin_hton16(n16); }