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/>.
21 #include "bus-gvariant.h"
22 #include "bus-signature.h"
25 int bus_gvariant_get_size(const char *signature
) {
29 /* For fixed size structs. Fails for variable size structs. */
35 r
= signature_element_length(p
, &n
);
44 r
= bus_gvariant_get_alignment(t
);
48 sum
= ALIGN_TO(sum
, r
);
53 case SD_BUS_TYPE_BOOLEAN
:
54 case SD_BUS_TYPE_BYTE
:
58 case SD_BUS_TYPE_INT16
:
59 case SD_BUS_TYPE_UINT16
:
63 case SD_BUS_TYPE_INT32
:
64 case SD_BUS_TYPE_UINT32
:
65 case SD_BUS_TYPE_UNIX_FD
:
69 case SD_BUS_TYPE_INT64
:
70 case SD_BUS_TYPE_UINT64
:
71 case SD_BUS_TYPE_DOUBLE
:
75 case SD_BUS_TYPE_STRUCT_BEGIN
:
76 case SD_BUS_TYPE_DICT_ENTRY_BEGIN
: {
78 /* unary type () has fixed size of 1 */
83 memcpy(t
, p
+ 1, n
- 2);
86 r
= bus_gvariant_get_size(t
);
95 case SD_BUS_TYPE_STRING
:
96 case SD_BUS_TYPE_OBJECT_PATH
:
97 case SD_BUS_TYPE_SIGNATURE
:
98 case SD_BUS_TYPE_ARRAY
:
99 case SD_BUS_TYPE_VARIANT
:
103 assert_not_reached("Unknown signature type");
109 r
= bus_gvariant_get_alignment(signature
);
113 return ALIGN_TO(sum
, r
);
116 int bus_gvariant_get_alignment(const char *signature
) {
117 size_t alignment
= 1;
122 while (*p
!= 0 && alignment
< 8) {
126 r
= signature_element_length(p
, &n
);
132 case SD_BUS_TYPE_BYTE
:
133 case SD_BUS_TYPE_BOOLEAN
:
134 case SD_BUS_TYPE_STRING
:
135 case SD_BUS_TYPE_OBJECT_PATH
:
136 case SD_BUS_TYPE_SIGNATURE
:
140 case SD_BUS_TYPE_INT16
:
141 case SD_BUS_TYPE_UINT16
:
145 case SD_BUS_TYPE_INT32
:
146 case SD_BUS_TYPE_UINT32
:
147 case SD_BUS_TYPE_UNIX_FD
:
151 case SD_BUS_TYPE_INT64
:
152 case SD_BUS_TYPE_UINT64
:
153 case SD_BUS_TYPE_DOUBLE
:
154 case SD_BUS_TYPE_VARIANT
:
158 case SD_BUS_TYPE_ARRAY
: {
161 memcpy(t
, p
+ 1, n
- 1);
164 a
= bus_gvariant_get_alignment(t
);
168 case SD_BUS_TYPE_STRUCT_BEGIN
:
169 case SD_BUS_TYPE_DICT_ENTRY_BEGIN
: {
172 memcpy(t
, p
+ 1, n
- 2);
175 a
= bus_gvariant_get_alignment(t
);
180 assert_not_reached("Unknown signature type");
186 assert(a
> 0 && a
<= 8);
187 if ((size_t) a
> alignment
)
188 alignment
= (size_t) a
;
196 int bus_gvariant_is_fixed_size(const char *signature
) {
206 r
= signature_element_length(p
, &n
);
212 case SD_BUS_TYPE_STRING
:
213 case SD_BUS_TYPE_OBJECT_PATH
:
214 case SD_BUS_TYPE_SIGNATURE
:
215 case SD_BUS_TYPE_ARRAY
:
216 case SD_BUS_TYPE_VARIANT
:
219 case SD_BUS_TYPE_BYTE
:
220 case SD_BUS_TYPE_BOOLEAN
:
221 case SD_BUS_TYPE_INT16
:
222 case SD_BUS_TYPE_UINT16
:
223 case SD_BUS_TYPE_INT32
:
224 case SD_BUS_TYPE_UINT32
:
225 case SD_BUS_TYPE_UNIX_FD
:
226 case SD_BUS_TYPE_INT64
:
227 case SD_BUS_TYPE_UINT64
:
228 case SD_BUS_TYPE_DOUBLE
:
231 case SD_BUS_TYPE_STRUCT_BEGIN
:
232 case SD_BUS_TYPE_DICT_ENTRY_BEGIN
: {
235 memcpy(t
, p
+ 1, n
- 2);
238 r
= bus_gvariant_is_fixed_size(t
);
245 assert_not_reached("Unknown signature type");
254 size_t bus_gvariant_determine_word_size(size_t sz
, size_t extra
) {
255 if (sz
+ extra
<= 0xFF)
257 else if (sz
+ extra
*2 <= 0xFFFF)
259 else if (sz
+ extra
*4 <= 0xFFFFFFFF)
265 size_t bus_gvariant_read_word_le(void *p
, size_t sz
) {
275 return *(uint8_t*) p
;
280 return le16toh(x
.u16
);
282 return le32toh(x
.u32
);
284 return le64toh(x
.u64
);
286 assert_not_reached("unknown word width");
289 void bus_gvariant_write_word_le(void *p
, size_t sz
, size_t value
) {
297 assert(sz
== 8 || (value
< (1ULL << (sz
*8))));
300 *(uint8_t*) p
= value
;
303 x
.u16
= htole16((uint16_t) value
);
305 x
.u32
= htole32((uint32_t) value
);
307 x
.u64
= htole64((uint64_t) value
);
309 assert_not_reached("unknown word width");