2 * Copyright (C) 2010-2012 Felix Fietkau <nbd@openwrt.org>
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 static const int blob_type[__BLOBMSG_TYPE_LAST] = {
19 [BLOBMSG_TYPE_INT8] = BLOB_ATTR_INT8,
20 [BLOBMSG_TYPE_INT16] = BLOB_ATTR_INT16,
21 [BLOBMSG_TYPE_INT32] = BLOB_ATTR_INT32,
22 [BLOBMSG_TYPE_INT64] = BLOB_ATTR_INT64,
23 [BLOBMSG_TYPE_DOUBLE] = BLOB_ATTR_DOUBLE,
24 [BLOBMSG_TYPE_STRING] = BLOB_ATTR_STRING,
25 [BLOBMSG_TYPE_UNSPEC] = BLOB_ATTR_BINARY,
28 bool blobmsg_check_attr(const struct blob_attr *attr, bool name)
30 return blobmsg_check_attr_len(attr, name, blob_raw_len(attr));
33 static bool blobmsg_check_name(const struct blob_attr *attr, size_t len, bool name)
35 char *limit = (char *) attr + len;
36 const struct blobmsg_hdr *hdr;
38 hdr = blob_data(attr);
39 if (name && !hdr->namelen)
42 if ((char *) hdr->name + blobmsg_namelen(hdr) > limit)
45 if (blobmsg_namelen(hdr) > (blob_len(attr) - sizeof(struct blobmsg_hdr)))
48 if (hdr->name[blobmsg_namelen(hdr)] != 0)
54 static const char* blobmsg_check_data(const struct blob_attr *attr, size_t len, size_t *data_len)
56 char *limit = (char *) attr + len;
59 *data_len = blobmsg_data_len(attr);
60 if (*data_len > blob_raw_len(attr))
63 data = blobmsg_data(attr);
64 if (data + *data_len > limit)
70 bool blobmsg_check_attr_len(const struct blob_attr *attr, bool name, size_t len)
76 if (len < sizeof(struct blob_attr))
79 if (!blobmsg_check_name(attr, len, name))
83 if (id > BLOBMSG_TYPE_LAST)
89 data = blobmsg_check_data(attr, len, &data_len);
93 return blob_check_type(data, data_len, blob_type[id]);
96 int blobmsg_check_array(const struct blob_attr *attr, int type)
98 return blobmsg_check_array_len(attr, type, blobmsg_len(attr));
101 int blobmsg_check_array_len(const struct blob_attr *attr, int type, size_t len)
103 struct blob_attr *cur;
107 if (type > BLOBMSG_TYPE_LAST)
110 if (!blobmsg_check_attr_len(attr, false, len))
113 switch (blobmsg_type(attr)) {
114 case BLOBMSG_TYPE_TABLE:
117 case BLOBMSG_TYPE_ARRAY:
124 __blobmsg_for_each_attr(cur, attr, len) {
125 if (type != BLOBMSG_TYPE_UNSPEC && blobmsg_type(cur) != type)
128 if (!blobmsg_check_attr_len(cur, name, len))
137 bool blobmsg_check_attr_list(const struct blob_attr *attr, int type)
139 return blobmsg_check_array(attr, type) >= 0;
142 bool blobmsg_check_attr_list_len(const struct blob_attr *attr, int type, size_t len)
144 return blobmsg_check_array_len(attr, type, len) >= 0;
147 int blobmsg_parse_array(const struct blobmsg_policy *policy, int policy_len,
148 struct blob_attr **tb, void *data, unsigned int len)
150 struct blob_attr *attr;
153 memset(tb, 0, policy_len * sizeof(*tb));
154 __blob_for_each_attr(attr, data, len) {
155 if (policy[i].type != BLOBMSG_TYPE_UNSPEC &&
156 blob_id(attr) != policy[i].type)
159 if (!blobmsg_check_attr_len(attr, false, len))
174 int blobmsg_parse(const struct blobmsg_policy *policy, int policy_len,
175 struct blob_attr **tb, void *data, unsigned int len)
177 struct blobmsg_hdr *hdr;
178 struct blob_attr *attr;
182 memset(tb, 0, policy_len * sizeof(*tb));
185 pslen = alloca(policy_len);
186 for (i = 0; i < policy_len; i++) {
190 pslen[i] = strlen(policy[i].name);
193 __blob_for_each_attr(attr, data, len) {
194 hdr = blob_data(attr);
195 for (i = 0; i < policy_len; i++) {
199 if (policy[i].type != BLOBMSG_TYPE_UNSPEC &&
200 blob_id(attr) != policy[i].type)
203 if (blobmsg_namelen(hdr) != pslen[i])
206 if (!blobmsg_check_attr_len(attr, true, len))
212 if (strcmp(policy[i].name, (char *) hdr->name) != 0)
223 static struct blob_attr *
224 blobmsg_new(struct blob_buf *buf, int type, const char *name, int payload_len, void **data)
226 struct blob_attr *attr;
227 struct blobmsg_hdr *hdr;
228 int attrlen, namelen;
229 char *pad_start, *pad_end;
234 namelen = strlen(name);
235 attrlen = blobmsg_hdrlen(namelen) + payload_len;
236 attr = blob_new(buf, type, attrlen);
240 attr->id_len |= be32_to_cpu(BLOB_ATTR_EXTENDED);
241 hdr = blob_data(attr);
242 hdr->namelen = cpu_to_be16(namelen);
244 memcpy(hdr->name, name, namelen);
245 hdr->name[namelen] = '\0';
247 pad_end = *data = blobmsg_data(attr);
248 pad_start = (char *) &hdr->name[namelen];
249 if (pad_start < pad_end)
250 memset(pad_start, 0, pad_end - pad_start);
256 attr_to_offset(struct blob_buf *buf, struct blob_attr *attr)
258 return (char *)attr - (char *) buf->buf + BLOB_COOKIE;
263 blobmsg_open_nested(struct blob_buf *buf, const char *name, bool array)
265 struct blob_attr *head;
266 int type = array ? BLOBMSG_TYPE_ARRAY : BLOBMSG_TYPE_TABLE;
267 unsigned long offset = attr_to_offset(buf, buf->head);
273 head = blobmsg_new(buf, type, name, 0, &data);
276 blob_set_raw_len(buf->head, blob_pad_len(buf->head) - blobmsg_hdrlen(strlen(name)));
278 return (void *)offset;
281 __attribute__((format(printf, 3, 0)))
282 int blobmsg_vprintf(struct blob_buf *buf, const char *name, const char *format, va_list arg)
290 len = vsnprintf(&cbuf, sizeof(cbuf), format, arg2);
293 sbuf = blobmsg_alloc_string_buffer(buf, name, len + 1);
296 ret = vsprintf(sbuf, format, arg);
297 blobmsg_add_string_buffer(buf);
302 __attribute__((format(printf, 3, 4)))
303 int blobmsg_printf(struct blob_buf *buf, const char *name, const char *format, ...)
308 va_start(ap, format);
309 ret = blobmsg_vprintf(buf, name, format, ap);
316 blobmsg_alloc_string_buffer(struct blob_buf *buf, const char *name, unsigned int maxlen)
318 struct blob_attr *attr;
321 attr = blobmsg_new(buf, BLOBMSG_TYPE_STRING, name, maxlen, &data_dest);
325 blob_set_raw_len(buf->head, blob_pad_len(buf->head) - blob_pad_len(attr));
326 blob_set_raw_len(attr, blob_raw_len(attr) - maxlen);
332 blobmsg_realloc_string_buffer(struct blob_buf *buf, unsigned int maxlen)
334 struct blob_attr *attr = blob_next(buf->head);
335 int offset = attr_to_offset(buf, blob_next(buf->head)) + blob_pad_len(attr) - BLOB_COOKIE;
336 int required = maxlen - (buf->buflen - offset);
341 if (!blob_buf_grow(buf, required))
343 attr = blob_next(buf->head);
346 return blobmsg_data(attr);
350 blobmsg_add_string_buffer(struct blob_buf *buf)
352 struct blob_attr *attr;
355 attr = blob_next(buf->head);
356 len = strlen(blobmsg_data(attr)) + 1;
358 attrlen = blob_raw_len(attr) + len;
359 blob_set_raw_len(attr, attrlen);
362 blob_set_raw_len(buf->head, blob_raw_len(buf->head) + blob_pad_len(attr));
366 blobmsg_add_field(struct blob_buf *buf, int type, const char *name,
367 const void *data, unsigned int len)
369 struct blob_attr *attr;
372 attr = blobmsg_new(buf, type, name, len, &data_dest);
377 memcpy(data_dest, data, len);