MBED_DEMOS / Mbed 2 deprecated SensorExamples-mDS-Ethernet

Project with example IPSO resources for LED bar, Gas Sensor, and Light Sensor

Dependencies:   EthernetInterface LED_Bar mbed-rtos mbed nsdl_lib

resources/IPSO_presence.cpp@7:3f52b52ef2ad, 2014-10-25 (annotated)

Committer:
michaeljkoster
Date:
Sat Oct 25 04:07:58 2014 +0000
Revision:
7:3f52b52ef2ad
Parent:
6:4fa917ca6aa4 
fix notification payload

Who changed what in which revision?

UserRevisionLine numberNew contents of line
michaeljkoster 1:76ab3521eb51 1 // IPSO Presence sensor resource implementation
michaeljkoster 1:76ab3521eb51 2
michaeljkoster 1:76ab3521eb51 3 #include "mbed.h"
michaeljkoster 5:3fa1d1f8b3f8 4 #include "rtos.h"
michaeljkoster 1:76ab3521eb51 5 #include "nsdl_support.h"
michaeljkoster 1:76ab3521eb51 6
michaeljkoster 1:76ab3521eb51 7 #define PRESENCE_RES_ID "3302/0/5500"
michaeljkoster 1:76ab3521eb51 8 #define PRESENCE_RES_RT "urn:X-ipso:presence"
michaeljkoster 1:76ab3521eb51 9
michaeljkoster 1:76ab3521eb51 10 extern Serial pc;
michaeljkoster 1:76ab3521eb51 11 uint8_t presence_max_age = 0;
michaeljkoster 1:76ab3521eb51 12 uint8_t presence_content_type = 50;
michaeljkoster 1:76ab3521eb51 13
michaeljkoster 5:3fa1d1f8b3f8 14 static uint8_t pres_obs_number = 0;
michaeljkoster 5:3fa1d1f8b3f8 15 static uint8_t *pres_obs_token_ptr = NULL;
michaeljkoster 5:3fa1d1f8b3f8 16 static uint8_t pres_obs_token_len = 0;
michaeljkoster 5:3fa1d1f8b3f8 17
michaeljkoster 1:76ab3521eb51 18 DigitalIn presenceSensor(D2);
michaeljkoster 7:3f52b52ef2ad 19 uint8_t presence = 0;
michaeljkoster 7:3f52b52ef2ad 20 uint8_t last_presence = 0;
michaeljkoster 7:3f52b52ef2ad 21 char presenceString[1];
michaeljkoster 1:76ab3521eb51 22
michaeljkoster 5:3fa1d1f8b3f8 23 static void pres_observe_thread(void const *args)
michaeljkoster 7:3f52b52ef2ad 24 {
michaeljkoster 5:3fa1d1f8b3f8 25 while (true)
michaeljkoster 7:3f52b52ef2ad 26 {
michaeljkoster 6:4fa917ca6aa4 27 wait(.1);
michaeljkoster 6:4fa917ca6aa4 28 presence = presenceSensor.read();
michaeljkoster 6:4fa917ca6aa4 29 if((presence != last_presence) && pres_obs_number != 0 && pres_obs_token_ptr != NULL)
michaeljkoster 7:3f52b52ef2ad 30 {
michaeljkoster 6:4fa917ca6aa4 31 last_presence = presence;
michaeljkoster 7:3f52b52ef2ad 32 pc.printf("presence: %d\r\n", presence);
michaeljkoster 5:3fa1d1f8b3f8 33 pres_obs_number++;
michaeljkoster 6:4fa917ca6aa4 34 sprintf(presenceString,"%d", presence);
michaeljkoster 7:3f52b52ef2ad 35 if(sn_nsdl_send_observation_notification(pres_obs_token_ptr, pres_obs_token_len, (uint8_t*)presenceString, strlen(presenceString), &pres_obs_number, 1, COAP_MSG_TYPE_NON_CONFIRMABLE, 0) == 0)
michaeljkoster 5:3fa1d1f8b3f8 36 pc.printf("Presence observation sending failed\r\n");
michaeljkoster 5:3fa1d1f8b3f8 37 else
michaeljkoster 5:3fa1d1f8b3f8 38 pc.printf("Presence observation\r\n");
michaeljkoster 7:3f52b52ef2ad 39 }
michaeljkoster 5:3fa1d1f8b3f8 40 }
michaeljkoster 5:3fa1d1f8b3f8 41 }
michaeljkoster 5:3fa1d1f8b3f8 42
michaeljkoster 5:3fa1d1f8b3f8 43
michaeljkoster 1:76ab3521eb51 44 /* Only GET method allowed */
michaeljkoster 1:76ab3521eb51 45 static uint8_t presence_resource_cb(sn_coap_hdr_s *received_coap_ptr, sn_nsdl_addr_s *address, sn_proto_info_s * proto)
michaeljkoster 1:76ab3521eb51 46 {
michaeljkoster 1:76ab3521eb51 47 sn_coap_hdr_s *coap_res_ptr = 0;
michaeljkoster 1:76ab3521eb51 48 presence = presenceSensor.read();
michaeljkoster 1:76ab3521eb51 49 sprintf(presenceString,"%d", presence);
michaeljkoster 4:69ea903414fe 50 pc.printf("presence callback\r\n");
michaeljkoster 4:69ea903414fe 51 pc.printf("presence state %s\r\n", presenceString);
michaeljkoster 1:76ab3521eb51 52
michaeljkoster 1:76ab3521eb51 53 if(received_coap_ptr->msg_code == COAP_MSG_CODE_REQUEST_GET)
michaeljkoster 7:3f52b52ef2ad 54 {
michaeljkoster 1:76ab3521eb51 55 coap_res_ptr = sn_coap_build_response(received_coap_ptr, COAP_MSG_CODE_RESPONSE_CONTENT);
michaeljkoster 5:3fa1d1f8b3f8 56
michaeljkoster 1:76ab3521eb51 57 coap_res_ptr->payload_len = strlen(presenceString);
michaeljkoster 1:76ab3521eb51 58 coap_res_ptr->payload_ptr = (uint8_t*)presenceString;
michaeljkoster 1:76ab3521eb51 59
michaeljkoster 1:76ab3521eb51 60 coap_res_ptr->content_type_ptr = &presence_content_type;
michaeljkoster 1:76ab3521eb51 61 coap_res_ptr->content_type_len = sizeof(presence_content_type);
michaeljkoster 1:76ab3521eb51 62
michaeljkoster 1:76ab3521eb51 63 coap_res_ptr->options_list_ptr = (sn_coap_options_list_s*)nsdl_alloc(sizeof(sn_coap_options_list_s));
michaeljkoster 1:76ab3521eb51 64 if(!coap_res_ptr->options_list_ptr)
michaeljkoster 1:76ab3521eb51 65 {
michaeljkoster 5:3fa1d1f8b3f8 66 pc.printf("cant alloc option list\r\n");
michaeljkoster 1:76ab3521eb51 67 coap_res_ptr->options_list_ptr = NULL; //FIXME report error and recover
michaeljkoster 1:76ab3521eb51 68 }
michaeljkoster 1:76ab3521eb51 69 memset(coap_res_ptr->options_list_ptr, 0, sizeof(sn_coap_options_list_s));
michaeljkoster 1:76ab3521eb51 70 coap_res_ptr->options_list_ptr->max_age_ptr = &presence_max_age;
michaeljkoster 1:76ab3521eb51 71 coap_res_ptr->options_list_ptr->max_age_len = sizeof(presence_max_age);
michaeljkoster 5:3fa1d1f8b3f8 72
michaeljkoster 5:3fa1d1f8b3f8 73 if(received_coap_ptr->token_ptr)
michaeljkoster 5:3fa1d1f8b3f8 74 {
michaeljkoster 5:3fa1d1f8b3f8 75 pc.printf("Token included\r\n");
michaeljkoster 5:3fa1d1f8b3f8 76 if(pres_obs_token_ptr)
michaeljkoster 5:3fa1d1f8b3f8 77 {
michaeljkoster 5:3fa1d1f8b3f8 78 free(pres_obs_token_ptr);
michaeljkoster 5:3fa1d1f8b3f8 79 pres_obs_token_ptr = 0;
michaeljkoster 5:3fa1d1f8b3f8 80 }
michaeljkoster 5:3fa1d1f8b3f8 81 pres_obs_token_ptr = (uint8_t*)malloc(received_coap_ptr->token_len);
michaeljkoster 5:3fa1d1f8b3f8 82 if(pres_obs_token_ptr)
michaeljkoster 5:3fa1d1f8b3f8 83 {
michaeljkoster 5:3fa1d1f8b3f8 84 memcpy(pres_obs_token_ptr, received_coap_ptr->token_ptr, received_coap_ptr->token_len);
michaeljkoster 5:3fa1d1f8b3f8 85 pres_obs_token_len = received_coap_ptr->token_len;
michaeljkoster 5:3fa1d1f8b3f8 86 }
michaeljkoster 5:3fa1d1f8b3f8 87 }
michaeljkoster 1:76ab3521eb51 88
michaeljkoster 5:3fa1d1f8b3f8 89 if(received_coap_ptr->options_list_ptr->observe)
michaeljkoster 5:3fa1d1f8b3f8 90 {
michaeljkoster 5:3fa1d1f8b3f8 91 coap_res_ptr->options_list_ptr->observe_ptr = &pres_obs_number;
michaeljkoster 5:3fa1d1f8b3f8 92 coap_res_ptr->options_list_ptr->observe_len = 1;
michaeljkoster 5:3fa1d1f8b3f8 93 pres_obs_number++;
michaeljkoster 5:3fa1d1f8b3f8 94 }
michaeljkoster 5:3fa1d1f8b3f8 95
michaeljkoster 1:76ab3521eb51 96 sn_nsdl_send_coap_message(address, coap_res_ptr);
michaeljkoster 1:76ab3521eb51 97 nsdl_free(coap_res_ptr->options_list_ptr);
michaeljkoster 1:76ab3521eb51 98 coap_res_ptr->options_list_ptr = NULL;
michaeljkoster 1:76ab3521eb51 99 coap_res_ptr->content_type_ptr = NULL;// parser_release below tries to free this memory
michaeljkoster 7:3f52b52ef2ad 100 }
michaeljkoster 1:76ab3521eb51 101
michaeljkoster 1:76ab3521eb51 102 sn_coap_parser_release_allocated_coap_msg_mem(coap_res_ptr);
michaeljkoster 1:76ab3521eb51 103
michaeljkoster 1:76ab3521eb51 104 return 0;
michaeljkoster 1:76ab3521eb51 105 }
michaeljkoster 1:76ab3521eb51 106
michaeljkoster 1:76ab3521eb51 107 int create_IPSO_presence_resource(sn_nsdl_resource_info_s *resource_ptr)
michaeljkoster 1:76ab3521eb51 108 {
michaeljkoster 5:3fa1d1f8b3f8 109 static Thread exec_thread(pres_observe_thread);
michaeljkoster 5:3fa1d1f8b3f8 110
michaeljkoster 5:3fa1d1f8b3f8 111 nsdl_create_dynamic_resource(resource_ptr, sizeof(PRESENCE_RES_ID)-1, (uint8_t*)PRESENCE_RES_ID, sizeof(PRESENCE_RES_RT)-1, (uint8_t*)PRESENCE_RES_RT, 1, &presence_resource_cb, (SN_GRS_GET_ALLOWED));
michaeljkoster 1:76ab3521eb51 112 return 0;
michaeljkoster 1:76ab3521eb51 113 }