X-Git-Url: https://gerrit.automotivelinux.org/gerrit/gitweb?a=blobdiff_plain;f=ucs2-afb%2Fucs_binding.c;h=b42c3ff4924e811e0dd49c0f301754161b40beae;hb=f892ce6d36b2287c5f54ae2a819b5342ef6ec22f;hp=e413ee3b6936d793df36e2fb216b790e11ec8bdc;hpb=05e055b854e46a7bbd60b4c249ff267a000b9258;p=apps%2Fagl-service-unicens.git

diff --git a/ucs2-afb/ucs_binding.c b/ucs2-afb/ucs_binding.c
index e413ee3..b42c3ff 100644
--- a/ucs2-afb/ucs_binding.c
+++ b/ucs2-afb/ucs_binding.c
@@ -65,6 +65,8 @@ typedef struct {
 
 static ucsContextT *ucsContextS;
 
+STATIC void ucs2_write_i2c_response(void *result_ptr, void *request_ptr);
+
 PUBLIC void UcsXml_CB_OnError(const char format[], uint16_t vargsCnt, ...) {
     /*AFB_DEBUG (afbIface, format, args); */
     va_list args;
@@ -545,40 +547,65 @@ PUBLIC void ucs2_monitor (struct afb_req request) {
 #define CONTROL_CH_1    0x08U
 #define CONTROL_CH_2    0x09U
 
-PUBLIC void ucs2_write_i2c (struct afb_req request) {
-    
-    /*const uint16_t MUTE_VALUE     = 0x03FFU;*/
-    /*const uint8_t MUTE_VALUE_HB   = 0x03U;*/
-    /*const uint8_t MUTE_VALUE_LB   = 0xFFU;*/
+#define UCSB_I2C_MAX_PAYLOAD     32
 
-    /*const uint8_t CONTROL_MASTER  = 0x07U;*/
-    /*const uint8_t CONTROL_CH_1    = 0x08U;*/
-    /*const uint8_t CONTROL_CH_2    = 0x09U;*/
+PUBLIC void ucs2_write_i2c (struct afb_req request) {
     
-    struct json_object *j_obj, *temp;
-    static uint8_t tx_payload[3] = {CONTROL_MASTER, MUTE_VALUE_HB, MUTE_VALUE_LB};
+    struct json_object *j_obj;
+    static uint8_t tx_payload[UCSB_I2C_MAX_PAYLOAD];
+    uint8_t tx_payload_sz = 0;
     uint16_t node_addr = 0;
     
     /* check UNICENS is initialised */
     if (!ucsContextS) {
-        afb_req_fail_f (request, "unicens-init","Should Load Config before using setvol");
+        afb_req_fail_f(request, "unicens-init","Should Load Config before using setvol");
         goto OnErrorExit;
     }
 
     j_obj = afb_req_json(request);
     if (!j_obj) {
-        afb_req_fail_f (request, "query-notjson","query=%s not a valid json entry", afb_req_value(request,""));
+        afb_req_fail_f(request, "query-notjson","query=%s not a valid json entry", afb_req_value(request,""));
         goto OnErrorExit;
     };
     
-    node_addr = (uint16_t)json_object_get_int(json_object_object_get(j_obj, "node"));
-    AFB_NOTICE ("node_addr: 0x%02X", node_addr);
+    node_addr = (uint16_t)json_object_get_int(json_object_object_get(j_obj, "node_address"));
+    AFB_NOTICE("node_address: 0x%02X", node_addr);
     
     if (node_addr == 0) {
-        afb_req_fail_f (request, "query-params","params wrong or missing");
+        afb_req_fail_f(request, "query-params","params wrong or missing");
+        goto OnErrorExit;
+    }
+       
+    if (json_object_get_type(json_object_object_get(j_obj, "i2c_data"))==json_type_array) {
+        int size = json_object_array_length(json_object_object_get(j_obj, "i2c_data"));
+        if ((size > 0) && (size <= UCSB_I2C_MAX_PAYLOAD)) {
+            
+            int32_t i;
+            int32_t val;
+            struct json_object *j_elem;
+            struct json_object *j_arr = json_object_object_get(j_obj, "i2c_data");
+
+            for (i = 0; i < size; i++) {
+                
+                
+                j_elem = json_object_array_get_idx(j_arr, i);
+                val = json_object_get_int(j_elem);
+                if ((val < 0) && (val > 0xFF)){
+                    i = 0;
+                    break;
+                }
+                tx_payload[i] = (uint8_t)json_object_get_int(j_elem);
+            }
+            
+            tx_payload_sz = (uint8_t)i;
+        }
+    }
+    
+    if (tx_payload_sz == 0) {
+        AFB_NOTICE("i2c_data: invalid or not found");
+        afb_req_fail_f(request, "query-params","params wrong or missing");
         goto OnErrorExit;
     }
-        
         
     UCSI_I2CWrite(&ucsContextS->ucsiData,/*UCSI_Data_t *pPriv*/
                   node_addr,            /*uint16_t targetAddress*/
@@ -586,13 +613,35 @@ PUBLIC void ucs2_write_i2c (struct afb_req request) {
                   0u,                   /* block count */
                   0x2Au,                /* i2c slave address */
                   0x03E8u,              /* timeout 1000 milliseconds */
-                  3,                    /* uint8_t dataLen */
-                  &tx_payload[0]        /* uint8_t *pData */
-                );
-    
+                  tx_payload_sz,        /* uint8_t dataLen */
+                  &tx_payload[0],       /* uint8_t *pData */
+                  ucs2_write_i2c_response,
+                  (void*)&request
+                );  
     
     afb_req_success(request,NULL,"done!!!");
     
  OnErrorExit:
     return;
 }
+
+STATIC void ucs2_write_i2c_response(void *result_ptr, void *request_ptr) {
+    
+    if (request_ptr){
+        afb_req *req = (afb_req *)request_ptr;
+        Ucs_I2c_ResultCode_t *res = (Ucs_I2c_ResultCode_t *)result_ptr;
+        
+        if (!res) {
+            afb_req_fail(*req, NULL,"failure, result code not provided");
+        }
+        else if (*res != UCS_I2C_RES_SUCCESS){
+            afb_req_fail_f(*req, NULL, "failure, result code: %d", *res);
+        }
+        else {
+            afb_req_success(*req, NULL, "success");
+        }
+    } 
+    else {
+        AFB_NOTICE("write_i2c: ambiguous response data");
+    }
+}