1 /*-*- Mode: C; c-basic-offset: 8; indent-tabs-mode: nil -*-*/
4 This file is part of systemd.
6 Copyright 2013 Lennart Poettering
8 systemd is free software; you can redistribute it and/or modify it
9 under the terms of the GNU Lesser General Public License as published by
10 the Free Software Foundation; either version 2.1 of the License, or
11 (at your option) any later version.
13 systemd is distributed in the hope that it will be useful, but
14 WITHOUT ANY WARRANTY; without even the implied warranty of
15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 Lesser General Public License for more details.
18 You should have received a copy of the GNU Lesser General Public License
19 along with systemd; If not, see <http://www.gnu.org/licenses/>.
24 #include "bus-gvariant.h"
25 #include "bus-signature.h"
27 int bus_gvariant_get_size(const char *signature
) {
31 /* For fixed size structs. Fails for variable size structs. */
37 r
= signature_element_length(p
, &n
);
46 r
= bus_gvariant_get_alignment(t
);
50 sum
= ALIGN_TO(sum
, r
);
55 case SD_BUS_TYPE_BOOLEAN
:
56 case SD_BUS_TYPE_BYTE
:
60 case SD_BUS_TYPE_INT16
:
61 case SD_BUS_TYPE_UINT16
:
65 case SD_BUS_TYPE_INT32
:
66 case SD_BUS_TYPE_UINT32
:
67 case SD_BUS_TYPE_UNIX_FD
:
71 case SD_BUS_TYPE_INT64
:
72 case SD_BUS_TYPE_UINT64
:
73 case SD_BUS_TYPE_DOUBLE
:
77 case SD_BUS_TYPE_STRUCT_BEGIN
:
78 case SD_BUS_TYPE_DICT_ENTRY_BEGIN
: {
81 memcpy(t
, p
+ 1, n
- 2);
84 r
= bus_gvariant_get_size(t
);
92 case SD_BUS_TYPE_STRING
:
93 case SD_BUS_TYPE_OBJECT_PATH
:
94 case SD_BUS_TYPE_SIGNATURE
:
95 case SD_BUS_TYPE_ARRAY
:
96 case SD_BUS_TYPE_VARIANT
:
100 assert_not_reached("Unknown signature type");
106 r
= bus_gvariant_get_alignment(signature
);
110 return ALIGN_TO(sum
, r
);
113 int bus_gvariant_get_alignment(const char *signature
) {
114 size_t alignment
= 1;
119 while (*p
!= 0 && alignment
< 8) {
123 r
= signature_element_length(p
, &n
);
129 case SD_BUS_TYPE_BYTE
:
130 case SD_BUS_TYPE_BOOLEAN
:
131 case SD_BUS_TYPE_STRING
:
132 case SD_BUS_TYPE_OBJECT_PATH
:
133 case SD_BUS_TYPE_SIGNATURE
:
137 case SD_BUS_TYPE_INT16
:
138 case SD_BUS_TYPE_UINT16
:
142 case SD_BUS_TYPE_INT32
:
143 case SD_BUS_TYPE_UINT32
:
144 case SD_BUS_TYPE_UNIX_FD
:
148 case SD_BUS_TYPE_INT64
:
149 case SD_BUS_TYPE_UINT64
:
150 case SD_BUS_TYPE_DOUBLE
:
151 case SD_BUS_TYPE_VARIANT
:
155 case SD_BUS_TYPE_ARRAY
: {
158 memcpy(t
, p
+ 1, n
- 1);
161 a
= bus_gvariant_get_alignment(t
);
165 case SD_BUS_TYPE_STRUCT_BEGIN
:
166 case SD_BUS_TYPE_DICT_ENTRY_BEGIN
: {
169 memcpy(t
, p
+ 1, n
- 2);
172 a
= bus_gvariant_get_alignment(t
);
177 assert_not_reached("Unknown signature type");
183 assert(a
> 0 && a
<= 8);
184 if ((size_t) a
> alignment
)
185 alignment
= (size_t) a
;
193 int bus_gvariant_is_fixed_size(const char *signature
) {
203 r
= signature_element_length(p
, &n
);
209 case SD_BUS_TYPE_STRING
:
210 case SD_BUS_TYPE_OBJECT_PATH
:
211 case SD_BUS_TYPE_SIGNATURE
:
212 case SD_BUS_TYPE_ARRAY
:
213 case SD_BUS_TYPE_VARIANT
:
216 case SD_BUS_TYPE_BYTE
:
217 case SD_BUS_TYPE_BOOLEAN
:
218 case SD_BUS_TYPE_INT16
:
219 case SD_BUS_TYPE_UINT16
:
220 case SD_BUS_TYPE_INT32
:
221 case SD_BUS_TYPE_UINT32
:
222 case SD_BUS_TYPE_UNIX_FD
:
223 case SD_BUS_TYPE_INT64
:
224 case SD_BUS_TYPE_UINT64
:
225 case SD_BUS_TYPE_DOUBLE
:
228 case SD_BUS_TYPE_STRUCT_BEGIN
:
229 case SD_BUS_TYPE_DICT_ENTRY_BEGIN
: {
232 memcpy(t
, p
+ 1, n
- 2);
235 r
= bus_gvariant_is_fixed_size(t
);
242 assert_not_reached("Unknown signature type");
251 size_t bus_gvariant_determine_word_size(size_t sz
, size_t extra
) {
252 if (sz
+ extra
<= 0xFF)
254 else if (sz
+ extra
*2 <= 0xFFFF)
256 else if (sz
+ extra
*4 <= 0xFFFFFFFF)
262 size_t bus_gvariant_read_word_le(void *p
, size_t sz
) {
272 return *(uint8_t*) p
;
277 return le16toh(x
.u16
);
279 return le32toh(x
.u32
);
281 return le64toh(x
.u64
);
283 assert_not_reached("unknown word width");
286 void bus_gvariant_write_word_le(void *p
, size_t sz
, size_t value
) {
294 assert(sz
== 8 || (value
< (1ULL << (sz
*8))));
297 *(uint8_t*) p
= value
;
300 x
.u16
= htole16((uint16_t) value
);
302 x
.u32
= htole32((uint32_t) value
);
304 x
.u64
= htole64((uint64_t) value
);
306 assert_not_reached("unknown word width");