[thirdparty/systemd.git] / src / libsystemd / sd-bus / bus-gvariant.c

/* SPDX-License-Identifier: LGPL-2.1+ */

#include <errno.h>
#include <string.h>

#include "sd-bus.h"

#include "bus-gvariant.h"
#include "bus-signature.h"
#include "bus-type.h"

int bus_gvariant_get_size(const char *signature) {
        const char *p;
        int sum = 0, r;

        /* For fixed size structs. Fails for variable size structs. */

        p = signature;
        while (*p != 0) {
                size_t n;

                r = signature_element_length(p, &n);
                if (r < 0)
                        return r;
                else {
                        char t[n+1];

                        memcpy(t, p, n);
                        t[n] = 0;

                        r = bus_gvariant_get_alignment(t);
                        if (r < 0)
                                return r;

                        sum = ALIGN_TO(sum, r);
                }

                switch (*p) {

                case SD_BUS_TYPE_BOOLEAN:
                case SD_BUS_TYPE_BYTE:
                        sum += 1;
                        break;

                case SD_BUS_TYPE_INT16:
                case SD_BUS_TYPE_UINT16:
                        sum += 2;
                        break;

                case SD_BUS_TYPE_INT32:
                case SD_BUS_TYPE_UINT32:
                case SD_BUS_TYPE_UNIX_FD:
                        sum += 4;
                        break;

                case SD_BUS_TYPE_INT64:
                case SD_BUS_TYPE_UINT64:
                case SD_BUS_TYPE_DOUBLE:
                        sum += 8;
                        break;

                case SD_BUS_TYPE_STRUCT_BEGIN:
                case SD_BUS_TYPE_DICT_ENTRY_BEGIN: {
                        if (n == 2) {
                                /* unary type () has fixed size of 1 */
                                r = 1;
                        } else {
                                char t[n-1];

                                memcpy(t, p + 1, n - 2);
                                t[n - 2] = 0;

                                r = bus_gvariant_get_size(t);
                                if (r < 0)
                                        return r;
                        }

                        sum += r;
                        break;
                }

                case SD_BUS_TYPE_STRING:
                case SD_BUS_TYPE_OBJECT_PATH:
                case SD_BUS_TYPE_SIGNATURE:
                case SD_BUS_TYPE_ARRAY:
                case SD_BUS_TYPE_VARIANT:
                        return -EINVAL;

                default:
                        assert_not_reached("Unknown signature type");
                }

                p += n;
        }

        r = bus_gvariant_get_alignment(signature);
        if (r < 0)
                return r;

        return ALIGN_TO(sum, r);
}

int bus_gvariant_get_alignment(const char *signature) {
        size_t alignment = 1;
        const char *p;
        int r;

        p = signature;
        while (*p != 0 && alignment < 8) {
                size_t n;
                int a;

                r = signature_element_length(p, &n);
                if (r < 0)
                        return r;

                switch (*p) {

                case SD_BUS_TYPE_BYTE:
                case SD_BUS_TYPE_BOOLEAN:
                case SD_BUS_TYPE_STRING:
                case SD_BUS_TYPE_OBJECT_PATH:
                case SD_BUS_TYPE_SIGNATURE:
                        a = 1;
                        break;

                case SD_BUS_TYPE_INT16:
                case SD_BUS_TYPE_UINT16:
                        a = 2;
                        break;

                case SD_BUS_TYPE_INT32:
                case SD_BUS_TYPE_UINT32:
                case SD_BUS_TYPE_UNIX_FD:
                        a = 4;
                        break;

                case SD_BUS_TYPE_INT64:
                case SD_BUS_TYPE_UINT64:
                case SD_BUS_TYPE_DOUBLE:
                case SD_BUS_TYPE_VARIANT:
                        a = 8;
                        break;

                case SD_BUS_TYPE_ARRAY: {
                        char t[n];

                        memcpy(t, p + 1, n - 1);
                        t[n - 1] = 0;

                        a = bus_gvariant_get_alignment(t);
                        break;
                }

                case SD_BUS_TYPE_STRUCT_BEGIN:
                case SD_BUS_TYPE_DICT_ENTRY_BEGIN: {
                        char t[n-1];

                        memcpy(t, p + 1, n - 2);
                        t[n - 2] = 0;

                        a = bus_gvariant_get_alignment(t);
                        break;
                }

                default:
                        assert_not_reached("Unknown signature type");
                }

                if (a < 0)
                        return a;

                assert(a > 0 && a <= 8);
                if ((size_t) a > alignment)
                        alignment = (size_t) a;

                p += n;
        }

        return alignment;
}

