1 /* SPDX-License-Identifier: LGPL-2.1+ */
3 This file is part of systemd.
5 Copyright 2013 Lennart Poettering
7 systemd is free software; you can redistribute it and/or modify it
8 under the terms of the GNU Lesser General Public License as published by
9 the Free Software Foundation; either version 2.1 of the License, or
10 (at your option) any later version.
12 systemd is distributed in the hope that it will be useful, but
13 WITHOUT ANY WARRANTY; without even the implied warranty of
14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 Lesser General Public License for more details.
17 You should have received a copy of the GNU Lesser General Public License
18 along with systemd; If not, see <http://www.gnu.org/licenses/>.
26 #include "bus-gvariant.h"
27 #include "bus-signature.h"
30 int bus_gvariant_get_size(const char *signature
) {
34 /* For fixed size structs. Fails for variable size structs. */
40 r
= signature_element_length(p
, &n
);
49 r
= bus_gvariant_get_alignment(t
);
53 sum
= ALIGN_TO(sum
, r
);
58 case SD_BUS_TYPE_BOOLEAN
:
59 case SD_BUS_TYPE_BYTE
:
63 case SD_BUS_TYPE_INT16
:
64 case SD_BUS_TYPE_UINT16
:
68 case SD_BUS_TYPE_INT32
:
69 case SD_BUS_TYPE_UINT32
:
70 case SD_BUS_TYPE_UNIX_FD
:
74 case SD_BUS_TYPE_INT64
:
75 case SD_BUS_TYPE_UINT64
:
76 case SD_BUS_TYPE_DOUBLE
:
80 case SD_BUS_TYPE_STRUCT_BEGIN
:
81 case SD_BUS_TYPE_DICT_ENTRY_BEGIN
: {
83 /* unary type () has fixed size of 1 */
88 memcpy(t
, p
+ 1, n
- 2);
91 r
= bus_gvariant_get_size(t
);
100 case SD_BUS_TYPE_STRING
:
101 case SD_BUS_TYPE_OBJECT_PATH
:
102 case SD_BUS_TYPE_SIGNATURE
:
103 case SD_BUS_TYPE_ARRAY
:
104 case SD_BUS_TYPE_VARIANT
:
108 assert_not_reached("Unknown signature type");
114 r
= bus_gvariant_get_alignment(signature
);
118 return ALIGN_TO(sum
, r
);
121 int bus_gvariant_get_alignment(const char *signature
) {
122 size_t alignment
= 1;
127 while (*p
!= 0 && alignment
< 8) {
131 r
= signature_element_length(p
, &n
);
137 case SD_BUS_TYPE_BYTE
:
138 case SD_BUS_TYPE_BOOLEAN
:
139 case SD_BUS_TYPE_STRING
:
140 case SD_BUS_TYPE_OBJECT_PATH
:
141 case SD_BUS_TYPE_SIGNATURE
:
145 case SD_BUS_TYPE_INT16
:
146 case SD_BUS_TYPE_UINT16
:
150 case SD_BUS_TYPE_INT32
:
151 case SD_BUS_TYPE_UINT32
:
152 case SD_BUS_TYPE_UNIX_FD
:
156 case SD_BUS_TYPE_INT64
:
157 case SD_BUS_TYPE_UINT64
:
158 case SD_BUS_TYPE_DOUBLE
:
159 case SD_BUS_TYPE_VARIANT
:
163 case SD_BUS_TYPE_ARRAY
: {
166 memcpy(t
, p
+ 1, n
- 1);
169 a
= bus_gvariant_get_alignment(t
);
173 case SD_BUS_TYPE_STRUCT_BEGIN
:
174 case SD_BUS_TYPE_DICT_ENTRY_BEGIN
: {
177 memcpy(t
, p
+ 1, n
- 2);
180 a
= bus_gvariant_get_alignment(t
);
185 assert_not_reached("Unknown signature type");
191 assert(a
> 0 && a
<= 8);
192 if ((size_t) a
> alignment
)
193 alignment
= (size_t) a
;
201 int bus_gvariant_is_fixed_size(const char *signature
) {
211 r
= signature_element_length(p
, &n
);
217 case SD_BUS_TYPE_STRING
:
218 case SD_BUS_TYPE_OBJECT_PATH
:
219 case SD_BUS_TYPE_SIGNATURE
:
220 case SD_BUS_TYPE_ARRAY
:
221 case SD_BUS_TYPE_VARIANT
:
224 case SD_BUS_TYPE_BYTE
:
225 case SD_BUS_TYPE_BOOLEAN
:
226 case SD_BUS_TYPE_INT16
:
227 case SD_BUS_TYPE_UINT16
:
228 case SD_BUS_TYPE_INT32
:
229 case SD_BUS_TYPE_UINT32
:
230 case SD_BUS_TYPE_UNIX_FD
:
231 case SD_BUS_TYPE_INT64
:
232 case SD_BUS_TYPE_UINT64
:
233 case SD_BUS_TYPE_DOUBLE
:
236 case SD_BUS_TYPE_STRUCT_BEGIN
:
237 case SD_BUS_TYPE_DICT_ENTRY_BEGIN
: {
240 memcpy(t
, p
+ 1, n
- 2);
243 r
= bus_gvariant_is_fixed_size(t
);
250 assert_not_reached("Unknown signature type");
259 size_t bus_gvariant_determine_word_size(size_t sz
, size_t extra
) {
260 if (sz
+ extra
<= 0xFF)
262 else if (sz
+ extra
*2 <= 0xFFFF)
264 else if (sz
+ extra
*4 <= 0xFFFFFFFF)
270 size_t bus_gvariant_read_word_le(void *p
, size_t sz
) {
280 return *(uint8_t*) p
;
285 return le16toh(x
.u16
);
287 return le32toh(x
.u32
);
289 return le64toh(x
.u64
);
291 assert_not_reached("unknown word width");
294 void bus_gvariant_write_word_le(void *p
, size_t sz
, size_t value
) {
302 assert(sz
== 8 || (value
< (1ULL << (sz
*8))));
305 *(uint8_t*) p
= value
;
308 x
.u16
= htole16((uint16_t) value
);
310 x
.u32
= htole32((uint32_t) value
);
312 x
.u64
= htole64((uint64_t) value
);
314 assert_not_reached("unknown word width");