Diff: accelerometer.cpp

Revision:

2:f271388cbfa9

Child:

3:a708d3686f4b

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/accelerometer.cpp	Wed Feb 04 16:41:56 2015 +0000
@@ -0,0 +1,97 @@
+// accelerometer sensor resource implementation
+ 
+#include "mbed.h"
+#include "nsdl_support.h"
+
+#include "node_cfg.h"
+
+#define ACCELEROMETER_RES_ID    "/sen/accelerometer"
+#define ACCELEROMETER_RES_RT    "Accelerometer"
+
+#if NODE_ACCELEROMETER_STATION 
+extern bool current_accelerometer_value;         //Either from Kiosk or PIR
+static char accelerometer_val[2];
+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 accelerometer.
+void accelerometer_report() {
+    printf("in report");
+    if(obs_number != 0){
+        obs_number++;
+        snprintf(accelerometer_val,2,"%d" ,current_accelerometer_value);
+        if(sn_nsdl_send_observation_notification(obs_token_ptr, obs_token_len, (uint8_t*)accelerometer_val, 1, &obs_number, 1, COAP_MSG_TYPE_NON_CONFIRMABLE, 0) == 0) {
+            printf("accelerometer Observation Sending Failed\r\n");
+        } else {
+            printf("accelerometer Observation Sent\r\n");
+        }
+    }
+}
+ 
+/* Only GET method allowed */
+static uint8_t accelerometer_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(accelerometer_val,2,"%d" ,current_accelerometer_value);
+    printf("accelerometer callback\r\n");
+    printf("accelerometer: %s\r\n", accelerometer_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(accelerometer_val);
+        coap_res_ptr->payload_ptr = (uint8_t*)accelerometer_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;
+            }
+        }
+    
+        if(received_coap_ptr->options_list_ptr->observe){
+            coap_res_ptr->options_list_ptr = (sn_coap_options_list_s*)malloc(sizeof(sn_coap_options_list_s));
+            memset(coap_res_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s));
+            coap_res_ptr->options_list_ptr->observe_ptr = &obs_number;
+            coap_res_ptr->options_list_ptr->observe_len = 1;
+            obs_number++;
+        }
+        printf("   Send observation %d... \r\n", obs_number);
+ 
+        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_accelerometer_resource(sn_nsdl_resource_info_s *resource_ptr)
+{
+    obs_number++;
+    nsdl_create_dynamic_resource(resource_ptr, sizeof(ACCELEROMETER_RES_ID)-1, (uint8_t*)ACCELEROMETER_RES_ID, sizeof(ACCELEROMETER_RES_RT)-1, (uint8_t*)ACCELEROMETER_RES_RT, 1, &accelerometer_resource_cb, (SN_GRS_GET_ALLOWED));
+    return 0;
+}
+#endif
\ No newline at end of file