X-Git-Url: https://git.archive.openwrt.org/?p=project%2Fubus.git;a=blobdiff_plain;f=libubus.c;h=c1a1010cc0ba788b734ee74e2c0669f092914872;hp=9e93aede871c71c65a52793093cde209714d2ba2;hb=36b1a80b075203c650a6612f1ef45674210fb7a6;hpb=8321f8c523c9bf5f476f9c5b06c955d0ce3a0f80 diff --git a/libubus.c b/libubus.c index 9e93aed..c1a1010 100644 --- a/libubus.c +++ b/libubus.c @@ -24,6 +24,7 @@ const char *__ubus_strerror[__UBUS_STATUS_LAST] = { [UBUS_STATUS_OK] = "Success", [UBUS_STATUS_INVALID_COMMAND] = "Invalid command", [UBUS_STATUS_INVALID_ARGUMENT] = "Invalid argument", + [UBUS_STATUS_METHOD_NOT_FOUND] = "Method not found", [UBUS_STATUS_NOT_FOUND] = "Not found", [UBUS_STATUS_NO_DATA] = "No response", }; @@ -34,6 +35,7 @@ static const struct blob_attr_info ubus_policy[UBUS_ATTR_MAX] = { [UBUS_ATTR_STATUS] = { .type = BLOB_ATTR_INT32 }, [UBUS_ATTR_OBJID] = { .type = BLOB_ATTR_INT32 }, [UBUS_ATTR_OBJPATH] = { .type = BLOB_ATTR_STRING }, + [UBUS_ATTR_METHOD] = { .type = BLOB_ATTR_STRING }, }; static struct blob_attr *attrbuf[UBUS_ATTR_MAX]; @@ -43,6 +45,16 @@ struct ubus_pending_data { struct blob_attr data[]; }; +static int ubus_cmp_id(const void *k1, const void *k2, void *ptr) +{ + const uint32_t *id1 = k1, *id2 = k2; + + if (*id1 < *id2) + return -1; + else + return *id1 > *id2; +} + struct blob_attr **ubus_parse_msg(struct blob_attr *msg) { blob_parse(msg, attrbuf, ubus_policy, UBUS_ATTR_MAX); @@ -66,23 +78,19 @@ out: return err; } -int ubus_start_request(struct ubus_context *ctx, struct ubus_request *req, - struct blob_attr *msg, int cmd, uint32_t peer) +static int ubus_send_msg(struct ubus_context *ctx, uint32_t seq, + struct blob_attr *msg, int cmd, uint32_t peer) { struct ubus_msghdr hdr; struct iovec iov[2] = { STATIC_IOV(hdr) }; - memset(req, 0, sizeof(*req)); hdr.version = 0; hdr.type = cmd; - hdr.seq = ++ctx->request_seq; + hdr.seq = seq; hdr.peer = peer; - req->peer = hdr.peer; - req->seq = hdr.seq; - if (!msg) { blob_buf_init(&b, 0); msg = b.head; @@ -90,12 +98,23 @@ int ubus_start_request(struct ubus_context *ctx, struct ubus_request *req, iov[1].iov_base = (char *) msg; iov[1].iov_len = blob_raw_len(msg); - INIT_LIST_HEAD(&req->list); - INIT_LIST_HEAD(&req->pending); return writev(ctx->sock.fd, iov, 2); } +static int ubus_start_request(struct ubus_context *ctx, struct ubus_request *req, + struct blob_attr *msg, int cmd, uint32_t peer) +{ + memset(req, 0, sizeof(*req)); + + INIT_LIST_HEAD(&req->list); + INIT_LIST_HEAD(&req->pending); + req->ctx = ctx; + req->peer = peer; + req->seq = ++ctx->request_seq; + return ubus_send_msg(ctx, req->seq, msg, cmd, peer); +} + static bool recv_retry(int fd, struct iovec *iov, bool wait) { int bytes; @@ -164,6 +183,20 @@ static bool ubus_get_status(struct ubus_msghdr *hdr, int *ret) return true; } +static void req_data_cb(struct ubus_request *req, int type, struct blob_attr *data) +{ + struct blob_attr **attr; + + if (req->raw_data_cb) + req->raw_data_cb(req, type, data); + + if (!req->data_cb) + return; + + attr = ubus_parse_msg(data); + req->data_cb(req, type, attr[UBUS_ATTR_DATA]); +} + static void ubus_process_req_data(struct ubus_request *req) { struct ubus_pending_data *data; @@ -172,7 +205,8 @@ static void ubus_process_req_data(struct ubus_request *req) data = list_first_entry(&req->pending, struct ubus_pending_data, list); list_del(&data->list); - req->data_cb(req, data->type, data->data); + if (!req->cancelled) + req_data_cb(req, data->type, data->data); free(data); } } @@ -212,7 +246,7 @@ static void ubus_req_data(struct ubus_request *req, struct ubus_msghdr *hdr) if (!req->blocked) { req->blocked = true; - req->data_cb(req, hdr->type, hdr->data); + req_data_cb(req, hdr->type, hdr->data); ubus_process_req_data(req); req->blocked = false; @@ -232,26 +266,94 @@ static void ubus_req_data(struct ubus_request *req, struct ubus_msghdr *hdr) list_add(&data->list, &req->pending); } -static void ubus_process_msg(struct ubus_context *ctx, struct ubus_msghdr *hdr) +static struct ubus_request *ubus_find_request(struct ubus_context *ctx, uint32_t seq, uint32_t peer) { struct ubus_request *req; list_for_each_entry(req, &ctx->requests, list) { - if (hdr->seq != req->seq || hdr->peer != req->peer) + if (seq != req->seq || peer != req->peer) continue; - switch(hdr->type) { - case UBUS_MSG_STATUS: - ubus_process_req_status(req, hdr); - return; - case UBUS_MSG_DATA: - if (req->data_cb) - ubus_req_data(req, hdr); - break; - default: - DPRINTF("unknown message type: %d\n", hdr->type); + return req; + } + return NULL; +} + +static void ubus_process_invoke(struct ubus_context *ctx, struct ubus_msghdr *hdr) +{ + struct ubus_request_data req; + struct ubus_object *obj; + uint32_t objid = 0; + int method; + int ret = 0; + + ubus_parse_msg(hdr->data); + + if (!attrbuf[UBUS_ATTR_OBJID]) + return; + + objid = blob_get_int32(attrbuf[UBUS_ATTR_OBJID]); + + if (!attrbuf[UBUS_ATTR_METHOD]) { + ret = UBUS_STATUS_INVALID_ARGUMENT; + goto send; + } + + obj = avl_find_element(&ctx->objects, &objid, obj, avl); + if (!obj) { + ret = UBUS_STATUS_NOT_FOUND; + goto send; + } + + for (method = 0; method < obj->n_methods; method++) + if (!strcmp(obj->methods[method].name, + blob_data(attrbuf[UBUS_ATTR_METHOD]))) + goto found; + + /* not found */ + ret = UBUS_STATUS_METHOD_NOT_FOUND; + goto send; + +found: + req.object = objid; + req.peer = hdr->peer; + req.seq = hdr->seq; + ret = obj->methods[method].handler(ctx, obj, &req, + obj->methods[method].name, + attrbuf[UBUS_ATTR_DATA]); + +send: + blob_buf_init(&b, 0); + blob_put_int32(&b, UBUS_ATTR_STATUS, ret); + blob_put_int32(&b, UBUS_ATTR_OBJID, objid); + ubus_send_msg(ctx, hdr->seq, b.head, UBUS_MSG_STATUS, hdr->peer); +} + +static void ubus_process_msg(struct ubus_context *ctx, struct ubus_msghdr *hdr) +{ + struct ubus_request *req; + + switch(hdr->type) { + case UBUS_MSG_STATUS: + req = ubus_find_request(ctx, hdr->seq, hdr->peer); + if (!req) break; - } + + ubus_process_req_status(req, hdr); + break; + + case UBUS_MSG_DATA: + req = ubus_find_request(ctx, hdr->seq, hdr->peer); + if (req && (req->data_cb || req->raw_data_cb)) + ubus_req_data(req, hdr); + break; + + case UBUS_MSG_INVOKE: + ubus_process_invoke(ctx, hdr); + break; + default: + DPRINTF("unknown message type: %d\n", hdr->type); + break; } } @@ -260,6 +362,8 @@ void ubus_abort_request(struct ubus_context *ctx, struct ubus_request *req) if (!list_empty(&req->list)) return; + req->cancelled = true; + ubus_process_req_data(req); list_del(&req->list); } @@ -278,6 +382,9 @@ static void ubus_handle_data(struct uloop_fd *u, unsigned int events) while (get_next_msg(ctx, false)) ubus_process_msg(ctx, hdr); + + if (u->eof) + ctx->connection_lost(ctx); } int ubus_complete_request(struct ubus_context *ctx, struct ubus_request *req) @@ -291,6 +398,9 @@ int ubus_complete_request(struct ubus_context *ctx, struct ubus_request *req) if (req->status_msg) return req->status_code; + if (req->cancelled) + return UBUS_STATUS_NO_DATA; + if (!get_next_msg(ctx, true)) return UBUS_STATUS_NO_DATA; @@ -301,12 +411,11 @@ int ubus_complete_request(struct ubus_context *ctx, struct ubus_request *req) case UBUS_MSG_STATUS: return ubus_process_req_status(req, hdr); case UBUS_MSG_DATA: - if (req->data_cb) + if (req->data_cb || req->raw_data_cb) ubus_req_data(req, hdr); continue; default: - DPRINTF("unknown message type: %d\n", hdr->type); - continue; + goto skip; } skip: @@ -314,37 +423,99 @@ skip: } } -void ubus_invoke_path_async(struct ubus_context *ctx, const char *path, const char *method, - struct blob_attr *msg, struct ubus_request *req) +struct ubus_lookup_request { + struct ubus_request req; + ubus_lookup_handler_t cb; +}; + +static void ubus_lookup_cb(struct ubus_request *ureq, int type, struct blob_attr *msg) { + struct ubus_lookup_request *req; + struct ubus_object_data obj; + struct blob_attr **attr; + + req = container_of(ureq, struct ubus_lookup_request, req); + attr = ubus_parse_msg(msg); + + if (!attr[UBUS_ATTR_OBJID] || !attr[UBUS_ATTR_OBJPATH] || + !attr[UBUS_ATTR_OBJTYPE]) + return; + + memset(&obj, 0, sizeof(obj)); + obj.id = blob_get_int32(attr[UBUS_ATTR_OBJID]); + obj.path = blob_data(attr[UBUS_ATTR_OBJPATH]); + obj.type_id = blob_get_int32(attr[UBUS_ATTR_OBJTYPE]); + obj.signature = attr[UBUS_ATTR_SIGNATURE]; + req->cb(ureq->ctx, &obj, ureq->priv); +} + +int ubus_lookup(struct ubus_context *ctx, const char *path, + ubus_lookup_handler_t cb, void *priv) +{ + struct ubus_lookup_request lookup; + blob_buf_init(&b, 0); - blob_put_string(&b, UBUS_ATTR_OBJPATH, path); - blob_put_string(&b, UBUS_ATTR_METHOD, method); - blob_put(&b, UBUS_ATTR_DATA, blob_data(msg), blob_len(msg)); + if (path) + blob_put_string(&b, UBUS_ATTR_OBJPATH, path); + ubus_start_request(ctx, &lookup.req, b.head, UBUS_MSG_LOOKUP, 0); + lookup.req.raw_data_cb = ubus_lookup_cb; + lookup.req.priv = priv; + lookup.cb = cb; + return ubus_complete_request(ctx, &lookup.req); +} + +static void ubus_lookup_id_cb(struct ubus_request *req, int type, struct blob_attr *msg) +{ + struct blob_attr **attr; + uint32_t *id = req->priv; + + attr = ubus_parse_msg(msg); + + if (!attr[UBUS_ATTR_OBJID]) + return; - ubus_start_request(ctx, req, b.head, UBUS_MSG_INVOKE, 0); + *id = blob_get_int32(attr[UBUS_ATTR_OBJID]); } -int ubus_invoke_path(struct ubus_context *ctx, const char *path, const char *method, - struct blob_attr *msg, ubus_data_handler_t cb, void *priv) +int ubus_lookup_id(struct ubus_context *ctx, const char *path, uint32_t *id) { struct ubus_request req; - ubus_invoke_path_async(ctx, path, method, msg, &req); - req.data_cb = cb; - req.priv = priv; + blob_buf_init(&b, 0); + if (path) + blob_put_string(&b, UBUS_ATTR_OBJPATH, path); + ubus_start_request(ctx, &req, b.head, UBUS_MSG_LOOKUP, 0); + req.raw_data_cb = ubus_lookup_id_cb; + req.priv = id; + return ubus_complete_request(ctx, &req); } +int ubus_send_reply(struct ubus_context *ctx, struct ubus_request_data *req, + struct blob_attr *msg) +{ + int ret; + + blob_buf_init(&b, 0); + blob_put_int32(&b, UBUS_ATTR_OBJID, req->object); + blob_put(&b, UBUS_ATTR_DATA, blob_data(msg), blob_len(msg)); + ret = ubus_send_msg(ctx, req->seq, b.head, UBUS_MSG_DATA, req->peer); + if (ret < 0) + return UBUS_STATUS_NO_DATA; + + return 0; +} + void ubus_invoke_async(struct ubus_context *ctx, uint32_t obj, const char *method, struct blob_attr *msg, struct ubus_request *req) { blob_buf_init(&b, 0); blob_put_int32(&b, UBUS_ATTR_OBJID, obj); blob_put_string(&b, UBUS_ATTR_METHOD, method); - blob_put(&b, UBUS_ATTR_DATA, blob_data(msg), blob_len(msg)); + if (msg) + blob_put(&b, UBUS_ATTR_DATA, blob_data(msg), blob_len(msg)); - ubus_start_request(ctx, req, b.head, UBUS_MSG_INVOKE, 0); + ubus_start_request(ctx, req, b.head, UBUS_MSG_INVOKE, obj); } int ubus_invoke(struct ubus_context *ctx, uint32_t obj, const char *method, @@ -371,6 +542,9 @@ static void ubus_publish_cb(struct ubus_request *req, int type, struct blob_attr if (attrbuf[UBUS_ATTR_OBJTYPE]) obj->type->id = blob_get_int32(attrbuf[UBUS_ATTR_OBJTYPE]); + + obj->avl.key = &obj->id; + avl_insert(&req->ctx->objects, &obj->avl); } static bool ubus_push_table_data(const struct ubus_signature **sig, int *rem, bool array) @@ -441,8 +615,6 @@ int ubus_publish(struct ubus_context *ctx, struct ubus_object *obj) blob_buf_init(&b, 0); blob_put_string(&b, UBUS_ATTR_OBJPATH, obj->name); - if (obj->parent) - blob_put_int32(&b, UBUS_ATTR_OBJID, obj->parent->id); if (obj->type->id) blob_put_int32(&b, UBUS_ATTR_OBJTYPE, obj->type->id); @@ -450,7 +622,7 @@ int ubus_publish(struct ubus_context *ctx, struct ubus_object *obj) return UBUS_STATUS_INVALID_ARGUMENT; ubus_start_request(ctx, &req, b.head, UBUS_MSG_PUBLISH, 0); - req.data_cb = ubus_publish_cb; + req.raw_data_cb = ubus_publish_cb; req.priv = obj; ret = ubus_complete_request(ctx, &req); if (ret) @@ -462,6 +634,12 @@ int ubus_publish(struct ubus_context *ctx, struct ubus_object *obj) return 0; } +void ubus_default_connection_lost(struct ubus_context *ctx) +{ + if (ctx->sock.registered) + uloop_end(); +} + struct ubus_context *ubus_connect(const char *path) { struct ubus_context *ctx; @@ -513,6 +691,11 @@ struct ubus_context *ubus_connect(const char *path) ctx->local_id = hdr.hdr.peer; free(buf); + ctx->connection_lost = ubus_default_connection_lost; + + INIT_LIST_HEAD(&ctx->requests); + avl_init(&ctx->objects, ubus_cmp_id, false, NULL); + if (!ctx->local_id) { DPRINTF("Failed to get local peer id\n"); goto error_close;