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/>.
23 #include "bus-gvariant.h"
24 #include "bus-signature.h"
26 int bus_gvariant_get_size(const char *signature) {
30 /* For fixed size structs. Fails for variable size structs. */
36 r = signature_element_length(p, &n);
45 r = bus_gvariant_get_alignment(t);
49 sum = ALIGN_TO(sum, r);
54 case SD_BUS_TYPE_BOOLEAN:
55 case SD_BUS_TYPE_BYTE:
59 case SD_BUS_TYPE_INT16:
60 case SD_BUS_TYPE_UINT16:
64 case SD_BUS_TYPE_INT32:
65 case SD_BUS_TYPE_UINT32:
66 case SD_BUS_TYPE_UNIX_FD:
70 case SD_BUS_TYPE_INT64:
71 case SD_BUS_TYPE_UINT64:
72 case SD_BUS_TYPE_DOUBLE:
76 case SD_BUS_TYPE_STRUCT_BEGIN:
77 case SD_BUS_TYPE_DICT_ENTRY_BEGIN: {
80 memcpy(t, p + 1, n - 2);
83 r = bus_gvariant_get_size(t);
91 case SD_BUS_TYPE_STRING:
92 case SD_BUS_TYPE_OBJECT_PATH:
93 case SD_BUS_TYPE_SIGNATURE:
94 case SD_BUS_TYPE_ARRAY:
95 case SD_BUS_TYPE_VARIANT:
99 assert_not_reached("Unknown signature type");
105 r = bus_gvariant_get_alignment(signature);
109 return ALIGN_TO(sum, r);
112 int bus_gvariant_get_alignment(const char *signature) {
113 size_t alignment = 1;
118 while (*p != 0 && alignment < 8) {
122 r = signature_element_length(p, &n);
128 case SD_BUS_TYPE_BYTE:
129 case SD_BUS_TYPE_BOOLEAN:
130 case SD_BUS_TYPE_STRING:
131 case SD_BUS_TYPE_OBJECT_PATH:
132 case SD_BUS_TYPE_SIGNATURE:
136 case SD_BUS_TYPE_INT16:
137 case SD_BUS_TYPE_UINT16:
141 case SD_BUS_TYPE_INT32:
142 case SD_BUS_TYPE_UINT32:
143 case SD_BUS_TYPE_UNIX_FD:
147 case SD_BUS_TYPE_INT64:
148 case SD_BUS_TYPE_UINT64:
149 case SD_BUS_TYPE_DOUBLE:
150 case SD_BUS_TYPE_VARIANT:
154 case SD_BUS_TYPE_ARRAY: {
157 memcpy(t, p + 1, n - 1);
160 a = bus_gvariant_get_alignment(t);
164 case SD_BUS_TYPE_STRUCT_BEGIN:
165 case SD_BUS_TYPE_DICT_ENTRY_BEGIN: {
168 memcpy(t, p + 1, n - 2);
171 a = bus_gvariant_get_alignment(t);
176 assert_not_reached("Unknown signature type");
182 assert(a > 0 && a <= 8);
183 if ((size_t) a > alignment)
184 alignment = (size_t) a;
192 int bus_gvariant_is_fixed_size(const char *signature) {
202 r = signature_element_length(p, &n);
208 case SD_BUS_TYPE_STRING:
209 case SD_BUS_TYPE_OBJECT_PATH:
210 case SD_BUS_TYPE_SIGNATURE:
211 case SD_BUS_TYPE_ARRAY:
212 case SD_BUS_TYPE_VARIANT:
215 case SD_BUS_TYPE_BYTE:
216 case SD_BUS_TYPE_BOOLEAN:
217 case SD_BUS_TYPE_INT16:
218 case SD_BUS_TYPE_UINT16:
219 case SD_BUS_TYPE_INT32:
220 case SD_BUS_TYPE_UINT32:
221 case SD_BUS_TYPE_UNIX_FD:
222 case SD_BUS_TYPE_INT64:
223 case SD_BUS_TYPE_UINT64:
224 case SD_BUS_TYPE_DOUBLE:
227 case SD_BUS_TYPE_STRUCT_BEGIN:
228 case SD_BUS_TYPE_DICT_ENTRY_BEGIN: {
231 memcpy(t, p + 1, n - 2);
234 r = bus_gvariant_is_fixed_size(t);
241 assert_not_reached("Unknown signature type");
250 size_t bus_gvariant_determine_word_size(size_t sz, size_t extra) {
251 if (sz + extra <= 0xFF)
253 else if (sz + extra*2 <= 0xFFFF)
255 else if (sz + extra*4 <= 0xFFFFFFFF)
261 size_t bus_gvariant_read_word_le(void *p, size_t sz) {
271 return *(uint8_t*) p;
276 return le16toh(x.u16);
278 return le32toh(x.u32);
280 return le64toh(x.u64);
282 assert_not_reached("unknown word width");
285 void bus_gvariant_write_word_le(void *p, size_t sz, size_t value) {
293 assert(sz == 8 || (value < (1ULL << (sz*8))));
296 *(uint8_t*) p = value;
299 x.u16 = htole16((uint16_t) value);
301 x.u32 = htole32((uint32_t) value);
303 x.u64 = htole64((uint64_t) value);
305 assert_not_reached("unknown word width");