mbed client on ethernet with LWIP
Dependencies: mbed Socket lwip-eth lwip-sys lwip
Fork of mbed-client-classic-example-lwip by
Diff: mbed-client/source/m2mnsdlinterface.cpp
- Revision:
- 11:cada08fc8a70
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed-client/source/m2mnsdlinterface.cpp Thu Jun 09 17:08:36 2016 +0000 @@ -0,0 +1,1388 @@ +/* + * Copyright (c) 2015 ARM Limited. All rights reserved. + * SPDX-License-Identifier: Apache-2.0 + * Licensed under the Apache License, Version 2.0 (the License); you may + * not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an AS IS BASIS, WITHOUT + * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ +#include "include/nsdlaccesshelper.h" +#include "include/m2mnsdlobserver.h" +#include "mbed-client/m2msecurity.h" +#include "mbed-client/m2mserver.h" +#include "mbed-client/m2mobject.h" +#include "mbed-client/m2mobjectinstance.h" +#include "mbed-client/m2mresource.h" +#include "mbed-client/m2mconstants.h" +#include "include/m2mtlvserializer.h" +#include "ip6string.h" +#include "ns_trace.h" +#include "mbed-client/m2mtimer.h" + +M2MNsdlInterface::M2MNsdlInterface(M2MNsdlObserver &observer) +: _observer(observer), + _server(NULL), + _nsdl_exceution_timer(new M2MTimer(*this)), + _registration_timer(new M2MTimer(*this)), + _nsdl_handle(NULL), + _counter_for_nsdl(0), + _register_id(0), + _unregister_id(0), + _update_id(0), + _bootstrap_id(0) +{ + tr_debug("M2MNsdlInterface::M2MNsdlInterface()"); + _endpoint = NULL; + _resource = NULL; + __nsdl_interface = this; + + _bootstrap_endpoint.device_object = NULL; + _bootstrap_endpoint.oma_bs_status_cb = NULL; + + _bootstrap_device_setup.sn_oma_device_boot_callback = NULL; + _bootstrap_device_setup.error_code = NO_ERROR; + + _sn_nsdl_address.addr_len = 0; + _sn_nsdl_address.addr_ptr = NULL; + _sn_nsdl_address.port = 0; + + // This initializes libCoap and libNsdl + // Parameters are function pointers to used memory allocation + // and free functions in structure and used functions for sending + // and receiving purposes. + _nsdl_handle = sn_nsdl_init(&(__nsdl_c_send_to_server), &(__nsdl_c_received_from_server), + &(__nsdl_c_memory_alloc), &(__nsdl_c_memory_free)); + + initialize(); +} + +M2MNsdlInterface::~M2MNsdlInterface() +{ + tr_debug("M2MNsdlInterface::~M2MNsdlInterface() - IN"); + if(_resource) { + if(_resource->resource_parameters_ptr) { + memory_free(_resource->resource_parameters_ptr); + _resource->resource_parameters_ptr = NULL; + } + memory_free(_resource); + _resource = NULL; + } + if(_endpoint) { + if(_endpoint->lifetime_ptr) { + memory_free(_endpoint->lifetime_ptr); + _endpoint->lifetime_ptr = NULL; + } + if(_endpoint->location_ptr) { + memory_free(_endpoint->location_ptr); + _endpoint->location_ptr = NULL; + } + memory_free(_endpoint); + _endpoint = NULL; + + } + delete _nsdl_exceution_timer; + delete _registration_timer; + _object_list.clear(); + + if(_server){ + delete _server; + _server = NULL; + } + sn_nsdl_destroy(_nsdl_handle); + _nsdl_handle = NULL; + __nsdl_interface = NULL; + tr_debug("M2MNsdlInterface::~M2MNsdlInterface() - OUT"); +} + +bool M2MNsdlInterface::initialize() +{ + tr_debug("M2MNsdlInterface::initialize()"); + bool success = false; + + //Sets the packet retransmission attempts and time interval + sn_coap_protocol_set_retransmission_parameters(RETRY_COUNT,RETRY_INTERVAL); + + _nsdl_exceution_timer->start_timer(ONE_SECOND_TIMER * 1000, + M2MTimerObserver::NsdlExecution, + false); + + // Allocate the memory for resources + _resource = (sn_nsdl_resource_info_s*)memory_alloc(sizeof(sn_nsdl_resource_info_s)); + if(_resource) { + memset(_resource, 0, sizeof(sn_nsdl_resource_info_s)); + _resource->resource_parameters_ptr = (sn_nsdl_resource_parameters_s*)memory_alloc(sizeof(sn_nsdl_resource_parameters_s)+1); + if(_resource->resource_parameters_ptr) { + memset(_resource->resource_parameters_ptr, 0, sizeof(sn_nsdl_resource_parameters_s)+1); + } + } + + //Allocate the memory for endpoint + _endpoint = (sn_nsdl_ep_parameters_s*)memory_alloc(sizeof(sn_nsdl_ep_parameters_s)+1); + if(_endpoint) { + memset(_endpoint, 0, sizeof(sn_nsdl_ep_parameters_s)+1); + success = true; + } + return success; +} + +void M2MNsdlInterface::create_endpoint(const String &name, + const String &type, + const int32_t life_time, + const String &domain, + const uint8_t mode, + const String &/*context_address*/) +{ + tr_debug("M2MNsdlInterface::create_endpoint( name %s type %s lifetime %d, domain %s, mode %d)", + name.c_str(), type.c_str(), life_time, domain.c_str(), mode); + if(_endpoint){ + memset(_endpoint, 0, sizeof(sn_nsdl_ep_parameters_s)+1); + if(!name.empty()) { + _endpoint->endpoint_name_ptr = (uint8_t*)name.c_str(); + _endpoint->endpoint_name_len = name.length(); + } + if(!type.empty()) { + _endpoint->type_ptr = (uint8_t*)type.c_str(); + _endpoint->type_len = type.length(); + } + if(!domain.empty()) { + _endpoint->domain_name_ptr = (uint8_t*)domain.c_str(); + _endpoint->domain_name_len = domain.length(); + } + _endpoint->binding_and_mode = (sn_nsdl_oma_binding_and_mode_t)mode; + + // If lifetime is less than zero then leave the field empty + if( life_time > 0) { + char *buffer = (char*)memory_alloc(20); + int size = snprintf(buffer, 20,"%ld",(long int)life_time); + if( _endpoint->lifetime_ptr == NULL ){ + _endpoint->lifetime_ptr = (uint8_t*)memory_alloc(size+1); + } + if(_endpoint->lifetime_ptr) { + memset(_endpoint->lifetime_ptr, 0, size+1); + memcpy(_endpoint->lifetime_ptr,buffer,size); + _endpoint->lifetime_len = size; + } + memory_free(buffer); + } + } +} + +void M2MNsdlInterface::delete_endpoint() +{ + tr_debug("M2MNsdlInterface::delete_endpoint()"); + if(_endpoint) { + if(_endpoint->lifetime_ptr) { + free(_endpoint->lifetime_ptr); + _endpoint->lifetime_ptr = NULL; + } + memory_free(_endpoint); + _endpoint = NULL; + } +} + +bool M2MNsdlInterface::create_nsdl_list_structure(const M2MObjectList &object_list) +{ + tr_debug("M2MNsdlInterface::create_nsdl_list_structure()"); + bool success = false; + if(!object_list.empty()) { + tr_debug("M2MNsdlInterface::create_nsdl_list_structure - Object count is %d", object_list.size()); + M2MObjectList::const_iterator it; + it = object_list.begin(); + for ( ; it != object_list.end(); it++ ) { + // Create NSDL structure for all Objects inside + success = create_nsdl_object_structure(*it); + add_object_to_list(*it); + } + } + return success; +} + +bool M2MNsdlInterface::delete_nsdl_resource(const String &resource_name) +{ + tr_debug("M2MNsdlInterface::delete_nsdl_resource( %s)", resource_name.c_str()); + return (sn_nsdl_delete_resource(_nsdl_handle, + resource_name.length(), + (uint8_t *)resource_name.c_str()) == 0) ? true : false; +} + +bool M2MNsdlInterface::create_bootstrap_resource(sn_nsdl_addr_s *address) +{ + tr_debug("M2MNsdlInterface::create_bootstrap_resource()"); + bool success = false; + _bootstrap_device_setup.error_code = NO_ERROR; + _bootstrap_device_setup.sn_oma_device_boot_callback = 0; + + _bootstrap_endpoint.device_object = &_bootstrap_device_setup; + _bootstrap_endpoint.oma_bs_status_cb = &__nsdl_c_bootstrap_done; + + if(_bootstrap_id == 0) { + _bootstrap_id = sn_nsdl_oma_bootstrap(_nsdl_handle, + address, + _endpoint, + &_bootstrap_endpoint); + tr_debug("M2MNsdlInterface::create_bootstrap_resource - _bootstrap_id %d", _bootstrap_id); + success = _bootstrap_id != 0; + + } + return success; +} + +bool M2MNsdlInterface::send_register_message(uint8_t* address, + const uint16_t port, + sn_nsdl_addr_type_e address_type) +{ + tr_debug("M2MNsdlInterface::send_register_message()"); + bool success = false; + if(set_NSP_address(_nsdl_handle,address, port, address_type) == 0) { + if(_register_id == 0) { + _register_id = sn_nsdl_register_endpoint(_nsdl_handle,_endpoint); + tr_debug("M2MNsdlInterface::send_register_message - _register_id %d", _register_id); + success = _register_id != 0; + } + } + return success; +} + +bool M2MNsdlInterface::send_update_registration(const uint32_t lifetime) +{ + tr_debug("M2MNsdlInterface::send_update_registration( lifetime %d)", lifetime); + bool success = false; + + create_nsdl_list_structure(_object_list); + //If Lifetime value is 0, then don't change the existing lifetime value + if(lifetime != 0) { + char *buffer = (char*)memory_alloc(20); + int size = snprintf(buffer, 20,"%ld",(long int)lifetime); + if(_endpoint->lifetime_ptr) { + memory_free(_endpoint->lifetime_ptr); + _endpoint->lifetime_ptr = NULL; + _endpoint->lifetime_len = 0; + } + + if(_endpoint->lifetime_ptr == NULL){ + _endpoint->lifetime_ptr = (uint8_t*)memory_alloc(size+1); + } + if(_endpoint->lifetime_ptr) { + memset(_endpoint->lifetime_ptr, 0, size+1); + memcpy(_endpoint->lifetime_ptr,buffer,size); + _endpoint->lifetime_len = size; + } + memory_free(buffer); + + _registration_timer->stop_timer(); + _registration_timer->start_timer(registration_time() * 1000, + M2MTimerObserver::Registration, + false); + if(_nsdl_handle && + _endpoint && _endpoint->lifetime_ptr) { + _update_id = sn_nsdl_update_registration(_nsdl_handle, + _endpoint->lifetime_ptr, + _endpoint->lifetime_len); + tr_debug("M2MNsdlInterface::send_update_registration - New lifetime value _update_id %d", _update_id); + success = _update_id != 0; + } + } else { + if(_nsdl_handle) { + _update_id = sn_nsdl_update_registration(_nsdl_handle, NULL, 0); + tr_debug("M2MNsdlInterface::send_update_registration - regular update- _update_id %d", _update_id); + success = _update_id != 0; + } + } + return success; +} + +bool M2MNsdlInterface::send_unregister_message() +{ + tr_debug("M2MNsdlInterface::send_unregister_message"); + bool success = false; + //Does not clean resources automatically + if(_unregister_id == 0) { + _unregister_id = sn_nsdl_unregister_endpoint(_nsdl_handle); + tr_debug("M2MNsdlInterface::send_unregister_message - _unregister_id %d", _unregister_id); + success = _unregister_id != 0; + } + return success; +} + +void *M2MNsdlInterface::memory_alloc(uint16_t size) +{ + if(size) + return malloc(size); + else + return 0; +} + +void M2MNsdlInterface::memory_free(void *ptr) +{ + if(ptr) + free(ptr); +} + +uint8_t M2MNsdlInterface::send_to_server_callback(struct nsdl_s * /*nsdl_handle*/, + sn_nsdl_capab_e /*protocol*/, + uint8_t *data_ptr, + uint16_t data_len, + sn_nsdl_addr_s *address) +{ + tr_debug("M2MNsdlInterface::send_to_server_callback()"); + _observer.coap_message_ready(data_ptr,data_len,address); + return 1; +} + +uint8_t M2MNsdlInterface::received_from_server_callback(struct nsdl_s * /*nsdl_handle*/, + sn_coap_hdr_s *coap_header, + sn_nsdl_addr_s *address) +{ + tr_debug("M2MNsdlInterface::received_from_server_callback()"); + _observer.coap_data_processed(); + uint8_t value = 0; + if(coap_header) { + if(coap_header->msg_id == _register_id) { + _register_id = 0; + if(coap_header->msg_code == COAP_MSG_CODE_RESPONSE_CREATED) { + if(_server) { + delete _server; + _server = NULL; + } + tr_debug("M2MNsdlInterface::received_from_server_callback - registration callback"); + _server = new M2MServer(); + _server->set_resource_value(M2MServer::ShortServerID,1); + + _observer.client_registered(_server); + // If lifetime is less than zero then leave the field empty + if(coap_header->options_list_ptr) { + if(coap_header->options_list_ptr->max_age_ptr) { + if(_endpoint->lifetime_ptr) { + memory_free(_endpoint->lifetime_ptr); + _endpoint->lifetime_ptr = NULL; + _endpoint->lifetime_len = 0; + } + uint32_t max_time = 0; + for(int i=0;i < coap_header->options_list_ptr->max_age_len; i++) { + max_time += (*(coap_header->options_list_ptr->max_age_ptr + i) & 0xff) << + 8*(coap_header->options_list_ptr->max_age_len- 1 - i); + } + // If lifetime is less than zero then leave the field empty + if( max_time > 0) { + char *buffer = (char*)memory_alloc(20); + if(buffer) { + int size = snprintf(buffer, 20,"%ld",(long int)max_time); + _endpoint->lifetime_ptr = (uint8_t*)memory_alloc(size+1); + + if(_endpoint->lifetime_ptr) { + memset(_endpoint->lifetime_ptr, 0, size+1); + memcpy(_endpoint->lifetime_ptr,buffer,size); + _endpoint->lifetime_len = size; + } + memory_free(buffer); + } + } + } + if(coap_header->options_list_ptr->location_path_ptr) { + _endpoint->location_ptr = (uint8_t*)memory_alloc(coap_header->options_list_ptr->location_path_len+1); + memset(_endpoint->location_ptr,0,coap_header->options_list_ptr->location_path_len+1); + memcpy(_endpoint->location_ptr, + coap_header->options_list_ptr->location_path_ptr, + coap_header->options_list_ptr->location_path_len); + _endpoint->location_len = coap_header->options_list_ptr->location_path_len ; + sn_nsdl_set_endpoint_location(_nsdl_handle,_endpoint->location_ptr,_endpoint->location_len); + } + } + if(_endpoint->lifetime_ptr) { + _registration_timer->stop_timer(); + _registration_timer->start_timer(registration_time() * 1000, + M2MTimerObserver::Registration, + false); + } + } else { + if(_server) { + delete _server; + _server = NULL; + } + tr_error("M2MNsdlInterface::received_from_server_callback - registration error %d", coap_header->msg_code); + M2MInterface::Error error = interface_error(coap_header); + _observer.registration_error(error); + } + } else if(coap_header->msg_id == _unregister_id) { + _unregister_id = 0; + if(coap_header->msg_code == COAP_MSG_CODE_RESPONSE_DELETED) { + _registration_timer->stop_timer(); + if(_server) { + delete _server; + _server = NULL; + } + tr_debug("M2MNsdlInterface::received_from_server_callback - unregistration callback"); + _observer.client_unregistered(); + } else { + tr_error("M2MNsdlInterface::received_from_server_callback - unregistration error %d", coap_header->msg_code); + M2MInterface::Error error = interface_error(coap_header); + _observer.registration_error(error); + } + } else if(coap_header->msg_id == _update_id) { + _update_id = 0; + + if(coap_header->msg_code == COAP_MSG_CODE_RESPONSE_CHANGED) { + tr_debug("M2MNsdlInterface::received_from_server_callback - registration_updated successfully"); + _observer.registration_updated(*_server); + } else { + tr_error("M2MNsdlInterface::received_from_server_callback - registration_updated failed %d", coap_header->msg_code); + M2MInterface::Error error = interface_error(coap_header); + // In case, the error for update registration is not allowed implies the client is no longer registered in + // server hence the error returns should be NotRegistered. + if(M2MInterface::NotAllowed == error) { + error = M2MInterface::NotRegistered; + } + _observer.registration_error(error); + } + }else if(coap_header->msg_id == _bootstrap_id) { + _bootstrap_id = 0; + M2MInterface::Error error = interface_error(coap_header); + if(error != M2MInterface::ErrorNone) { + _observer.bootstrap_error(); + } + } else { + if(COAP_MSG_CODE_REQUEST_POST == coap_header->msg_code) { + if(coap_header->uri_path_ptr) { + String resource_name = coap_to_string(coap_header->uri_path_ptr, + coap_header->uri_path_len); + + sn_coap_hdr_s *coap_response = NULL; + String object_name; + int slash_found = resource_name.find_last_of('/'); + //The POST operation here is only allowed for non-existing object instances + if(slash_found != -1) { + object_name = resource_name.substr(0,slash_found); + if( object_name.find_last_of('/') != -1){ + coap_response = sn_nsdl_build_response(_nsdl_handle, + coap_header, + COAP_MSG_CODE_RESPONSE_NOT_FOUND); + } else { + int32_t instance_id = atoi(resource_name.substr(slash_found+1, + resource_name.size()-object_name.size()).c_str()); + M2MBase* base = find_resource(object_name); + if(base && (instance_id >= 0) && (instance_id < 65535)) { + if(coap_header->payload_ptr) { + M2MObject* object = (M2MObject*)base; + M2MObjectInstance *obj_instance = object->create_object_instance(instance_id); + if(obj_instance) { + obj_instance->set_operation(M2MBase::GET_PUT_POST_ALLOWED); + coap_response = obj_instance->handle_post_request(_nsdl_handle,coap_header,this); + } + if(coap_response && coap_response->msg_code != COAP_MSG_CODE_RESPONSE_CREATED) { + //Invalid request so remove created ObjectInstance + object->remove_object_instance(instance_id); + } + } else { + tr_debug("M2MNsdlInterface::received_from_server_callback - Missing Payload - Cannot create"); + coap_response = sn_nsdl_build_response(_nsdl_handle, + coap_header, + COAP_MSG_CODE_RESPONSE_BAD_REQUEST); + } + } else { //if(base) + tr_debug("M2MNsdlInterface::received_from_server_callback - Missing BASE - Cannot create"); + coap_response = sn_nsdl_build_response(_nsdl_handle, + coap_header, + COAP_MSG_CODE_RESPONSE_METHOD_NOT_ALLOWED); + } + } + } else{ // if(slash_found != -1) + tr_debug("M2MNsdlInterface::received_from_server_callback - slash_found - Cannot create"); + coap_response = sn_nsdl_build_response(_nsdl_handle, + coap_header, + COAP_MSG_CODE_RESPONSE_NOT_FOUND); + } + if(coap_response) { + tr_debug("M2MNsdlInterface::received_from_server_callback - send CoAP response"); + (sn_nsdl_send_coap_message(_nsdl_handle, address, coap_response) == 0) ? value = 0 : value = 1; + sn_nsdl_release_allocated_coap_msg_mem(_nsdl_handle, coap_response); + } + } + } + } + } + return value; +} + +uint8_t M2MNsdlInterface::resource_callback(struct nsdl_s */*nsdl_handle*/, + sn_coap_hdr_s *received_coap_header, + sn_nsdl_addr_s *address, + sn_nsdl_capab_e /*nsdl_capab*/) +{ + tr_debug("M2MNsdlInterface::resource_callback()"); + _observer.coap_data_processed(); + uint8_t result = 1; + sn_coap_hdr_s *coap_response = NULL; + sn_coap_msg_code_e msg_code = COAP_MSG_CODE_RESPONSE_CHANGED; // 4.00 + String resource_name = coap_to_string(received_coap_header->uri_path_ptr, + received_coap_header->uri_path_len); + tr_debug("M2MNsdlInterface::resource_callback() - resource_name %s", resource_name.c_str()); + M2MBase* base = find_resource(resource_name); + + if(base) { + if(COAP_MSG_CODE_REQUEST_GET == received_coap_header->msg_code) { + coap_response = base->handle_get_request(_nsdl_handle, received_coap_header,this); + } else if(COAP_MSG_CODE_REQUEST_PUT == received_coap_header->msg_code) { + coap_response = base->handle_put_request(_nsdl_handle, received_coap_header,this); + } else if(COAP_MSG_CODE_REQUEST_POST == received_coap_header->msg_code) { + if(base->base_type() == M2MBase::ResourceInstance) { + msg_code = COAP_MSG_CODE_RESPONSE_BAD_REQUEST; + } else { + coap_response = base->handle_post_request(_nsdl_handle, received_coap_header,this); + } + } else if(COAP_MSG_CODE_REQUEST_DELETE == received_coap_header->msg_code) { + // Delete the object instance + tr_debug("M2MNsdlInterface::resource_callback() - DELETE the object instance"); + M2MBase::BaseType type = base->base_type(); + if(M2MBase::ObjectInstance == type) { + M2MBase* base_object = find_resource(base->name()); + if(base_object) { + M2MObject *object = (M2MObject*)base_object; + int slash_found = resource_name.find_last_of('/'); + // Object instance validty checks done in upper level, no need for error handling + if(slash_found != -1) { + String object_name; + object_name = resource_name.substr(slash_found + 1, resource_name.length()); + if (object->remove_object_instance(strtoul( + object_name.c_str(), NULL, 10))) { + msg_code = COAP_MSG_CODE_RESPONSE_DELETED; + } + } + } + } else { + msg_code = COAP_MSG_CODE_RESPONSE_BAD_REQUEST; // 4.00 + } + } + } else { + tr_debug("M2MNsdlInterface::resource_callback() - Resource NOT FOUND"); + msg_code = COAP_MSG_CODE_RESPONSE_BAD_REQUEST; // 4.00 + } + if(!coap_response) { + coap_response = sn_nsdl_build_response(_nsdl_handle, + received_coap_header, + msg_code); + } + if(coap_response) { + tr_debug("M2MNsdlInterface::resource_callback() - send CoAP response"); + (sn_nsdl_send_coap_message(_nsdl_handle, address, coap_response) == 0) ? result = 0 : result = 1; + if(coap_response->payload_ptr) { + free(coap_response->payload_ptr); + coap_response->payload_ptr = NULL; + } + sn_nsdl_release_allocated_coap_msg_mem(_nsdl_handle, coap_response); + } + return result; +} + +void M2MNsdlInterface::bootstrap_done_callback(sn_nsdl_oma_server_info_t *server_info) +{ + tr_debug("M2MNsdlInterface::bootstrap_done_callback()"); + _bootstrap_id = 0; + M2MSecurity* security = NULL; + if(server_info && server_info->omalw_address_ptr->addr_ptr) { + security = new M2MSecurity(M2MSecurity::M2MServer); + uint16_t port = server_info->omalw_address_ptr->port; + char *buffer = (char*)memory_alloc(20); + snprintf(buffer, 20,"%d",port); + String server_uri(COAP); + String server_address; + //TODO: currently only supports IPV4 Mapping, fix to support IPV6 as well + if(SN_NSDL_ADDRESS_TYPE_IPV4 == server_info->omalw_address_ptr->type) { + int val = 0; + for(int index = 0; index < server_info->omalw_address_ptr->addr_len; index++) { + char *server_buffer = (char*)memory_alloc(20); + val = (int)server_info->omalw_address_ptr->addr_ptr[index]; + snprintf(server_buffer, 20,"%d",val); + server_address +=String(server_buffer); + + memory_free(server_buffer); + + if(index < server_info->omalw_address_ptr->addr_len-1) { + server_address += String("."); + } + } + + tr_debug("M2MNsdlInterface::bootstrap_done_callback - IPv4 Server address received %s", server_address.c_str()); + } else if(SN_NSDL_ADDRESS_TYPE_HOSTNAME == server_info->omalw_address_ptr->type) { + char *hostname = (char*)memory_alloc(server_info->omalw_address_ptr->addr_len); + if(hostname) { + memset(hostname, 0, server_info->omalw_address_ptr->addr_len); + memcpy(hostname, + server_info->omalw_address_ptr->addr_ptr, + server_info->omalw_address_ptr->addr_len); + server_address += String(hostname); + memory_free(hostname); + hostname = NULL; + tr_debug("M2MNsdlInterface::bootstrap_done_callback - Hostname Server address received %s", server_address.c_str()); + } + } else if(SN_NSDL_ADDRESS_TYPE_IPV6 == server_info->omalw_address_ptr->type) { + char ipv6_address[40]; + ip6tos(server_info->omalw_address_ptr->addr_ptr, ipv6_address); + server_address += String(ipv6_address); + tr_debug("M2MNsdlInterface::bootstrap_done_callback - IPv6 Server address received %s", server_address.c_str()); + } + + server_uri += server_address; + server_uri +=String(":"); + server_uri += String(buffer); + + memory_free(buffer); + security->set_resource_value(M2MSecurity::M2MServerUri, server_uri); + security->set_resource_value(M2MSecurity::BootstrapServer, 0); + + M2MSecurity::SecurityModeType security_mode = M2MSecurity::SecurityNotSet; + + switch(server_info->omalw_server_security) { + case SEC_NOT_SET: + security_mode = M2MSecurity::SecurityNotSet; + break; + case PSK: + //Not supported at the moment + break; + case RPK: + //Not supported at the moment + break; + case CERTIFICATE: + security_mode = M2MSecurity::Certificate; + break; + case NO_SEC: + security_mode = M2MSecurity::NoSecurity; + break; + } + security->set_resource_value(M2MSecurity::SecurityMode,security_mode); + + //TODO: This is mandatory parameter for LWM2M server, + // why is it missing from nsdl-c API ? + security->set_resource_value(M2MSecurity::ShortServerID,1); + + // Check certiticates only if the mode is Certificate + // else it is in NoSecurity Mode, Psk and Rsk are not supported. + if(M2MSecurity::Certificate == security_mode) { + omalw_certificate_list_t *certificates = sn_nsdl_get_certificates(_nsdl_handle); + if(certificates) { + security->set_resource_value(M2MSecurity::ServerPublicKey,certificates->certificate_ptr[0],certificates->certificate_len[0]); + security->set_resource_value(M2MSecurity::PublicKey,certificates->certificate_ptr[1],certificates->certificate_len[1]); + security->set_resource_value(M2MSecurity::Secretkey,certificates->own_private_key_ptr,certificates->own_private_key_len); + } else { + // Mode is certificate but certificates are missing so its bootstrap error. + delete security; + security = NULL; + } + } + } + if(security) { + tr_debug("M2MNsdlInterface::bootstrap_done_callback - bootstrap_done"); + // Inform that bootstrap is done and LWM2M server object is available. + _observer.bootstrap_done(security); + } else { + tr_error("M2MNsdlInterface::bootstrap_done_callback - bootstrap_error"); + // Bootstrap error inform to the application. + _observer.bootstrap_error(); + } +} + +bool M2MNsdlInterface::process_received_data(uint8_t *data, + uint16_t data_size, + sn_nsdl_addr_s *address) +{ + tr_debug("M2MNsdlInterface::process_received_data( data size %d)", data_size); + return (0 == sn_nsdl_process_coap(_nsdl_handle, + data, + data_size, + address)) ? true : false; +} + +void M2MNsdlInterface::stop_timers() +{ + tr_debug("M2MNsdlInterface::stop_timers()"); + if(_registration_timer) { + _registration_timer->stop_timer(); + } +} + +void M2MNsdlInterface::timer_expired(M2MTimerObserver::Type type) +{ + if(M2MTimerObserver::NsdlExecution == type) { + sn_nsdl_exec(_nsdl_handle, _counter_for_nsdl); + _counter_for_nsdl++; + } else if(M2MTimerObserver::Registration == type) { + tr_debug("M2MNsdlInterface::timer_expired - M2MTimerObserver::Registration - Send update registration"); + send_update_registration(); + } +} + +void M2MNsdlInterface::observation_to_be_sent(M2MBase *object) +{ + tr_debug("M2MNsdlInterface::observation_to_be_sent()"); + if(object) { + M2MBase::BaseType type = object->base_type(); + if(type == M2MBase::Object) { + send_object_observation((M2MObject*)object); + } else if(type == M2MBase::ObjectInstance) { + send_object_instance_observation((M2MObjectInstance*)object); + } else if(type == M2MBase::Resource) { + send_resource_observation((M2MResource*)object); + } + } +} + +void M2MNsdlInterface::resource_to_be_deleted(const String &resource_name) +{ + tr_debug("M2MNsdlInterface::resource_to_be_deleted(resource_name %s)", resource_name.c_str()); + delete_nsdl_resource(resource_name); +} + +void M2MNsdlInterface::value_updated(M2MBase *base, + const String &object_name) +{ + tr_debug("M2MNsdlInterface::value_updated()"); + if(base) { + switch(base->base_type()) { + case M2MBase::Object: + create_nsdl_object_structure((M2MObject*)base); + break; + case M2MBase::ObjectInstance: + create_nsdl_object_instance_structure((M2MObjectInstance*)base); + break; + case M2MBase::Resource: { + M2MResource* resource = (M2MResource*)base; + create_nsdl_resource_structure(resource,object_name, + resource->supports_multiple_instances()); + } + break; + case M2MBase::ResourceInstance: { + M2MResourceInstance* instance = (M2MResourceInstance*)base; + create_nsdl_resource(instance,object_name); + } + break; + } + } + _observer.value_updated(base); +} + +void M2MNsdlInterface::remove_object(M2MBase *object) +{ + tr_debug("M2MNsdlInterface::remove_object()"); + M2MObject* rem_object = (M2MObject*)object; + if(rem_object && !_object_list.empty()) { + M2MObjectList::const_iterator it; + it = _object_list.begin(); + int index = 0; + for ( ; it != _object_list.end(); it++, index++ ) { + if((*it) == rem_object) { + _object_list.erase(index); + break; + } + } + } + if(_object_list.empty()) { + _object_list.clear(); + } +} + +bool M2MNsdlInterface::create_nsdl_object_structure(M2MObject *object) +{ + tr_debug("M2MNsdlInterface::create_nsdl_object_structure()"); + bool success = false; + if(object) { + //object->set_under_observation(false,this); + M2MObjectInstanceList instance_list = object->instances(); + tr_debug("M2MNsdlInterface::create_nsdl_object_structure - Object Instance count %d", instance_list.size()); + if(!instance_list.empty()) { + M2MObjectInstanceList::const_iterator it; + it = instance_list.begin(); + for ( ; it != instance_list.end(); it++ ) { + // Create NSDL structure for all object instances inside + success = create_nsdl_object_instance_structure(*it); + } + } + } + if((object->operation() != M2MBase::NOT_ALLOWED)) { + success = create_nsdl_resource(object,object->name()); + } + return success; +} + +bool M2MNsdlInterface::create_nsdl_object_instance_structure(M2MObjectInstance *object_instance) +{ + tr_debug("M2MNsdlInterface::create_nsdl_object_instance_structure()"); + bool success = false; + if( object_instance) { + + char *inst_id = (char*)malloc(20); + snprintf(inst_id, 20,"%d",object_instance->instance_id()); + + // Append object instance id to the object name. + String object_name = object_instance->name(); + object_name += String("/"); + object_name += String(inst_id); + free(inst_id); + + + //object_instance->set_under_observation(false,this); + + M2MResourceList res_list = object_instance->resources(); + tr_debug("M2MNsdlInterface::create_nsdl_object_instance_structure - ResourceBase count %d", res_list.size()); + if(!res_list.empty()) { + M2MResourceList::const_iterator it; + it = res_list.begin(); + for ( ; it != res_list.end(); it++ ) { + // Create NSDL structure for all resources inside + success = create_nsdl_resource_structure(*it,object_name, + (*it)->supports_multiple_instances()); + } + } + if(object_instance->operation() != M2MBase::NOT_ALLOWED) { + success = create_nsdl_resource(object_instance,object_name); + } + } + return success; +} + +bool M2MNsdlInterface::create_nsdl_resource_structure(M2MResource *res, + const String &object_name, + bool multiple_instances) +{ + tr_debug("M2MNsdlInterface::create_nsdl_resource_structure(object_name %s)", object_name.c_str()); + bool success = false; + if(res) { + // Append object name to the resource. + // Take out the instance Id and append to the + // resource name like "object/0/+ resource + / + 0" + String res_name = object_name; + res_name+= String("/"); + res_name.append(res->name().c_str(),res->name().length()); + + // if there are multiple instances supported + // then add instance Id into creating resource path + // else normal /object_id/object_instance/resource_id format. + if(multiple_instances) { + M2MResourceInstanceList res_list = res->resource_instances(); + tr_debug("M2MNsdlInterface::create_nsdl_resource_structure - ResourceInstance count %d", res_list.size()); + if(!res_list.empty()) { + M2MResourceInstanceList::const_iterator it; + it = res_list.begin(); + for ( ; it != res_list.end(); it++ ) { + String inst_name = res_name; + // Create NSDL structure for all resources inside + char *inst_id = (char*)memory_alloc(20); + snprintf(inst_id, 20,"%d",(*it)->instance_id()); + inst_name+= String("/") ; + inst_name+= String(inst_id); + + memory_free(inst_id); + + success = create_nsdl_resource((*it),inst_name); + } + // Register the main Resource as well along with ResourceInstances + success = create_nsdl_resource(res,res_name); + } + } else { + tr_debug("M2MNsdlInterface::create_nsdl_resource_structure - res_name %s", res_name.c_str()); + success = create_nsdl_resource(res,res_name); + } + } + return success; +} + +bool M2MNsdlInterface::create_nsdl_resource(M2MBase *base, const String &name) +{ + tr_debug("M2MNsdlInterface::create_nsdl_resource(name %s)", name.c_str()); + bool success = false; + uint8_t* buffer = 0; + uint32_t length = 0; + + // Create the NSDL Resource Pointer... + if(base) { + sn_nsdl_resource_info_s* resource = sn_nsdl_get_resource(_nsdl_handle, + name.length(), + (uint8_t*)name.c_str()); + if(resource) { + success = true; + if(resource->mode == SN_GRS_STATIC) { + if((M2MBase::Resource == base->base_type() || + M2MBase::ResourceInstance == base->base_type()) && + M2MBase::Static == base->mode()) { + M2MResourceInstance *res = (M2MResourceInstance*)base; + res->get_value(buffer,length); + if(resource->resource) { + memory_free(resource->resource); + } + resource->resource = buffer; + resource->resourcelen = length; + sn_nsdl_update_resource(_nsdl_handle,resource); + } + } + // Update Resource access everytime for existing resource. + resource->access = (sn_grs_resource_acl_e)base->operation(); + } else if(_resource) { + base->set_under_observation(false,this); + //TODO: implement access control + // Currently complete access is given + _resource->access = (sn_grs_resource_acl_e)base->operation(); + + if((M2MBase::Resource == base->base_type() || + M2MBase::ResourceInstance == base->base_type()) && + M2MBase::Static == base->mode()) { + M2MResourceInstance *res = (M2MResourceInstance*)base; + // Static resource is updated + _resource->mode = SN_GRS_STATIC; + + res->get_value(buffer,length); + _resource->resource = buffer; + _resource->resourcelen = length; + } + + if(M2MBase::Dynamic == base->mode()){ + // Dynamic resource is updated + _resource->mode = SN_GRS_DYNAMIC; + _resource->sn_grs_dyn_res_callback = __nsdl_c_callback; + } else { + _resource->mode = SN_GRS_DIRECTORY; + } + + if( _resource->path != NULL ){ + memory_free(_resource->path); + _resource->path = NULL; + } + if(name.length() > 0 ){ + _resource->path = ((uint8_t*)memory_alloc(name.length()+1)); + if(_resource->path) { + memset(_resource->path, 0, name.length()+1); + memcpy(_resource->path, (uint8_t*)name.c_str(), name.length()); + _resource->pathlen = name.length(); + } + } + + if(!base->resource_type().empty() && _resource->resource_parameters_ptr) { + _resource->resource_parameters_ptr->resource_type_ptr = + ((uint8_t*)memory_alloc(base->resource_type().length()+1)); + if(_resource->resource_parameters_ptr->resource_type_ptr) { + memset(_resource->resource_parameters_ptr->resource_type_ptr, + 0, base->resource_type().length()+1); + memcpy(_resource->resource_parameters_ptr->resource_type_ptr, + (uint8_t*)base->resource_type().c_str(), + base->resource_type().length()); + _resource->resource_parameters_ptr->resource_type_len = + base->resource_type().length(); + } + } + if(!base->interface_description().empty() && _resource->resource_parameters_ptr) { + _resource->resource_parameters_ptr->interface_description_ptr = + ((uint8_t*)memory_alloc(base->interface_description().length()+1)); + if(_resource->resource_parameters_ptr->interface_description_ptr) { + memset(_resource->resource_parameters_ptr->interface_description_ptr, + 0, base->interface_description().length()+1); + memcpy(_resource->resource_parameters_ptr->interface_description_ptr, + (uint8_t*)base->interface_description().c_str(), + base->interface_description().length()); + _resource->resource_parameters_ptr->interface_description_len = + base->interface_description().length(); + } + } + if(_resource->resource_parameters_ptr) { + _resource->resource_parameters_ptr->coap_content_type = base->coap_content_type(); + _resource->resource_parameters_ptr->observable = (uint8_t)base->is_observable(); + } + + int8_t result = sn_nsdl_create_resource(_nsdl_handle,_resource); + tr_debug("M2MNsdlInterface::create_nsdl_resource - Creating in NSDL-C result %d", result); + + // Either the resource is created or it already + // exists , then result is success. + if (result == 0 || + result == -2){ + success = true; + } + + if(_resource->path) { + memory_free(_resource->path); + } + if(_resource->resource_parameters_ptr->resource_type_ptr){ + memory_free(_resource->resource_parameters_ptr->resource_type_ptr); + } + if(_resource->resource_parameters_ptr->interface_description_ptr){ + memory_free(_resource->resource_parameters_ptr->interface_description_ptr); + } + + //Clear up the filled resource to fill up new resource. + clear_resource(_resource); + + if(success) { + base->set_under_observation(false,this); + } + } + } + if(buffer) { + free(buffer); + } + return success; +} + +// convenience method to get the URI from its buffer field... +String M2MNsdlInterface::coap_to_string(uint8_t *coap_data,int coap_data_length) +{ + String value = ""; + if (coap_data != NULL && coap_data_length > 0) { + char buf[256+1]; + memset(buf,0,256+1); + memcpy(buf,(char *)coap_data,coap_data_length); + value = String(buf); + } + return value; +} + +uint64_t M2MNsdlInterface::registration_time() +{ + uint64_t value = 0; + if(_endpoint->lifetime_ptr) { + value = atol((const char*)_endpoint->lifetime_ptr); + } + + if(value >= OPTIMUM_LIFETIME) { + value = value - REDUCE_LIFETIME; + } else { + value = REDUCTION_FACTOR * value; + } + tr_debug("M2MNsdlInterface::registration_time - value (in seconds) %ld", value); + return value; +} + +M2MBase* M2MNsdlInterface::find_resource(const String &object_name) +{ + M2MBase *object = NULL; + if(!_object_list.empty()) { + M2MObjectList::const_iterator it; + it = _object_list.begin(); + for ( ; it != _object_list.end(); it++ ) { + if((*it)->name() == object_name) { + object = (*it); + tr_debug("M2MNsdlInterface::find_resource(%s) found", object_name.c_str()); + break; + } + object = find_resource((*it),object_name); + if(object != NULL) { + tr_debug("M2MNsdlInterface::find_resource(%s) found", object_name.c_str()); + break; + } + } + } + return object; +} + +M2MBase* M2MNsdlInterface::find_resource(const M2MObject *object, + const String &object_instance) +{ + M2MBase *instance = NULL; + if(object) { + M2MObjectInstanceList list = object->instances(); + if(!list.empty()) { + M2MObjectInstanceList::const_iterator it; + it = list.begin(); + for ( ; it != list.end(); it++ ) { + char *inst_id = (char*)memory_alloc(20); + snprintf(inst_id, 20,"%d",(*it)->instance_id()); + + // Append object instance id to the object name. + String name = (*it)->name(); + name+= String("/"); + name+= String(inst_id); + + memory_free(inst_id); + + if(name == object_instance){ + instance = (*it); + break; + } + instance = find_resource((*it),object_instance); + if(instance != NULL){ + break; + } + } + } + } + return instance; +} + +M2MBase* M2MNsdlInterface::find_resource(const M2MObjectInstance *object_instance, + const String &resource_instance) +{ + M2MBase *instance = NULL; + if(object_instance) { + M2MResourceList list = object_instance->resources(); + if(!list.empty()) { + M2MResourceList::const_iterator it; + it = list.begin(); + for ( ; it != list.end(); it++ ) { + String name = object_instance->name(); + char *obj_inst_id = (char*)memory_alloc(20); + snprintf(obj_inst_id, 20,"%d",object_instance->instance_id()); + + // Append object instance id to the object name. + name+= String("/"); + name+= String(obj_inst_id); + + memory_free(obj_inst_id); + + name+= String("/"); + name+= (*it)->name(); + + if(name == resource_instance) { + instance = *it; + break; + } else if((*it)->supports_multiple_instances()) { + instance = find_resource((*it),name, resource_instance); + if(instance != NULL){ + break; + } + } + } + } + } + return instance; +} + +M2MBase* M2MNsdlInterface::find_resource(const M2MResource *resource, + const String &object_name, + const String &resource_instance) +{ + M2MBase *res = NULL; + if(resource) { + if(resource->supports_multiple_instances()) { + M2MResourceInstanceList list = resource->resource_instances(); + if(!list.empty()) { + M2MResourceInstanceList::const_iterator it; + it = list.begin(); + for ( ; it != list.end(); it++ ) { + String name = object_name; + // if there are multiple instances supported + // then add instance Id into creating resource path + // else normal /object_id/object_instance/resource_id format. + + char *inst_id = (char*)memory_alloc(20); + snprintf(inst_id, 20,"%d",(*it)->instance_id()); + + name+= String("/") ; + name+= String(inst_id); + + memory_free(inst_id); + + if(name == resource_instance){ + res = (*it); + break; + } + } + } + } + } + return res; +} + +bool M2MNsdlInterface::object_present(M2MObject* object) const +{ + bool success = false; + if(object && !_object_list.empty()) { + M2MObjectList::const_iterator it; + it = _object_list.begin(); + for ( ; it != _object_list.end(); it++ ) { + if((*it) == object) { + success = true; + break; + } + } + } + return success; +} + +bool M2MNsdlInterface::add_object_to_list(M2MObject* object) +{ + bool success = false; + if(object && !object_present(object)) { + _object_list.push_back(object); + success = true; + } + return success; +} + +void M2MNsdlInterface::clear_resource(sn_nsdl_resource_info_s *&resource) +{ + //Clear up the filled resource to fill up new resource. + if(resource && resource->resource_parameters_ptr) { + sn_nsdl_resource_parameters_s *temp_resource_parameter = resource->resource_parameters_ptr; + memset(resource->resource_parameters_ptr, 0, sizeof(sn_nsdl_resource_parameters_s)); + memset(resource,0, sizeof(sn_nsdl_resource_info_s)); + resource->resource_parameters_ptr = temp_resource_parameter; + } +} + +M2MInterface::Error M2MNsdlInterface::interface_error(sn_coap_hdr_s *coap_header) +{ + M2MInterface::Error error = M2MInterface::ErrorNone; + if(coap_header) { + switch(coap_header->msg_code) { + case COAP_MSG_CODE_RESPONSE_BAD_REQUEST: + case COAP_MSG_CODE_RESPONSE_BAD_OPTION: + case COAP_MSG_CODE_RESPONSE_REQUEST_ENTITY_INCOMPLETE: + case COAP_MSG_CODE_RESPONSE_PRECONDITION_FAILED: + case COAP_MSG_CODE_RESPONSE_REQUEST_ENTITY_TOO_LARGE: + case COAP_MSG_CODE_RESPONSE_UNSUPPORTED_CONTENT_FORMAT: + error = M2MInterface::InvalidParameters; + break; + case COAP_MSG_CODE_RESPONSE_UNAUTHORIZED: + case COAP_MSG_CODE_RESPONSE_FORBIDDEN: + case COAP_MSG_CODE_RESPONSE_NOT_ACCEPTABLE: + case COAP_MSG_CODE_RESPONSE_NOT_FOUND: + case COAP_MSG_CODE_RESPONSE_METHOD_NOT_ALLOWED: + error = M2MInterface::NotAllowed; + break; + case COAP_MSG_CODE_RESPONSE_CREATED: + case COAP_MSG_CODE_RESPONSE_DELETED: + case COAP_MSG_CODE_RESPONSE_VALID: + case COAP_MSG_CODE_RESPONSE_CHANGED: + case COAP_MSG_CODE_RESPONSE_CONTENT: + error = M2MInterface::ErrorNone; + break; + default: + error = M2MInterface::UnknownError; + break; + } + if(coap_header->coap_status == COAP_STATUS_BUILDER_MESSAGE_SENDING_FAILED) { + error = M2MInterface::NetworkError; + } + } + return error; +} + +void M2MNsdlInterface::send_object_observation(M2MObject *object) +{ + tr_debug("M2MNsdlInterface::send_object_observation"); + if(object) { + uint8_t *value = 0; + uint32_t length = 0; + uint8_t *token = 0; + uint32_t token_length = 0; + uint8_t observation_number[2]; + uint8_t observation_number_length = 1; + + uint16_t number = object->observation_number(); + + observation_number[0] = ((number>>8) & 0xFF); + observation_number[1] = (number & 0xFF); + + if(number > 0xFF) { + observation_number_length = 2; + } + + M2MTLVSerializer *serializer = new M2MTLVSerializer(); + if(serializer) { + value = serializer->serialize(object->instances(), length); + delete serializer; + } + + object->get_observation_token(token,token_length); + + sn_nsdl_send_observation_notification(_nsdl_handle, + token, + token_length, + value,length, + observation_number, + observation_number_length, + COAP_MSG_TYPE_CONFIRMABLE, + object->coap_content_type()); + memory_free(value); + memory_free(token); + } +} + +void M2MNsdlInterface::send_object_instance_observation(M2MObjectInstance *object_instance) +{ + tr_debug("M2MNsdlInterface::send_object_instance_observation"); + if(object_instance) { + uint8_t *value = 0; + uint32_t length = 0; + uint8_t *token = 0; + uint32_t token_length = 0; + uint8_t observation_number[2]; + uint8_t observation_number_length = 1; + + uint16_t number = object_instance->observation_number(); + + observation_number[0] = ((number>>8) & 0xFF); + observation_number[1] = (number & 0xFF); + + if(number > 0xFF) { + observation_number_length = 2; + } + + M2MTLVSerializer *serializer = new M2MTLVSerializer(); + if(serializer) { + value = serializer->serialize(object_instance->resources(), length); + delete serializer; + } + + object_instance->get_observation_token(token,token_length); + + sn_nsdl_send_observation_notification(_nsdl_handle, + token, + token_length, + value,length, + observation_number, + observation_number_length, + COAP_MSG_TYPE_CONFIRMABLE, + object_instance->coap_content_type()); + memory_free(value); + memory_free(token); + } +} + +void M2MNsdlInterface::send_resource_observation(M2MResource *resource) +{ + tr_debug("M2MNsdlInterface::send_resource_observation"); + if(resource) { + uint8_t *value = 0; + uint32_t length = 0; + uint8_t *token = 0; + uint32_t token_length = 0; + uint8_t observation_number[2]; + uint8_t observation_number_length = 1; + + uint16_t number = resource->observation_number(); + + observation_number[0] = ((number>>8) & 0xFF); + observation_number[1] = (number & 0xFF); + + if(number > 0xFF) { + observation_number_length = 2; + } + + resource->get_observation_token(token,token_length); + uint8_t content_type = 0; + if (resource->resource_instance_count() > 0) { + M2MTLVSerializer *serializer = new M2MTLVSerializer(); + content_type = COAP_CONTENT_OMA_TLV_TYPE; + if(serializer) { + value = serializer->serialize(resource, length); + delete serializer; + } + } else { + resource->get_value(value,length); + } + + sn_nsdl_send_observation_notification(_nsdl_handle, + token, + token_length, + value,length, + observation_number, + observation_number_length, + COAP_MSG_TYPE_CONFIRMABLE, + content_type); + memory_free(value); + memory_free(token); + } +}