Diff: Resources/height.cpp

Revision:

25:cb16c5248769

diff -r 81c04180090c -r cb16c5248769 Resources/height.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Resources/height.cpp	Wed Dec 03 09:03:29 2014 +0000
@@ -0,0 +1,96 @@
+// height (from Maxbotix) sensor resource implementation
+ 
+#include "mbed.h"
+#include "nsdl_support.h"
+#include "sensor_ctl.h"
+//#include "node_cfg.h"
+ 
+#define HEIGHT_RES_ID    "/sen/door/height"
+#define HEIGHT_RES_RT    "Height"
+
+#if NODE_HEIGHT_STATION
+extern float current_door_height_value;
+static char height_val[5];
+static uint8_t max_age = 0; 
+static uint8_t content_type = 50;
+ 
+/* stored data for observable resource */
+static uint8_t obs_number = 0;
+static uint8_t *obs_token_ptr = NULL;
+static uint8_t obs_token_len = 0;
+
+
+
+//This is to be called from main program loop... it only sends report if height taken.
+void height_report() {
+    if(obs_number != 0){// && obs_token_ptr != NULL){
+        obs_number++;
+        snprintf(height_val,5,"%f" ,current_door_height_value);
+        if(sn_nsdl_send_observation_notification(obs_token_ptr, obs_token_len, (uint8_t*)height_val, 5, &obs_number, 1, COAP_MSG_TYPE_NON_CONFIRMABLE, 0) == 0) {
+            printf("Height Observation Sending Failed\r\n");
+        } else {
+            printf("Height Observation Sent\r\n");
+        }
+    }
+} 
+
+/* Only GET method allowed */
+static uint8_t height_resource_cb(sn_coap_hdr_s *received_coap_ptr, sn_nsdl_addr_s *address, sn_proto_info_s * proto)
+{
+    sn_coap_hdr_s *coap_res_ptr = 0;
+    snprintf(height_val,5,"%f" ,current_door_height_value);
+    printf("height callback\r\n");
+    printf("height: %s\r\n", height_val);
+ 
+    if(received_coap_ptr->msg_code == COAP_MSG_CODE_REQUEST_GET)
+    {
+        coap_res_ptr = sn_coap_build_response(received_coap_ptr, COAP_MSG_CODE_RESPONSE_CONTENT);
+ 
+        coap_res_ptr->payload_len = strlen(height_val);
+        coap_res_ptr->payload_ptr = (uint8_t*)height_val;
+        
+        coap_res_ptr->content_type_ptr = &content_type;
+        coap_res_ptr->content_type_len = sizeof(content_type);
+        
+        if(received_coap_ptr->token_ptr){
+            printf("   Token included\r\n");
+            if(obs_token_ptr){
+                free(obs_token_ptr);
+                obs_token_ptr = 0;
+            }
+            obs_token_ptr = (uint8_t*)malloc(received_coap_ptr->token_len);
+            if(obs_token_ptr){
+                memcpy(obs_token_ptr, received_coap_ptr->token_ptr, received_coap_ptr->token_len);
+                obs_token_len = received_coap_ptr->token_len;
+            }
+        }
+        
+        coap_res_ptr->options_list_ptr = (sn_coap_options_list_s*)nsdl_alloc(sizeof(sn_coap_options_list_s));
+        if(!coap_res_ptr->options_list_ptr)
+            {
+            printf("cant alloc option list for max-age\r\n");
+            coap_res_ptr->options_list_ptr = NULL; //FIXME report error and recover
+            }
+        memset(coap_res_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s));
+        coap_res_ptr->options_list_ptr->max_age_ptr = &max_age;
+        coap_res_ptr->options_list_ptr->max_age_len = sizeof(max_age);
+ 
+        sn_nsdl_send_coap_message(address, coap_res_ptr);
+        nsdl_free(coap_res_ptr->options_list_ptr);
+        coap_res_ptr->options_list_ptr = NULL;
+        coap_res_ptr->content_type_ptr = NULL;// parser_release below tries to free this memory
+ 
+    }
+ 
+    sn_coap_parser_release_allocated_coap_msg_mem(coap_res_ptr);
+ 
+    return 0;
+}
+ 
+int create_height_resource(sn_nsdl_resource_info_s *resource_ptr)
+{
+    obs_number++;
+    nsdl_create_dynamic_resource(resource_ptr, sizeof(HEIGHT_RES_ID)-1, (uint8_t*)HEIGHT_RES_ID, sizeof(HEIGHT_RES_RT)-1, (uint8_t*)HEIGHT_RES_RT, 1, &height_resource_cb, (SN_GRS_GET_ALLOWED));
+    return 0;
+}
+#endif