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
|
/*
* This file is part of the libjaylink project.
*
* Copyright (C) 2014-2015 Marc Schink <jaylink-dev@marcschink.de>
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
#include <stdint.h>
#include <string.h>
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include "libjaylink-internal.h"
/**
* @file
*
* Buffer helper functions.
*/
/**
* Write a 16-bit unsigned integer value to a buffer.
*
* The value is stored in the buffer in device byte order.
*
* @param[out] buffer Buffer to write the value into.
* @param[in] value Value to write into the buffer in host byte order.
* @param[in] offset Offset of the value within the buffer in bytes.
*/
JAYLINK_PRIV void buffer_set_u16(uint8_t *buffer, uint16_t value,
size_t offset)
{
/*
* Store the value in the buffer and swap byte order depending on the
* host byte order.
*/
#ifdef WORDS_BIGENDIAN
buffer[offset + 0] = value;
buffer[offset + 1] = value >> 8;
#else
memcpy(buffer + offset, &value, sizeof(value));
#endif
}
/**
* Read a 16-bit unsigned integer value from a buffer.
*
* The value in the buffer is expected to be stored in device byte order.
*
* @param[in] buffer Buffer to read the value from.
* @param[in] offset Offset of the value within the buffer in bytes.
*
* @return The value read from the buffer in host byte order.
*/
JAYLINK_PRIV uint16_t buffer_get_u16(const uint8_t *buffer, size_t offset)
{
uint16_t value;
/*
* Read the value from the buffer and swap byte order depending on the
* host byte order.
*/
#ifdef WORDS_BIGENDIAN
value = (((uint16_t)buffer[offset + 1])) | \
(((uint16_t)buffer[offset + 0]) << 8);
#else
memcpy(&value, buffer + offset, sizeof(value));
#endif
return value;
}
/**
* Write a 32-bit unsigned integer value to a buffer.
*
* The value is stored in the buffer in device byte order.
*
* @param[out] buffer Buffer to write the value into.
* @param[in] value Value to write into the buffer in host byte order.
* @param[in] offset Offset of the value within the buffer in bytes.
*/
JAYLINK_PRIV void buffer_set_u32(uint8_t *buffer, uint32_t value,
size_t offset)
{
/*
* Store the value in the buffer and swap byte order depending on the
* host byte order.
*/
#ifdef WORDS_BIGENDIAN
buffer[offset + 0] = value;
buffer[offset + 1] = value >> 8;
buffer[offset + 2] = value >> 16;
buffer[offset + 3] = value >> 24;
#else
memcpy(buffer + offset, &value, sizeof(value));
#endif
}
/**
* Read a 32-bit unsigned integer value from a buffer.
*
* The value in the buffer is expected to be stored in device byte order.
*
* @param[in] buffer Buffer to read the value from.
* @param[in] offset Offset of the value within the buffer in bytes.
*
* @return The value read from the buffer in host byte order.
*/
JAYLINK_PRIV uint32_t buffer_get_u32(const uint8_t *buffer, size_t offset)
{
uint32_t value;
/*
* Read the value from the buffer and swap byte order depending on the
* host byte order.
*/
#ifdef WORDS_BIGENDIAN
value = (((uint32_t)buffer[offset + 3])) | \
(((uint32_t)buffer[offset + 2]) << 8) | \
(((uint32_t)buffer[offset + 1]) << 16) | \
(((uint32_t)buffer[offset + 0]) << 24);
#else
memcpy(&value, buffer + offset, sizeof(value));
#endif
return value;
}
|