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,
29 blobmsg_namelen(const struct blobmsg_hdr *hdr)
31 return be16_to_cpu(hdr->namelen);
34 bool blobmsg_check_attr(const struct blob_attr *attr, bool name)
36 const struct blobmsg_hdr *hdr;
40 if (blob_len(attr) < sizeof(struct blobmsg_hdr))
43 hdr = (void *) attr->data;
44 if (!hdr->namelen && name)
47 if (blobmsg_namelen(hdr) > blob_len(attr) - sizeof(struct blobmsg_hdr))
50 if (hdr->name[blobmsg_namelen(hdr)] != 0)
54 len = blobmsg_data_len(attr);
55 data = blobmsg_data(attr);
57 if (id > BLOBMSG_TYPE_LAST)
63 return blob_check_type(data, len, blob_type[id]);
66 int blobmsg_check_array(const struct blob_attr *attr, int type)
68 struct blob_attr *cur;
73 switch (blobmsg_type(attr)) {
74 case BLOBMSG_TYPE_TABLE:
77 case BLOBMSG_TYPE_ARRAY:
84 blobmsg_for_each_attr(cur, attr, rem) {
85 if (type != BLOBMSG_TYPE_UNSPEC && blobmsg_type(cur) != type)
88 if (!blobmsg_check_attr(cur, name))
97 bool blobmsg_check_attr_list(const struct blob_attr *attr, int type)
99 return blobmsg_check_array(attr, type) >= 0;
102 int blobmsg_parse_array(const struct blobmsg_policy *policy, int policy_len,
103 struct blob_attr **tb, void *data, unsigned int len)
105 struct blob_attr *attr;
108 memset(tb, 0, policy_len * sizeof(*tb));
109 __blob_for_each_attr(attr, data, len) {
110 if (policy[i].type != BLOBMSG_TYPE_UNSPEC &&
111 blob_id(attr) != policy[i].type)
114 if (!blobmsg_check_attr(attr, false))
129 int blobmsg_parse(const struct blobmsg_policy *policy, int policy_len,
130 struct blob_attr **tb, void *data, unsigned int len)
132 struct blobmsg_hdr *hdr;
133 struct blob_attr *attr;
137 memset(tb, 0, policy_len * sizeof(*tb));
138 pslen = alloca(policy_len);
139 for (i = 0; i < policy_len; i++) {
143 pslen[i] = strlen(policy[i].name);
146 __blob_for_each_attr(attr, data, len) {
147 hdr = blob_data(attr);
148 for (i = 0; i < policy_len; i++) {
152 if (policy[i].type != BLOBMSG_TYPE_UNSPEC &&
153 blob_id(attr) != policy[i].type)
156 if (blobmsg_namelen(hdr) != pslen[i])
159 if (!blobmsg_check_attr(attr, true))
165 if (strcmp(policy[i].name, (char *) hdr->name) != 0)
176 static struct blob_attr *
177 blobmsg_new(struct blob_buf *buf, int type, const char *name, int payload_len, void **data)
179 struct blob_attr *attr;
180 struct blobmsg_hdr *hdr;
181 int attrlen, namelen;
182 char *pad_start, *pad_end;
187 namelen = strlen(name);
188 attrlen = blobmsg_hdrlen(namelen) + payload_len;
189 attr = blob_new(buf, type, attrlen);
193 attr->id_len |= be32_to_cpu(BLOB_ATTR_EXTENDED);
194 hdr = blob_data(attr);
195 hdr->namelen = cpu_to_be16(namelen);
196 strcpy((char *) hdr->name, (const char *)name);
197 pad_end = *data = blobmsg_data(attr);
198 pad_start = (char *) &hdr->name[namelen];
199 if (pad_start < pad_end)
200 memset(pad_start, 0, pad_end - pad_start);
206 attr_to_offset(struct blob_buf *buf, struct blob_attr *attr)
208 return (char *)attr - (char *) buf->buf + BLOB_COOKIE;
213 blobmsg_open_nested(struct blob_buf *buf, const char *name, bool array)
215 struct blob_attr *head;
216 int type = array ? BLOBMSG_TYPE_ARRAY : BLOBMSG_TYPE_TABLE;
217 unsigned long offset = attr_to_offset(buf, buf->head);
223 head = blobmsg_new(buf, type, name, 0, &data);
226 blob_set_raw_len(buf->head, blob_pad_len(buf->head) - blobmsg_hdrlen(strlen(name)));
228 return (void *)offset;
232 blobmsg_vprintf(struct blob_buf *buf, const char *name, const char *format, va_list arg)
240 len = vsnprintf(&cbuf, sizeof(cbuf), format, arg2);
243 sbuf = blobmsg_alloc_string_buffer(buf, name, len + 1);
246 ret = vsprintf(sbuf, format, arg);
247 blobmsg_add_string_buffer(buf);
253 blobmsg_printf(struct blob_buf *buf, const char *name, const char *format, ...)
258 va_start(ap, format);
259 ret = blobmsg_vprintf(buf, name, format, ap);
266 blobmsg_alloc_string_buffer(struct blob_buf *buf, const char *name, unsigned int maxlen)
268 struct blob_attr *attr;
271 attr = blobmsg_new(buf, BLOBMSG_TYPE_STRING, name, maxlen, &data_dest);
275 blob_set_raw_len(buf->head, blob_pad_len(buf->head) - blob_pad_len(attr));
276 blob_set_raw_len(attr, blob_raw_len(attr) - maxlen);
282 blobmsg_realloc_string_buffer(struct blob_buf *buf, unsigned int maxlen)
284 struct blob_attr *attr = blob_next(buf->head);
285 int offset = attr_to_offset(buf, blob_next(buf->head)) + blob_pad_len(attr) - BLOB_COOKIE;
286 int required = maxlen - (buf->buflen - offset);
291 if (!blob_buf_grow(buf, required))
293 attr = blob_next(buf->head);
296 return blobmsg_data(attr);
300 blobmsg_add_string_buffer(struct blob_buf *buf)
302 struct blob_attr *attr;
305 attr = blob_next(buf->head);
306 len = strlen(blobmsg_data(attr)) + 1;
308 attrlen = blob_raw_len(attr) + len;
309 blob_set_raw_len(attr, attrlen);
312 blob_set_raw_len(buf->head, blob_raw_len(buf->head) + blob_pad_len(attr));
316 blobmsg_add_field(struct blob_buf *buf, int type, const char *name,
317 const void *data, unsigned int len)
319 struct blob_attr *attr;
322 attr = blobmsg_new(buf, type, name, len, &data_dest);
327 memcpy(data_dest, data, len);