int bus_gvariant_is_fixed_size(const char *signature) {
        const char *p;
        int r;

        assert(signature);

        p = signature;
        while (*p != 0) {
                size_t n;

                r = signature_element_length(p, &n);
                if (r < 0)
                        return r;

                switch (*p) {

                case SD_BUS_TYPE_STRING:
                case SD_BUS_TYPE_OBJECT_PATH:
                case SD_BUS_TYPE_SIGNATURE:
                case SD_BUS_TYPE_ARRAY:
                case SD_BUS_TYPE_VARIANT:
                        return 0;

                case SD_BUS_TYPE_BYTE:
                case SD_BUS_TYPE_BOOLEAN:
                case SD_BUS_TYPE_INT16:
                case SD_BUS_TYPE_UINT16:
                case SD_BUS_TYPE_INT32:
                case SD_BUS_TYPE_UINT32:
                case SD_BUS_TYPE_UNIX_FD:
                case SD_BUS_TYPE_INT64:
                case SD_BUS_TYPE_UINT64:
                case SD_BUS_TYPE_DOUBLE:
                        break;

                case SD_BUS_TYPE_STRUCT_BEGIN:
                case SD_BUS_TYPE_DICT_ENTRY_BEGIN: {
                        char t[n-1];

                        memcpy(t, p + 1, n - 2);
                        t[n - 2] = 0;

                        r = bus_gvariant_is_fixed_size(t);
                        if (r <= 0)
                                return r;
                        break;
                }

                default:
                        assert_not_reached("Unknown signature type");
                }

                p += n;
        }

        return true;
}

size_t bus_gvariant_determine_word_size(size_t sz, size_t extra) {
        if (sz + extra <= 0xFF)
                return 1;
        else if (sz + extra*2 <= 0xFFFF)
                return 2;
        else if (sz + extra*4 <= 0xFFFFFFFF)
                return 4;
        else
                return 8;
}

size_t bus_gvariant_read_word_le(void *p, size_t sz) {
        union {
                uint16_t u16;
                uint32_t u32;
                uint64_t u64;
        } x;

        assert(p);

        if (sz == 1)
                return *(uint8_t*) p;

        memcpy(&x, p, sz);

        if (sz == 2)
                return le16toh(x.u16);
        else if (sz == 4)
                return le32toh(x.u32);
        else if (sz == 8)
                return le64toh(x.u64);

        assert_not_reached("unknown word width");
}

void bus_gvariant_write_word_le(void *p, size_t sz, size_t value) {
        union {
                uint16_t u16;
                uint32_t u32;
                uint64_t u64;
        } x;

        assert(p);
        assert(sz == 8 || (value < (1ULL << (sz*8))));

        if (sz == 1) {
                *(uint8_t*) p = value;
                return;
        } else if (sz == 2)
                x.u16 = htole16((uint16_t) value);
        else if (sz == 4)
                x.u32 = htole32((uint32_t) value);
        else if (sz == 8)
                x.u64 = htole64((uint64_t) value);
        else
                assert_not_reached("unknown word width");

        memcpy(p, &x, sz);
}
Commit	Line	Data
53e1b683	1	/* SPDX-License-Identifier: LGPL-2.1+ */
c1b9d935	2
dccca82b LP	3	#include <errno.h>
	4	#include <string.h>
	5
	6	#include "sd-bus.h"
	7
