1 files changed, 42 insertions, 23 deletions

diff --git a/ucs2-afb/ucs_binding.c b/ucs2-afb/ucs_binding.c
index ddf44b1..bc783aa 100644
--- a/ucs2-afb/ucs_binding.c
+++ b/ucs2-afb/ucs_binding.c
@@ -41,6 +41,7 @@
 
 #include "ucs_binding.h"
 #include "ucs_interface.h"
+#include "wrap-json.h"
 
 #define MAX_FILENAME_LEN (100)
 #define RX_BUFFER (64)
@@ -223,30 +224,19 @@ STATIC void NotifyEventRxMsg(uint16_t src_addr, uint16_t msg_id, uint8_t *data_p
         return;
     }
 
-    json_object *j_event_info = json_object_new_object();
-    json_object *j_array = json_object_new_array();
+    json_object *j_query = NULL;
+    int node = (int)src_addr;
+    int msgid = (int)msg_id;
+    size_t data_size = (size_t)data_sz;
 
-    if (!j_event_info || !j_array) {
-        if (j_event_info) {
-            json_object_put(j_event_info);
-        }
-        if (j_array) {
-            json_object_put(j_array);
-        }
-        AFB_ERROR("Failed to create json objects");
-        return;
-    }
-
-    uint32_t cnt = 0U;
-    for (cnt = 0U; cnt < data_sz; cnt++) {
-        json_object_array_add(j_array, json_object_new_int(data_ptr[cnt]));
-    }
-
-    json_object_object_add(j_event_info, "node", json_object_new_int(src_addr));
-    json_object_object_add(j_event_info, "msgid", json_object_new_int(msg_id));
-    json_object_object_add(j_event_info, "data", j_array);
+    /* skip data attribute if possible, wrap_json_unpack may fail to deal with
+     * an empty Base64 string */
+    if (data_size > 0)
+        wrap_json_pack(&j_query, "{s:i, s:i, s:Y*}", "node", node, "msgid", msgid, "data", data_ptr, data_size);
+    else
+        wrap_json_pack(&j_query, "{s:i, s:i}", "node", node, "msgid", msgid);
 
-    afb_event_push(eventDataRx->rx_event, j_event_info);
+    afb_event_push(eventDataRx->rx_event, j_query);
 }
 
 /** Asynchronous processing of Rx messages in mainloop is recommended */
@@ -858,7 +848,36 @@ PUBLIC void ucs2_sendmessage(struct afb_req request) {
 }
 
 PUBLIC void ucs2_sendmessageb64(struct afb_req req) {
-    afb_req_fail_f(req, "not-implemented", "Function not yet implemented.");
+    uint8_t *data_ptr = NULL;
+    size_t data_sz = 0;
+    int ret, node_addr, msg_id  = 0;
+    struct json_object *j_obj;
+
+    j_obj = ucs2_validate_command(req, "sendmessageb64");
+
+    if (!j_obj) {
+        AFB_NOTICE("validation of command failed");
+        goto OnErrorExit;
+    }
+
+    ret = wrap_json_unpack(j_obj, "{s:i, s:i, s?Y}", "node", &node_addr, "msgid", &msg_id, "data", &data_ptr, &data_sz);
+
+    if ((ret==0) &&
+        UCSI_SendAmsMessage(&ucsContextS->ucsiData, msg_id, node_addr, &data_ptr[0], data_sz)
+            ) {
+        afb_req_success(req, NULL, "sendmessageb64 started successful");
+    }
+    else {
+        AFB_ERROR("sendmessageb64: scheduling command failed. ret: %d", ret);
+        afb_req_fail_f(req, "query-command-queue","ambiguous command or queue overload");
+        goto OnErrorExit;
+    }
+
+OnErrorExit:
+    if (data_ptr) {
+        free(data_ptr);
+    }
+    return;
 }
 
 PUBLIC int ucs2_initbinding(void) {