Add callback for CoAP message prevalidation (ARMmbed#1918)

Set message prevalidation callback to CoAP Service

Author: Arto Kinnunen

source/6LoWPAN/Thread/thread_management_server.c

@@ -66,6 +66,8 @@
 #include "thread_management_server.h"
 #include "mac_api.h"
 #include "6LoWPAN/MAC/mac_data_poll.h"
+#include "Common_Protocols/ipv6_constants.h"
+#include "Core/include/address.h"
 #include "mlme.h"
 
 #ifdef HAVE_THREAD
@@ -1118,6 +1120,36 @@ static int thread_management_server_announce_begin_cb(int8_t service_id, uint8_t
     return 0;
 }
 
+static int coap_msg_prevalidate_cb(int8_t interface_id, uint8_t source_address[static 16], uint16_t source_port, uint8_t local_address[static 16], uint16_t local_port, char *coap_uri)
+{
+    protocol_interface_info_entry_t *cur;
+    uint_fast8_t local_addr_scope;
+
+    (void) source_address;
+    (void) source_port;
+    (void) coap_uri;
+
+    cur = protocol_stack_interface_info_get_by_id(interface_id);
+
+    if (!cur) {
+        tr_error("No interface");
+        return -1;
+    }
+
+    if (local_port != THREAD_MANAGEMENT_PORT) {
+        // Message not sent to THREAD_MANAGEMENT_PORT, let it come through
+        return 0;
+    }
+
+    /* check our address scope */
+    local_addr_scope = addr_ipv6_scope(local_address, cur);
+    if (local_addr_scope > IPV6_SCOPE_REALM_LOCAL) {
+        return 1;
+    }
+
+    return 0;
+}
+
 /**
  * Public interface functions
  */
@@ -1162,6 +1194,7 @@ int thread_management_server_init(int8_t interface_id)
         ns_dyn_mem_free(this);
         return -3;
     }
+    coap_service_msg_prevalidate_callback_set(this->coap_service_id, coap_msg_prevalidate_cb);
 #ifdef HAVE_THREAD_ROUTER
     if (thread_leader_service_init(interface_id, this->coap_service_id) != 0) {
         tr_error("Thread leader service init failed");

test/nanostack/unittest/stub/coap_service_api_stub.c

@@ -100,4 +100,9 @@ void coap_service_request_delete_by_service_id(int8_t service_id)
 {
 }
 
+int8_t coap_service_msg_prevalidate_callback_set(int8_t service_id, coap_service_msg_prevalidate_cb *msg_prevalidate_cb)
+{
+    return 0;
+}
+
 #endif