c1b9d935 LP	8	#include "bus-gvariant.h"
c1b9d935 LP	9	#include "bus-signature.h"
cf0fbc49	10	#include "bus-type.h"
c1b9d935	11
6647dc66 LP	12	int bus_gvariant_get_size(const char *signature) {
	13	const char *p;
	14	int sum = 0, r;
c1b9d935	15
6647dc66	16	/* For fixed size structs. Fails for variable size structs. */
c1b9d935	17
6647dc66 LP	18	p = signature;
	19	while (*p != 0) {
	20	size_t n;
c1b9d935	21
6647dc66 LP	22	r = signature_element_length(p, &n);
	23	if (r < 0)
	24	return r;
	25	else {
	26	char t[n+1];
	27
	28	memcpy(t, p, n);
	29	t[n] = 0;
c1b9d935	30
6647dc66 LP	31	r = bus_gvariant_get_alignment(t);
	32	if (r < 0)
	33	return r;
c1b9d935	34
6647dc66 LP	35	sum = ALIGN_TO(sum, r);
	36	}
	37
	38	switch (*p) {
	39
	40	case SD_BUS_TYPE_BOOLEAN:
	41	case SD_BUS_TYPE_BYTE:
	42	sum += 1;
	43	break;
	44
	45	case SD_BUS_TYPE_INT16:
	46	case SD_BUS_TYPE_UINT16:
	47	sum += 2;
	48	break;
	49
	50	case SD_BUS_TYPE_INT32:
	51	case SD_BUS_TYPE_UINT32:
	52	case SD_BUS_TYPE_UNIX_FD:
	53	sum += 4;
	54	break;
	55
	56	case SD_BUS_TYPE_INT64:
	57	case SD_BUS_TYPE_UINT64:
	58	case SD_BUS_TYPE_DOUBLE:
	59	sum += 8;
	60	break;
	61
	62	case SD_BUS_TYPE_STRUCT_BEGIN:
	63	case SD_BUS_TYPE_DICT_ENTRY_BEGIN: {
e53d21d0 DH	64	if (n == 2) {
	65	/* unary type () has fixed size of 1 */
	66	r = 1;
	67	} else {
	68	char t[n-1];
	69
	70	memcpy(t, p + 1, n - 2);
	71	t[n - 2] = 0;
	72
	73	r = bus_gvariant_get_size(t);
	74	if (r < 0)
	75	return r;
	76	}
6647dc66 LP	77
	78	sum += r;
	79	break;
	80	}
	81
	82	case SD_BUS_TYPE_STRING:
	83	case SD_BUS_TYPE_OBJECT_PATH:
	84	case SD_BUS_TYPE_SIGNATURE:
	85	case SD_BUS_TYPE_ARRAY:
	86	case SD_BUS_TYPE_VARIANT:
	87	return -EINVAL;
	88
	89	default:
	90	assert_not_reached("Unknown signature type");
	91	}
	92
	93	p += n;
c1b9d935 LP	94	}
c1b9d935 LP	95
6647dc66 LP	96	r = bus_gvariant_get_alignment(signature);
	97	if (r < 0)
	98	return r;
	99
	100	return ALIGN_TO(sum, r);
c1b9d935 LP	101	}
	102
	103	int bus_gvariant_get_alignment(const char *signature) {
	104	size_t alignment = 1;
	105	const char *p;
	106	int r;
	107
	108	p = signature;
	109	while (*p != 0 && alignment < 8) {
	110	size_t n;
	111	int a;
	112
	113	r = signature_element_length(p, &n);
	114	if (r < 0)
	115	return r;
	116
	117	switch (*p) {
	118
	119	case SD_BUS_TYPE_BYTE:
	120	case SD_BUS_TYPE_BOOLEAN:
	121	case SD_BUS_TYPE_STRING:
	122	case SD_BUS_TYPE_OBJECT_PATH:
	123	case SD_BUS_TYPE_SIGNATURE:
	124	a = 1;
	125	break;
	126
	127	case SD_BUS_TYPE_INT16:
	128	case SD_BUS_TYPE_UINT16:
	129	a = 2;
	130	break;
	131
	132	case SD_BUS_TYPE_INT32:
	133	case SD_BUS_TYPE_UINT32:
	134	case SD_BUS_TYPE_UNIX_FD:
	135	a = 4;
	136	break;
	137
	138	case SD_BUS_TYPE_INT64:
	139	case SD_BUS_TYPE_UINT64:
	140	case SD_BUS_TYPE_DOUBLE:
	141	case SD_BUS_TYPE_VARIANT:
	142	a = 8;
	143	break;
	144
	145	case SD_BUS_TYPE_ARRAY: {
	146	char t[n];
	147
	148	memcpy(t, p + 1, n - 1);
	149	t[n - 1] = 0;
	150
	151	a = bus_gvariant_get_alignment(t);
	152	break;
	153	}
	154
	155	case SD_BUS_TYPE_STRUCT_BEGIN:
	156	case SD_BUS_TYPE_DICT_ENTRY_BEGIN: {
	157	char t[n-1];
	158
	159	memcpy(t, p + 1, n - 2);
	160	t[n - 2] = 0;
	161
	162	a = bus_gvariant_get_alignment(t);
	163	break;
	164	}
165
166	default:
167	assert_not_reached("Unknown signature type");
168	}
169
170	if (a < 0)
171	return a;
172
173	assert(a > 0 && a <= 8);
174	if ((size_t) a > alignment)
175	alignment = (size_t) a;
176
177	p += n;
178	}
179
180	return alignment;
181	}
182
183	int bus_gvariant_is_fixed_size(const char *signature) {
184	const char *p;
185	int r;
186
187	assert(signature);
188
189	p = signature;
190	while (*p != 0) {
191	size_t n;
192
193	r = signature_element_length(p, &n);
194	if (r < 0)
195	return r;
196
197	switch (*p) {
198
199	case SD_BUS_TYPE_STRING:
200	case SD_BUS_TYPE_OBJECT_PATH:
201	case SD_BUS_TYPE_SIGNATURE:
202	case SD_BUS_TYPE_ARRAY:
203	case SD_BUS_TYPE_VARIANT:
204	return 0;
205
206	case SD_BUS_TYPE_BYTE:
207	case SD_BUS_TYPE_BOOLEAN:
208	case SD_BUS_TYPE_INT16:
209	case SD_BUS_TYPE_UINT16:
210	case SD_BUS_TYPE_INT32:
211	case SD_BUS_TYPE_UINT32:
212	case SD_BUS_TYPE_UNIX_FD:
213	case SD_BUS_TYPE_INT64:
214	case SD_BUS_TYPE_UINT64:
215	case SD_BUS_TYPE_DOUBLE:
216	break;
217
218	case SD_BUS_TYPE_STRUCT_BEGIN:
219	case SD_BUS_TYPE_DICT_ENTRY_BEGIN: {
220	char t[n-1];
221
222	memcpy(t, p + 1, n - 2);
223	t[n - 2] = 0;
224
225	r = bus_gvariant_is_fixed_size(t);
226	if (r <= 0)
227	return r;
228	break;
229	}
230
231	default:
232	assert_not_reached("Unknown signature type");
233	}
234
235	p += n;
236	}
237
238	return true;
239	}
2ac7c17f LP	240
	241	size_t bus_gvariant_determine_word_size(size_t sz, size_t extra) {
	242	if (sz + extra <= 0xFF)
	243	return 1;
	244	else if (sz + extra*2 <= 0xFFFF)
	245	return 2;
	246	else if (sz + extra*4 <= 0xFFFFFFFF)
	247	return 4;
	248	else
	249	return 8;
	250	}
	251
	252	size_t bus_gvariant_read_word_le(void *p, size_t sz) {
	253	union {
	254	uint16_t u16;
	255	uint32_t u32;
	256	uint64_t u64;
	257	} x;
	258
	259	assert(p);
	260
	261	if (sz == 1)
	262	return (uint8_t) p;
	263
	264	memcpy(&x, p, sz);
	265
	266	if (sz == 2)
	267	return le16toh(x.u16);
	268	else if (sz == 4)
	269	return le32toh(x.u32);
	270	else if (sz == 8)
	271	return le64toh(x.u64);
	272
	273	assert_not_reached("unknown word width");
	274	}
	275
	276	void bus_gvariant_write_word_le(void *p, size_t sz, size_t value) {
	277	union {
	278	uint16_t u16;
	279	uint32_t u32;
	280	uint64_t u64;
	281	} x;
	282
	283	assert(p);
	284	assert(sz == 8 \|\| (value < (1ULL << (sz*8))));
	285
	286	if (sz == 1) {
	287	(uint8_t) p = value;
	288	return;
	289	} else if (sz == 2)
	290	x.u16 = htole16((uint16_t) value);
	291	else if (sz == 4)
	292	x.u32 = htole32((uint32_t) value);
	293	else if (sz == 8)
	294	x.u64 = htole64((uint64_t) value);
	295	else
	296	assert_not_reached("unknown word width");
	297
	298	memcpy(p, &x, sz);
	299	}