2 * blob - library for generating/parsing tagged binary data
4 * Copyright (C) 2010 Felix Fietkau <nbd@openwrt.org>
6 * Permission to use, copy, modify, and/or distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
22 blob_buffer_grow(struct blob_buf
*buf
, int minlen
)
24 int delta
= ((minlen
/ 256) + 1) * 256;
26 buf
->buf
= realloc(buf
->buf
, buf
->buflen
);
28 memset(buf
->buf
+ buf
->buflen
- delta
, 0, delta
);
33 blob_init(struct blob_attr
*attr
, int id
, unsigned int len
)
35 len
&= BLOB_ATTR_LEN_MASK
;
36 len
|= (id
<< BLOB_ATTR_ID_SHIFT
) & BLOB_ATTR_ID_MASK
;
37 attr
->id_len
= cpu_to_be32(len
);
40 static inline struct blob_attr
*
41 offset_to_attr(struct blob_buf
*buf
, int offset
)
43 void *ptr
= (char *)buf
->buf
+ offset
;
48 attr_to_offset(struct blob_buf
*buf
, struct blob_attr
*attr
)
50 return (char *)attr
- (char *) buf
->buf
;
53 static struct blob_attr
*
54 blob_add(struct blob_buf
*buf
, struct blob_attr
*pos
, int id
, int payload
)
56 int offset
= attr_to_offset(buf
, pos
);
57 int required
= (offset
+ sizeof(struct blob_attr
) + payload
) - buf
->buflen
;
58 struct blob_attr
*attr
;
61 int offset_head
= attr_to_offset(buf
, buf
->head
);
63 if (!buf
->grow
|| !buf
->grow(buf
, required
))
66 buf
->head
= offset_to_attr(buf
, offset_head
);
67 attr
= offset_to_attr(buf
, offset
);
72 blob_init(attr
, id
, payload
+ sizeof(struct blob_attr
));
78 blob_buf_init(struct blob_buf
*buf
, int id
)
81 buf
->grow
= blob_buffer_grow
;
84 if (blob_add(buf
, buf
->buf
, id
, 0) == NULL
)
91 blob_buf_free(struct blob_buf
*buf
)
99 blob_fill_pad(struct blob_attr
*attr
)
101 char *buf
= (char *) attr
;
102 int len
= blob_pad_len(attr
);
103 int delta
= len
- blob_raw_len(attr
);
106 memset(buf
+ len
- delta
, 0, delta
);
110 blob_set_raw_len(struct blob_attr
*attr
, unsigned int len
)
112 int id
= blob_id(attr
);
113 len
&= BLOB_ATTR_LEN_MASK
;
114 len
|= (id
<< BLOB_ATTR_ID_SHIFT
) & BLOB_ATTR_ID_MASK
;
115 attr
->id_len
= cpu_to_be32(len
);
119 blob_new(struct blob_buf
*buf
, int id
, int payload
)
121 struct blob_attr
*attr
;
123 attr
= blob_add(buf
, blob_next(buf
->head
), id
, payload
);
127 blob_set_raw_len(buf
->head
, blob_pad_len(buf
->head
) + blob_pad_len(attr
));
132 blob_put(struct blob_buf
*buf
, int id
, const void *ptr
, int len
)
134 struct blob_attr
*attr
;
136 attr
= blob_new(buf
, id
, len
);
141 memcpy(blob_data(attr
), ptr
, len
);
146 blob_nest_start(struct blob_buf
*buf
, int id
)
148 unsigned long offset
= attr_to_offset(buf
, buf
->head
);
149 buf
->head
= blob_new(buf
, id
, 0);
150 return (void *) offset
;
154 blob_nest_end(struct blob_buf
*buf
, void *cookie
)
156 struct blob_attr
*attr
= offset_to_attr(buf
, (unsigned long) cookie
);
157 blob_set_raw_len(attr
, blob_pad_len(attr
) + blob_len(buf
->head
));
161 static const int blob_type_minlen
[BLOB_ATTR_LAST
] = {
162 [BLOB_ATTR_STRING
] = 1,
163 [BLOB_ATTR_INT8
] = sizeof(uint8_t),
164 [BLOB_ATTR_INT16
] = sizeof(uint16_t),
165 [BLOB_ATTR_INT32
] = sizeof(uint32_t),
166 [BLOB_ATTR_INT64
] = sizeof(uint64_t),
170 blob_check_type(const void *ptr
, int len
, int type
)
172 const char *data
= ptr
;
174 if (type
>= BLOB_ATTR_LAST
)
177 if (type
>= BLOB_ATTR_INT8
&& type
<= BLOB_ATTR_INT64
) {
178 if (len
!= blob_type_minlen
[type
])
181 if (len
< blob_type_minlen
[type
])
185 if (type
== BLOB_ATTR_STRING
&& data
[len
- 1] != 0)
192 blob_parse(struct blob_attr
*attr
, struct blob_attr
**data
, const struct blob_attr_info
*info
, int max
)
194 struct blob_attr
*pos
;
198 memset(data
, 0, sizeof(struct blob_attr
*) * max
);
199 blob_for_each_attr(pos
, attr
, rem
) {
200 int id
= blob_id(pos
);
201 int len
= blob_len(pos
);
207 int type
= info
[id
].type
;
209 if (type
< BLOB_ATTR_LAST
) {
210 if (!blob_check_type(blob_data(pos
), len
, type
))
214 if (info
[id
].minlen
&& len
< info
[id
].minlen
)
217 if (info
[id
].maxlen
&& len
> info
[id
].maxlen
)
220 if (info
[id
].validate
&& !info
[id
].validate(&info
[id
], attr
))
233 blob_attr_equal(const struct blob_attr
*a1
, const struct blob_attr
*a2
)
241 if (blob_pad_len(a1
) != blob_pad_len(a2
))
244 return !memcmp(a1
, a2
, blob_pad_len(a1
));
248 blob_memdup(struct blob_attr
*attr
)
250 struct blob_attr
*ret
;
251 int size
= blob_pad_len(attr
);
257 memcpy(ret
, attr
, size
);