2 * Copyright (C) 2011 Felix Fietkau <nbd@openwrt.org>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU Lesser General Public License version 2.1
6 * as published by the Free Software Foundation
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
14 #include <arpa/inet.h>
18 static struct ubus_msg_buf
*retmsg
;
19 static int *retmsg_data
;
20 static struct avl_tree clients
;
22 static struct blob_attr
*attrbuf
[UBUS_ATTR_MAX
];
24 typedef int (*ubus_cmd_cb
)(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct blob_attr
**attr
);
26 static const struct blob_attr_info ubus_policy
[UBUS_ATTR_MAX
] = {
27 [UBUS_ATTR_SIGNATURE
] = { .type
= BLOB_ATTR_NESTED
},
28 [UBUS_ATTR_OBJTYPE
] = { .type
= BLOB_ATTR_INT32
},
29 [UBUS_ATTR_OBJPATH
] = { .type
= BLOB_ATTR_STRING
},
30 [UBUS_ATTR_OBJID
] = { .type
= BLOB_ATTR_INT32
},
31 [UBUS_ATTR_STATUS
] = { .type
= BLOB_ATTR_INT32
},
32 [UBUS_ATTR_METHOD
] = { .type
= BLOB_ATTR_STRING
},
35 static struct blob_attr
**ubus_parse_msg(struct blob_attr
*msg
)
37 blob_parse(msg
, attrbuf
, ubus_policy
, UBUS_ATTR_MAX
);
41 static void ubus_msg_init(struct ubus_msg_buf
*ub
, uint8_t type
, uint16_t seq
, uint32_t peer
)
49 static struct ubus_msg_buf
*ubus_msg_from_blob(bool shared
)
51 return ubus_msg_new(b
.head
, blob_raw_len(b
.head
), shared
);
54 static struct ubus_msg_buf
*ubus_reply_from_blob(struct ubus_msg_buf
*ub
, bool shared
)
56 struct ubus_msg_buf
*new;
58 new = ubus_msg_from_blob(shared
);
62 ubus_msg_init(new, UBUS_MSG_DATA
, ub
->hdr
.seq
, ub
->hdr
.peer
);
67 ubus_send_msg_from_blob(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
,
70 ub
= ubus_reply_from_blob(ub
, true);
75 ubus_msg_send(cl
, ub
, true);
78 static bool ubusd_send_hello(struct ubus_client
*cl
)
80 struct ubus_msg_buf
*ub
;
83 ub
= ubus_msg_from_blob(true);
87 ubus_msg_init(ub
, UBUS_MSG_HELLO
, 0, cl
->id
.id
);
88 ubus_msg_send(cl
, ub
, true);
92 static int ubusd_send_pong(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct blob_attr
**attr
)
94 ub
->hdr
.type
= UBUS_MSG_DATA
;
95 ubus_msg_send(cl
, ub
, false);
99 static int ubusd_handle_remove_object(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct blob_attr
**attr
)
101 struct ubus_object
*obj
;
103 if (!attr
[UBUS_ATTR_OBJID
])
104 return UBUS_STATUS_INVALID_ARGUMENT
;
106 obj
= ubusd_find_object(blob_get_u32(attr
[UBUS_ATTR_OBJID
]));
108 return UBUS_STATUS_NOT_FOUND
;
110 if (obj
->client
!= cl
)
111 return UBUS_STATUS_PERMISSION_DENIED
;
113 blob_buf_init(&b
, 0);
114 blob_put_int32(&b
, UBUS_ATTR_OBJID
, obj
->id
.id
);
116 /* check if we're removing the object type as well */
117 if (obj
->type
&& obj
->type
->refcount
== 1)
118 blob_put_int32(&b
, UBUS_ATTR_OBJTYPE
, obj
->type
->id
.id
);
120 ubusd_free_object(obj
);
121 ubus_send_msg_from_blob(cl
, ub
, UBUS_MSG_DATA
);
126 static int ubusd_handle_add_object(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct blob_attr
**attr
)
128 struct ubus_object
*obj
;
130 obj
= ubusd_create_object(cl
, attr
);
132 return UBUS_STATUS_INVALID_ARGUMENT
;
134 blob_buf_init(&b
, 0);
135 blob_put_int32(&b
, UBUS_ATTR_OBJID
, obj
->id
.id
);
136 if (attr
[UBUS_ATTR_SIGNATURE
])
137 blob_put_int32(&b
, UBUS_ATTR_OBJTYPE
, obj
->type
->id
.id
);
139 ubus_send_msg_from_blob(cl
, ub
, UBUS_MSG_DATA
);
143 static void ubusd_send_obj(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct ubus_object
*obj
)
145 struct ubus_method
*m
;
148 blob_buf_init(&b
, 0);
151 blob_put_string(&b
, UBUS_ATTR_OBJPATH
, obj
->path
.key
);
152 blob_put_int32(&b
, UBUS_ATTR_OBJID
, obj
->id
.id
);
153 blob_put_int32(&b
, UBUS_ATTR_OBJTYPE
, obj
->type
->id
.id
);
155 s
= blob_nest_start(&b
, UBUS_ATTR_SIGNATURE
);
156 list_for_each_entry(m
, &obj
->type
->methods
, list
)
157 blob_put(&b
, blob_id(m
->data
), blob_data(m
->data
), blob_len(m
->data
));
158 blob_nest_end(&b
, s
);
160 ubus_send_msg_from_blob(cl
, ub
, UBUS_MSG_DATA
);
163 static int ubusd_handle_lookup(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct blob_attr
**attr
)
165 struct ubus_object
*obj
;
170 if (!attr
[UBUS_ATTR_OBJPATH
]) {
171 avl_for_each_element(&path
, obj
, path
)
172 ubusd_send_obj(cl
, ub
, obj
);
176 objpath
= blob_data(attr
[UBUS_ATTR_OBJPATH
]);
177 len
= strlen(objpath
);
178 if (objpath
[len
- 1] != '*') {
179 obj
= avl_find_element(&path
, objpath
, obj
, path
);
181 return UBUS_STATUS_NOT_FOUND
;
183 ubusd_send_obj(cl
, ub
, obj
);
189 obj
= avl_find_ge_element(&path
, objpath
, obj
, path
);
191 return UBUS_STATUS_NOT_FOUND
;
193 while (!strncmp(objpath
, obj
->path
.key
, len
)) {
195 ubusd_send_obj(cl
, ub
, obj
);
196 if (obj
== avl_last_element(&path
, obj
, path
))
198 obj
= avl_next_element(obj
, path
);
202 return UBUS_STATUS_NOT_FOUND
;
208 ubusd_forward_invoke(struct ubus_object
*obj
, const char *method
,
209 struct ubus_msg_buf
*ub
, struct blob_attr
*data
)
211 blob_put_int32(&b
, UBUS_ATTR_OBJID
, obj
->id
.id
);
212 blob_put_string(&b
, UBUS_ATTR_METHOD
, method
);
214 blob_put(&b
, UBUS_ATTR_DATA
, blob_data(data
), blob_len(data
));
216 ubus_send_msg_from_blob(obj
->client
, ub
, UBUS_MSG_INVOKE
);
219 static int ubusd_handle_invoke(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct blob_attr
**attr
)
221 struct ubus_object
*obj
= NULL
;
225 if (!attr
[UBUS_ATTR_METHOD
] || !attr
[UBUS_ATTR_OBJID
])
226 return UBUS_STATUS_INVALID_ARGUMENT
;
228 id
= ubus_find_id(&objects
, blob_get_u32(attr
[UBUS_ATTR_OBJID
]));
230 return UBUS_STATUS_NOT_FOUND
;
232 obj
= container_of(id
, struct ubus_object
, id
);
234 method
= blob_data(attr
[UBUS_ATTR_METHOD
]);
237 return obj
->recv_msg(cl
, method
, attr
[UBUS_ATTR_DATA
]);
239 ub
->hdr
.peer
= cl
->id
.id
;
240 blob_buf_init(&b
, 0);
241 ubusd_forward_invoke(obj
, method
, ub
, attr
[UBUS_ATTR_DATA
]);
247 static int ubusd_handle_notify(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct blob_attr
**attr
)
249 struct ubus_object
*obj
= NULL
;
250 struct ubus_subscription
*s
;
253 bool no_reply
= false;
256 if (!attr
[UBUS_ATTR_METHOD
] || !attr
[UBUS_ATTR_OBJID
])
257 return UBUS_STATUS_INVALID_ARGUMENT
;
259 if (attr
[UBUS_ATTR_NO_REPLY
])
260 no_reply
= blob_get_int8(attr
[UBUS_ATTR_NO_REPLY
]);
262 id
= ubus_find_id(&objects
, blob_get_u32(attr
[UBUS_ATTR_OBJID
]));
264 return UBUS_STATUS_NOT_FOUND
;
266 obj
= container_of(id
, struct ubus_object
, id
);
267 if (obj
->client
!= cl
)
268 return UBUS_STATUS_PERMISSION_DENIED
;
271 blob_buf_init(&b
, 0);
272 blob_put_int32(&b
, UBUS_ATTR_OBJID
, id
->id
);
273 c
= blob_nest_start(&b
, UBUS_ATTR_SUBSCRIBERS
);
274 list_for_each_entry(s
, &obj
->subscribers
, list
) {
275 blob_put_int32(&b
, 0, s
->subscriber
->id
.id
);
277 blob_nest_end(&b
, c
);
278 blob_put_int32(&b
, UBUS_ATTR_STATUS
, 0);
279 ubus_send_msg_from_blob(cl
, ub
, UBUS_MSG_STATUS
);
282 ub
->hdr
.peer
= cl
->id
.id
;
283 method
= blob_data(attr
[UBUS_ATTR_METHOD
]);
284 list_for_each_entry(s
, &obj
->subscribers
, list
) {
285 blob_buf_init(&b
, 0);
287 blob_put_int8(&b
, UBUS_ATTR_NO_REPLY
, 1);
288 ubusd_forward_invoke(s
->subscriber
, method
, ub
, attr
[UBUS_ATTR_DATA
]);
295 static struct ubus_client
*ubusd_get_client_by_id(uint32_t id
)
297 struct ubus_id
*clid
;
299 clid
= ubus_find_id(&clients
, id
);
303 return container_of(clid
, struct ubus_client
, id
);
306 static int ubusd_handle_response(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct blob_attr
**attr
)
308 struct ubus_object
*obj
;
310 if (!attr
[UBUS_ATTR_OBJID
] ||
311 (ub
->hdr
.type
== UBUS_MSG_STATUS
&& !attr
[UBUS_ATTR_STATUS
]) ||
312 (ub
->hdr
.type
== UBUS_MSG_DATA
&& !attr
[UBUS_ATTR_DATA
]))
315 obj
= ubusd_find_object(blob_get_u32(attr
[UBUS_ATTR_OBJID
]));
319 if (cl
!= obj
->client
)
322 cl
= ubusd_get_client_by_id(ub
->hdr
.peer
);
326 ub
->hdr
.peer
= blob_get_u32(attr
[UBUS_ATTR_OBJID
]);
327 ubus_msg_send(cl
, ub
, true);
335 static int ubusd_handle_add_watch(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct blob_attr
**attr
)
337 struct ubus_object
*obj
, *target
;
339 if (!attr
[UBUS_ATTR_OBJID
] || !attr
[UBUS_ATTR_TARGET
])
340 return UBUS_STATUS_INVALID_ARGUMENT
;
342 obj
= ubusd_find_object(blob_get_u32(attr
[UBUS_ATTR_OBJID
]));
344 return UBUS_STATUS_NOT_FOUND
;
346 if (cl
!= obj
->client
)
347 return UBUS_STATUS_INVALID_ARGUMENT
;
349 target
= ubusd_find_object(blob_get_u32(attr
[UBUS_ATTR_TARGET
]));
351 return UBUS_STATUS_NOT_FOUND
;
353 if (cl
== target
->client
)
354 return UBUS_STATUS_INVALID_ARGUMENT
;
356 ubus_subscribe(obj
, target
);
360 static int ubusd_handle_remove_watch(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
, struct blob_attr
**attr
)
362 struct ubus_object
*obj
;
363 struct ubus_subscription
*s
;
366 if (!attr
[UBUS_ATTR_OBJID
] || !attr
[UBUS_ATTR_TARGET
])
367 return UBUS_STATUS_INVALID_ARGUMENT
;
369 obj
= ubusd_find_object(blob_get_u32(attr
[UBUS_ATTR_OBJID
]));
371 return UBUS_STATUS_NOT_FOUND
;
373 if (cl
!= obj
->client
)
374 return UBUS_STATUS_INVALID_ARGUMENT
;
376 id
= blob_get_u32(attr
[UBUS_ATTR_TARGET
]);
377 list_for_each_entry(s
, &obj
->target_list
, target_list
) {
378 if (s
->target
->id
.id
!= id
)
385 return UBUS_STATUS_NOT_FOUND
;
388 static const ubus_cmd_cb handlers
[__UBUS_MSG_LAST
] = {
389 [UBUS_MSG_PING
] = ubusd_send_pong
,
390 [UBUS_MSG_ADD_OBJECT
] = ubusd_handle_add_object
,
391 [UBUS_MSG_REMOVE_OBJECT
] = ubusd_handle_remove_object
,
392 [UBUS_MSG_LOOKUP
] = ubusd_handle_lookup
,
393 [UBUS_MSG_INVOKE
] = ubusd_handle_invoke
,
394 [UBUS_MSG_STATUS
] = ubusd_handle_response
,
395 [UBUS_MSG_DATA
] = ubusd_handle_response
,
396 [UBUS_MSG_SUBSCRIBE
] = ubusd_handle_add_watch
,
397 [UBUS_MSG_UNSUBSCRIBE
] = ubusd_handle_remove_watch
,
398 [UBUS_MSG_NOTIFY
] = ubusd_handle_notify
,
401 void ubusd_proto_receive_message(struct ubus_client
*cl
, struct ubus_msg_buf
*ub
)
403 ubus_cmd_cb cb
= NULL
;
406 retmsg
->hdr
.seq
= ub
->hdr
.seq
;
407 retmsg
->hdr
.peer
= ub
->hdr
.peer
;
409 if (ub
->hdr
.type
< __UBUS_MSG_LAST
)
410 cb
= handlers
[ub
->hdr
.type
];
413 ret
= cb(cl
, ub
, ubus_parse_msg(ub
->data
));
415 ret
= UBUS_STATUS_INVALID_COMMAND
;
422 *retmsg_data
= htonl(ret
);
423 ubus_msg_send(cl
, retmsg
, false);
426 struct ubus_client
*ubusd_proto_new_client(int fd
, uloop_fd_handler cb
)
428 struct ubus_client
*cl
;
430 cl
= calloc(1, sizeof(*cl
));
434 INIT_LIST_HEAD(&cl
->objects
);
438 if (!ubus_alloc_id(&clients
, &cl
->id
, 0))
441 if (!ubusd_send_hello(cl
))
447 ubus_free_id(&clients
, &cl
->id
);
453 void ubusd_proto_free_client(struct ubus_client
*cl
)
455 struct ubus_object
*obj
;
457 while (!list_empty(&cl
->objects
)) {
458 obj
= list_first_entry(&cl
->objects
, struct ubus_object
, list
);
459 ubusd_free_object(obj
);
462 ubus_free_id(&clients
, &cl
->id
);
465 void ubus_notify_subscription(struct ubus_object
*obj
)
467 bool active
= !list_empty(&obj
->subscribers
);
468 struct ubus_msg_buf
*ub
;
470 blob_buf_init(&b
, 0);
471 blob_put_int32(&b
, UBUS_ATTR_OBJID
, obj
->id
.id
);
472 blob_put_int8(&b
, UBUS_ATTR_ACTIVE
, active
);
474 ub
= ubus_msg_from_blob(false);
475 ubus_msg_init(ub
, UBUS_MSG_NOTIFY
, ++obj
->invoke_seq
, 0);
476 ubus_msg_send(obj
->client
, ub
, true);
479 void ubus_notify_unsubscribe(struct ubus_subscription
*s
)
481 struct ubus_msg_buf
*ub
;
483 blob_buf_init(&b
, 0);
484 blob_put_int32(&b
, UBUS_ATTR_OBJID
, s
->subscriber
->id
.id
);
485 blob_put_int32(&b
, UBUS_ATTR_TARGET
, s
->target
->id
.id
);
487 ub
= ubus_msg_from_blob(false);
488 ubus_msg_init(ub
, UBUS_MSG_UNSUBSCRIBE
, ++s
->subscriber
->invoke_seq
, 0);
489 ubus_msg_send(s
->subscriber
->client
, ub
, true);
494 static void __init
ubusd_proto_init(void)
496 ubus_init_id_tree(&clients
);
498 blob_buf_init(&b
, 0);
499 blob_put_int32(&b
, UBUS_ATTR_STATUS
, 0);
501 retmsg
= ubus_msg_from_blob(false);
505 retmsg
->hdr
.type
= UBUS_MSG_STATUS
;
506 retmsg_data
= blob_data(blob_data(retmsg
->data
));