NXP / Mbed 2 deprecated mcr20_wireless_uart

The MCR20A Wireless UART application functions as an wireless UART bridge between two (one-to-one) or several (one to many) boards. The application can be used with both a TERM, or with software that is capable of opening a serial port and writing to or reading from it. The characters sent or received are not necessarily ASCII printable characters.

Dependencies:   fsl_phy_mcr20a fsl_smac mbed-rtos mbed

Fork of mcr20_wireless_uart by Freescale

By default, the application uses broadcast addresses for OTA communication. This way, the application can be directly downloaded and run without any user intervention. The following use case assumes no changes have been done to the project.

  • Two (or more) MCR20A platforms (plugged into the FRDM-K64F Freescale Freedom Development platform) have to be connected to the PC using the mini/micro-USB cables.
  • The code must be downloaded on the platforms via CMSIS-DAP (or other means).
  • After that, two or more TERM applications must be opened, and the serial ports must be configured with the same baud rate as the one in the project (default baud rate is 115200). Other necessary serial configurations are 8 bit, no parity, and 1 stop bit.
  • To start the setup, each platform must be reset, and one of the (user) push buttons found on the MCR20A platform must be pressed. The user can press any of the non-reset buttons on the FRDM-K64F Freescale Freedom Development platform as well. *This initiates the state machine of the application so user can start.

Documentation

SMAC Demo Applications User Guide

main.cpp@3:a38ad504a18c, 2015-03-05 (annotated)

Committer:
sam_grove
Date:
Thu Mar 05 16:37:54 2015 +0000
Revision:
3:a38ad504a18c
Parent:
2:3e7685cfb2a7
Child:
15:990a8b5664e1
Delete multi use functions and update mbed library - exporters for IAR now working again

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sam_grove 0:01fb291427ce 1 #include "mbed.h"
sam_grove 0:01fb291427ce 2
sam_grove 2:3e7685cfb2a7 3 #include "driverDebug.h"
sam_grove 2:3e7685cfb2a7 4 #include "socket_api.h"
sam_grove 2:3e7685cfb2a7 5 #include "net_interface.h"
sam_grove 2:3e7685cfb2a7 6 #include "system_event.h"
sam_grove 2:3e7685cfb2a7 7 #include "string.h"
sam_grove 2:3e7685cfb2a7 8 #include "net_nwk_scan.h"
sam_grove 2:3e7685cfb2a7 9 #include "socket_security.h"
sam_grove 2:3e7685cfb2a7 10 #include "nwk_stats_api.h"
sam_grove 2:3e7685cfb2a7 11 #include "multicast_api.h"
sam_grove 2:3e7685cfb2a7 12 #include "nsdynmemLIB.h"
sam_grove 2:3e7685cfb2a7 13 #include "randLIB.h"
sam_grove 2:3e7685cfb2a7 14 #include "arm_hal_timer.h"
sam_grove 2:3e7685cfb2a7 15 #include "common_functions.h"
sam_grove 2:3e7685cfb2a7 16 #include "driverRFPhy.h"
sam_grove 2:3e7685cfb2a7 17 #include "driverAtmelRFInterface.h"
sam_grove 2:3e7685cfb2a7 18 #include "nsdl_support.h"
sam_grove 2:3e7685cfb2a7 19 #include "node_cfg.h"
sam_grove 2:3e7685cfb2a7 20
sam_grove 2:3e7685cfb2a7 21 /*** DEBUG ******/
sam_grove 2:3e7685cfb2a7 22 #define DEBUG 1
sam_grove 2:3e7685cfb2a7 23 #if DEBUG
sam_grove 2:3e7685cfb2a7 24 #define debug printf
sam_grove 2:3e7685cfb2a7 25 #else
sam_grove 2:3e7685cfb2a7 26 #define debug(...) ""
sam_grove 2:3e7685cfb2a7 27 #endif // DEBUG
sam_grove 2:3e7685cfb2a7 28
sam_grove 2:3e7685cfb2a7 29 /******* Hardware Definition **********/
sam_grove 2:3e7685cfb2a7 30 #if NODE_CONTROLLER
sam_grove 2:3e7685cfb2a7 31 DigitalOut ledR(PTB22); // RGB - Red LED
sam_grove 2:3e7685cfb2a7 32 DigitalOut ledG(PTE26); // RGB - Green LED
sam_grove 2:3e7685cfb2a7 33 DigitalOut ledB(PTB21); // RGB - Blue LED
sam_grove 2:3e7685cfb2a7 34 InterruptIn TAP_INT(PTC6); // INT1 from FXOS8700Q
sam_grove 2:3e7685cfb2a7 35 #endif
sam_grove 2:3e7685cfb2a7 36
sam_grove 2:3e7685cfb2a7 37 /******* Timers Definitions ************/
sam_grove 2:3e7685cfb2a7 38 #define RETRY_TIMER 1
sam_grove 2:3e7685cfb2a7 39 #define NSP_REGISTRATION_TIMER 2
sam_grove 2:3e7685cfb2a7 40 #if NODE_CONTROLLER
sam_grove 2:3e7685cfb2a7 41 #define ACCELEROMETER_TIMER 3
sam_grove 2:3e7685cfb2a7 42 #endif
sam_grove 2:3e7685cfb2a7 43 #if NODE_HOME
sam_grove 2:3e7685cfb2a7 44 #define DOOR_CHECK_TIMER 4
sam_grove 2:3e7685cfb2a7 45 #endif
sam_grove 2:3e7685cfb2a7 46
sam_grove 2:3e7685cfb2a7 47 void app_heap_error_handler(heap_fail_t event);
sam_grove 2:3e7685cfb2a7 48 void tasklet_main(arm_event_s *event);
sam_grove 2:3e7685cfb2a7 49 void button_main(arm_event_s *event);
sam_grove 2:3e7685cfb2a7 50
sam_grove 2:3e7685cfb2a7 51 #define APP_DEV_HEAP_SIZE 6000
sam_grove 2:3e7685cfb2a7 52 static uint8_t app_defined_stack_heap[APP_DEV_HEAP_SIZE];
sam_grove 2:3e7685cfb2a7 53 static int8_t main_tasklet_id = -1;
sam_grove 2:3e7685cfb2a7 54
sam_grove 2:3e7685cfb2a7 55 static const uint8_t app_MAC_address[8] = NODE_MAC_ADDRESS;
sam_grove 2:3e7685cfb2a7 56 static int8_t rf_phy_device_register_id = -1;
sam_grove 2:3e7685cfb2a7 57 static int8_t net_6lowpan_id = -1;
sam_grove 2:3e7685cfb2a7 58 static uint32_t channel_list = 0x07FFF800; // All channels
sam_grove 2:3e7685cfb2a7 59
sam_grove 2:3e7685cfb2a7 60 int8_t coap_udp_socket = -1;
sam_grove 2:3e7685cfb2a7 61
sam_grove 3:a38ad504a18c 62 #define AUDP_SOCKET_PORT 61630
sam_grove 2:3e7685cfb2a7 63 #define RECV_CTRL_UDP_PORT 1050 // receive
sam_grove 2:3e7685cfb2a7 64 #define SEND_CTRL_UDP_PORT 1060 // send
sam_grove 2:3e7685cfb2a7 65
sam_grove 2:3e7685cfb2a7 66 /** Used for Receive Data source Address store*/
sam_grove 3:a38ad504a18c 67 static ns_address_t app_src;
sam_grove 2:3e7685cfb2a7 68 static sn_nsdl_addr_s sn_addr_s;
sam_grove 2:3e7685cfb2a7 69
sam_grove 2:3e7685cfb2a7 70 static int access_point_status = 0;
sam_grove 2:3e7685cfb2a7 71
sam_grove 2:3e7685cfb2a7 72 link_layer_setups_s app_link_info;
sam_grove 2:3e7685cfb2a7 73 link_layer_address_s app_link_address_info;
sam_grove 2:3e7685cfb2a7 74 network_layer_address_s app_nd_address_info;
sam_grove 2:3e7685cfb2a7 75
sam_grove 2:3e7685cfb2a7 76 /* Prototype functions */
sam_grove 2:3e7685cfb2a7 77 void NSDL_receive_socket(void *cb);
sam_grove 2:3e7685cfb2a7 78 void NSP_registration(void);
sam_grove 2:3e7685cfb2a7 79
sam_grove 2:3e7685cfb2a7 80 extern void create_lqi_resource(uint8_t);
sam_grove 2:3e7685cfb2a7 81 void* own_alloc(uint16_t size);
sam_grove 2:3e7685cfb2a7 82 void own_free(void *ptr);
sam_grove 2:3e7685cfb2a7 83
sam_grove 2:3e7685cfb2a7 84 /*************** Application variables ***********************/
sam_grove 2:3e7685cfb2a7 85 uint8_t batteryLevel = 100;
sam_grove 2:3e7685cfb2a7 86 enum LED {NONE, RED, GREEN, BLUE};
sam_grove 2:3e7685cfb2a7 87 int ledState = NONE;
sam_grove 2:3e7685cfb2a7 88
sam_grove 2:3e7685cfb2a7 89
sam_grove 2:3e7685cfb2a7 90 /* #defines, definitions and declarations according node profile */
sam_grove 2:3e7685cfb2a7 91
sam_grove 2:3e7685cfb2a7 92 #if NODE_CONTROLLER
sam_grove 2:3e7685cfb2a7 93 int8_t ctrl_udp_socket = -1;
sam_grove 2:3e7685cfb2a7 94 void empty_udp_receive(void * cb);
sam_grove 2:3e7685cfb2a7 95 void ctrl_udp_send(uint8_t cmd);
sam_grove 2:3e7685cfb2a7 96
sam_grove 2:3e7685cfb2a7 97 #include "FXOS8700Q_TD.h"
sam_grove 2:3e7685cfb2a7 98
sam_grove 2:3e7685cfb2a7 99 #define ACCEL_SAMPLE_TIME 200
sam_grove 2:3e7685cfb2a7 100 FXOS8700Q accel( PTE25, PTE24, FXOS8700CQ_SLAVE_ADDR1); // Proper Ports and I2C Address for K64F Freedom board
sam_grove 2:3e7685cfb2a7 101 bool accel_enable = 1;
sam_grove 2:3e7685cfb2a7 102
sam_grove 2:3e7685cfb2a7 103 void tap_detector_handler(void) {
sam_grove 2:3e7685cfb2a7 104 printf("Tap Detected!\r\n");
sam_grove 2:3e7685cfb2a7 105
sam_grove 2:3e7685cfb2a7 106 switch(ledState) {
sam_grove 2:3e7685cfb2a7 107 case NONE:
sam_grove 2:3e7685cfb2a7 108 break;
sam_grove 2:3e7685cfb2a7 109 case RED:
sam_grove 2:3e7685cfb2a7 110 ctrl_udp_send('R');
sam_grove 2:3e7685cfb2a7 111 break;
sam_grove 2:3e7685cfb2a7 112 case GREEN:
sam_grove 2:3e7685cfb2a7 113 ctrl_udp_send('G');
sam_grove 2:3e7685cfb2a7 114 break;
sam_grove 2:3e7685cfb2a7 115 case BLUE:
sam_grove 2:3e7685cfb2a7 116 ctrl_udp_send('B');
sam_grove 2:3e7685cfb2a7 117 break;
sam_grove 2:3e7685cfb2a7 118 }
sam_grove 2:3e7685cfb2a7 119 }
sam_grove 2:3e7685cfb2a7 120
sam_grove 2:3e7685cfb2a7 121 void update_LED(void) {
sam_grove 2:3e7685cfb2a7 122
sam_grove 2:3e7685cfb2a7 123 switch(ledState) {
sam_grove 2:3e7685cfb2a7 124 case NONE:
sam_grove 2:3e7685cfb2a7 125 ledState = GREEN;
sam_grove 2:3e7685cfb2a7 126 ledR = 1;
sam_grove 2:3e7685cfb2a7 127 ledG = 0;
sam_grove 2:3e7685cfb2a7 128 ledB = 1;
sam_grove 2:3e7685cfb2a7 129 break;
sam_grove 2:3e7685cfb2a7 130
sam_grove 2:3e7685cfb2a7 131 case GREEN:
sam_grove 2:3e7685cfb2a7 132 ledState = RED;
sam_grove 2:3e7685cfb2a7 133 ledR = 0;
sam_grove 2:3e7685cfb2a7 134 ledG = 1;
sam_grove 2:3e7685cfb2a7 135 ledB = 1;
sam_grove 2:3e7685cfb2a7 136 break;
sam_grove 2:3e7685cfb2a7 137
sam_grove 2:3e7685cfb2a7 138 case RED:
sam_grove 2:3e7685cfb2a7 139 ledState = BLUE;
sam_grove 2:3e7685cfb2a7 140 ledR = 1;
sam_grove 2:3e7685cfb2a7 141 ledG = 1;
sam_grove 2:3e7685cfb2a7 142 ledB = 0;
sam_grove 2:3e7685cfb2a7 143 break;
sam_grove 2:3e7685cfb2a7 144
sam_grove 2:3e7685cfb2a7 145 case BLUE:
sam_grove 2:3e7685cfb2a7 146 ledState = NONE;
sam_grove 2:3e7685cfb2a7 147 ledR = 1;
sam_grove 2:3e7685cfb2a7 148 ledG = 1;
sam_grove 2:3e7685cfb2a7 149 ledB = 1;
sam_grove 2:3e7685cfb2a7 150 break;
sam_grove 2:3e7685cfb2a7 151 }
sam_grove 2:3e7685cfb2a7 152 }
sam_grove 2:3e7685cfb2a7 153
sam_grove 2:3e7685cfb2a7 154 #endif
sam_grove 0:01fb291427ce 155
sam_grove 2:3e7685cfb2a7 156 #if 1
sam_grove 2:3e7685cfb2a7 157 void printf_array(uint8_t *ptr , uint16_t len)
sam_grove 2:3e7685cfb2a7 158 {
sam_grove 2:3e7685cfb2a7 159 uint16_t i;
sam_grove 2:3e7685cfb2a7 160 for(i=0; i<len; i++)
sam_grove 2:3e7685cfb2a7 161 {
sam_grove 2:3e7685cfb2a7 162 if(i)
sam_grove 2:3e7685cfb2a7 163 {
sam_grove 2:3e7685cfb2a7 164 if(i%16== 0)
sam_grove 2:3e7685cfb2a7 165 {
sam_grove 2:3e7685cfb2a7 166 debug("\r\n");
sam_grove 2:3e7685cfb2a7 167 if(len > 64)
sam_grove 2:3e7685cfb2a7 168 {
sam_grove 2:3e7685cfb2a7 169 uint8_t x =254;
sam_grove 2:3e7685cfb2a7 170 while(x--);
sam_grove 2:3e7685cfb2a7 171 }
sam_grove 2:3e7685cfb2a7 172 }
sam_grove 2:3e7685cfb2a7 173 else
sam_grove 2:3e7685cfb2a7 174 {
sam_grove 2:3e7685cfb2a7 175 debug(":");
sam_grove 2:3e7685cfb2a7 176 }
sam_grove 2:3e7685cfb2a7 177 }
sam_grove 2:3e7685cfb2a7 178 debug_hex(*ptr++);
sam_grove 2:3e7685cfb2a7 179 }
sam_grove 2:3e7685cfb2a7 180 debug("\r\n");
sam_grove 2:3e7685cfb2a7 181 }
sam_grove 2:3e7685cfb2a7 182
sam_grove 2:3e7685cfb2a7 183
sam_grove 2:3e7685cfb2a7 184
sam_grove 2:3e7685cfb2a7 185 void debug_integer(uint8_t width, uint8_t base, int16_t n)
sam_grove 2:3e7685cfb2a7 186 {
sam_grove 2:3e7685cfb2a7 187 uint8_t bfr[8];
sam_grove 2:3e7685cfb2a7 188 uint8_t *ptr = bfr;
sam_grove 2:3e7685cfb2a7 189 uint8_t ctr = 0;
sam_grove 2:3e7685cfb2a7 190
sam_grove 2:3e7685cfb2a7 191 if (width > 7) width = 7;
sam_grove 2:3e7685cfb2a7 192
sam_grove 2:3e7685cfb2a7 193 ptr += width;
sam_grove 2:3e7685cfb2a7 194 *ptr-- = 0;
sam_grove 2:3e7685cfb2a7 195
sam_grove 2:3e7685cfb2a7 196 if (base == 16)
sam_grove 2:3e7685cfb2a7 197 {
sam_grove 2:3e7685cfb2a7 198 do
sam_grove 2:3e7685cfb2a7 199 {
sam_grove 2:3e7685cfb2a7 200 *ptr = n & 0x0F;
sam_grove 2:3e7685cfb2a7 201 if (*ptr < 10) *ptr += '0';
sam_grove 2:3e7685cfb2a7 202 else *ptr += ('A'-10);
sam_grove 2:3e7685cfb2a7 203 ptr--;
sam_grove 2:3e7685cfb2a7 204 n >>= 4;
sam_grove 2:3e7685cfb2a7 205 ctr++;
sam_grove 2:3e7685cfb2a7 206 }while((ctr & 1) || (ctr < width));
sam_grove 2:3e7685cfb2a7 207 }
sam_grove 2:3e7685cfb2a7 208 else
sam_grove 2:3e7685cfb2a7 209 {
sam_grove 2:3e7685cfb2a7 210 uint8_t negative = 0;
sam_grove 2:3e7685cfb2a7 211 if (n < 0)
sam_grove 2:3e7685cfb2a7 212 { negative = 1;
sam_grove 2:3e7685cfb2a7 213 n = -n;
sam_grove 2:3e7685cfb2a7 214 }
sam_grove 2:3e7685cfb2a7 215 ctr++;
sam_grove 2:3e7685cfb2a7 216 do
sam_grove 2:3e7685cfb2a7 217 {
sam_grove 2:3e7685cfb2a7 218 *ptr-- = (n % 10) + '0';
sam_grove 2:3e7685cfb2a7 219 n /= 10;
sam_grove 2:3e7685cfb2a7 220 ctr++;
sam_grove 2:3e7685cfb2a7 221 }while ((ctr < width) && n);
sam_grove 2:3e7685cfb2a7 222 if (negative)
sam_grove 2:3e7685cfb2a7 223 {
sam_grove 2:3e7685cfb2a7 224 *ptr-- = '-';
sam_grove 2:3e7685cfb2a7 225 }
sam_grove 2:3e7685cfb2a7 226 else
sam_grove 2:3e7685cfb2a7 227 {
sam_grove 2:3e7685cfb2a7 228 *ptr-- = ' ';
sam_grove 2:3e7685cfb2a7 229 }
sam_grove 2:3e7685cfb2a7 230 }
sam_grove 2:3e7685cfb2a7 231 ptr++;
sam_grove 2:3e7685cfb2a7 232 //debug_send(ptr);
sam_grove 2:3e7685cfb2a7 233 debug((const char *)ptr);
sam_grove 2:3e7685cfb2a7 234 }
sam_grove 2:3e7685cfb2a7 235
sam_grove 2:3e7685cfb2a7 236
sam_grove 2:3e7685cfb2a7 237 void printf_ipv6_address(uint8_t *addr_ptr)
sam_grove 0:01fb291427ce 238 {
sam_grove 2:3e7685cfb2a7 239 if(addr_ptr)
sam_grove 2:3e7685cfb2a7 240 {
sam_grove 2:3e7685cfb2a7 241 uint8_t i, d_colon = 0;
sam_grove 2:3e7685cfb2a7 242 uint16_t current_value = 0, last_value = 0;
sam_grove 2:3e7685cfb2a7 243
sam_grove 2:3e7685cfb2a7 244 for(i=0; i< 16;i += 2)
sam_grove 2:3e7685cfb2a7 245 {
sam_grove 2:3e7685cfb2a7 246 current_value = (*addr_ptr++ << 8);
sam_grove 2:3e7685cfb2a7 247 current_value += *addr_ptr++;
sam_grove 2:3e7685cfb2a7 248
sam_grove 2:3e7685cfb2a7 249 if(i == 0)
sam_grove 2:3e7685cfb2a7 250 {
sam_grove 2:3e7685cfb2a7 251 last_value = current_value;
sam_grove 2:3e7685cfb2a7 252 debug_hex(current_value >> 8);
sam_grove 2:3e7685cfb2a7 253 debug_hex(current_value );
sam_grove 2:3e7685cfb2a7 254 debug(":");
sam_grove 2:3e7685cfb2a7 255 }
sam_grove 2:3e7685cfb2a7 256 else
sam_grove 2:3e7685cfb2a7 257 {
sam_grove 2:3e7685cfb2a7 258 if(current_value == 0)
sam_grove 2:3e7685cfb2a7 259 {
sam_grove 2:3e7685cfb2a7 260 if(i== 14)
sam_grove 2:3e7685cfb2a7 261 {
sam_grove 2:3e7685cfb2a7 262 debug(":");
sam_grove 2:3e7685cfb2a7 263 //debug_put('0');
sam_grove 2:3e7685cfb2a7 264 debug("0");
sam_grove 2:3e7685cfb2a7 265 }
sam_grove 2:3e7685cfb2a7 266 else
sam_grove 2:3e7685cfb2a7 267 {
sam_grove 2:3e7685cfb2a7 268 if(last_value == 0)
sam_grove 2:3e7685cfb2a7 269 {
sam_grove 2:3e7685cfb2a7 270 if(d_colon == 0)
sam_grove 2:3e7685cfb2a7 271 {
sam_grove 2:3e7685cfb2a7 272 d_colon=1;
sam_grove 2:3e7685cfb2a7 273 }
sam_grove 2:3e7685cfb2a7 274 }
sam_grove 2:3e7685cfb2a7 275 else
sam_grove 2:3e7685cfb2a7 276 {
sam_grove 2:3e7685cfb2a7 277 if(d_colon == 2)
sam_grove 2:3e7685cfb2a7 278 {
sam_grove 2:3e7685cfb2a7 279 //debug_put('0');
sam_grove 2:3e7685cfb2a7 280 debug("0");
sam_grove 2:3e7685cfb2a7 281 debug(":");
sam_grove 2:3e7685cfb2a7 282 }
sam_grove 2:3e7685cfb2a7 283 }
sam_grove 2:3e7685cfb2a7 284 }
sam_grove 2:3e7685cfb2a7 285 }
sam_grove 2:3e7685cfb2a7 286 else
sam_grove 2:3e7685cfb2a7 287 {
sam_grove 2:3e7685cfb2a7 288 if(last_value == 0)
sam_grove 2:3e7685cfb2a7 289 {
sam_grove 2:3e7685cfb2a7 290 if(d_colon == 1)
sam_grove 2:3e7685cfb2a7 291 {
sam_grove 2:3e7685cfb2a7 292 debug(":");
sam_grove 2:3e7685cfb2a7 293 d_colon = 2;
sam_grove 2:3e7685cfb2a7 294 }
sam_grove 2:3e7685cfb2a7 295 else
sam_grove 2:3e7685cfb2a7 296 {
sam_grove 2:3e7685cfb2a7 297 //debug_put('0');
sam_grove 2:3e7685cfb2a7 298 debug("0");
sam_grove 2:3e7685cfb2a7 299 debug(":");
sam_grove 2:3e7685cfb2a7 300 }
sam_grove 2:3e7685cfb2a7 301 }
sam_grove 2:3e7685cfb2a7 302 if(current_value > 0x00ff)
sam_grove 2:3e7685cfb2a7 303 {
sam_grove 2:3e7685cfb2a7 304 debug_hex(current_value >> 8);
sam_grove 2:3e7685cfb2a7 305 }
sam_grove 2:3e7685cfb2a7 306 debug_hex(current_value );
sam_grove 2:3e7685cfb2a7 307 if(i< 14)
sam_grove 2:3e7685cfb2a7 308 {
sam_grove 2:3e7685cfb2a7 309 debug(":");
sam_grove 2:3e7685cfb2a7 310 }
sam_grove 2:3e7685cfb2a7 311 }
sam_grove 2:3e7685cfb2a7 312 last_value = current_value;
sam_grove 2:3e7685cfb2a7 313 }
sam_grove 2:3e7685cfb2a7 314 }
sam_grove 2:3e7685cfb2a7 315 }
sam_grove 2:3e7685cfb2a7 316 else
sam_grove 2:3e7685cfb2a7 317 {
sam_grove 2:3e7685cfb2a7 318 debug("Address Print: pointer NULL");
sam_grove 2:3e7685cfb2a7 319 }
sam_grove 2:3e7685cfb2a7 320 debug("\r\n");
sam_grove 2:3e7685cfb2a7 321 }
sam_grove 2:3e7685cfb2a7 322 #endif
sam_grove 2:3e7685cfb2a7 323
sam_grove 2:3e7685cfb2a7 324 int main()
sam_grove 2:3e7685cfb2a7 325 {
sam_grove 2:3e7685cfb2a7 326 #if NODE_CONTROLLER
sam_grove 2:3e7685cfb2a7 327 ledR = 1;
sam_grove 2:3e7685cfb2a7 328 ledG = 1;
sam_grove 2:3e7685cfb2a7 329 ledB = 1;
sam_grove 2:3e7685cfb2a7 330 TAP_INT.rise(&tap_detector_handler);
sam_grove 2:3e7685cfb2a7 331 #endif
sam_grove 2:3e7685cfb2a7 332
sam_grove 2:3e7685cfb2a7 333 debug("\r\nApplication Start\r\n");
sam_grove 2:3e7685cfb2a7 334 ns_dyn_mem_init(app_defined_stack_heap, APP_DEV_HEAP_SIZE, app_heap_error_handler,0);
sam_grove 2:3e7685cfb2a7 335 rf_set_mac_address(app_MAC_address);
sam_grove 2:3e7685cfb2a7 336
sam_grove 2:3e7685cfb2a7 337 // init RF interface
sam_grove 2:3e7685cfb2a7 338 debug("Init RF Interface...\r\n");
sam_grove 2:3e7685cfb2a7 339 rf_phy_device_register_id = rf_device_register();
sam_grove 2:3e7685cfb2a7 340 randLIB_seed_random();
sam_grove 0:01fb291427ce 341
sam_grove 2:3e7685cfb2a7 342 debug("Init ARM Timer...\r\n");
sam_grove 2:3e7685cfb2a7 343 arm_timer_init();//Init Timer
sam_grove 2:3e7685cfb2a7 344 //Init nanostack & Event OS
sam_grove 2:3e7685cfb2a7 345 debug("Init Net Core...\r\n");
sam_grove 2:3e7685cfb2a7 346 net_init_core();
sam_grove 2:3e7685cfb2a7 347 debug("Create Tasklets...\r\n");
sam_grove 2:3e7685cfb2a7 348 main_tasklet_id = arm_ns_tasklet_create(&tasklet_main);
sam_grove 2:3e7685cfb2a7 349 if(main_tasklet_id < 0)
sam_grove 2:3e7685cfb2a7 350 {
sam_grove 2:3e7685cfb2a7 351 //Tasklet cerate fail
sam_grove 2:3e7685cfb2a7 352 error("Tasklet create fail..");
sam_grove 2:3e7685cfb2a7 353 while(1);
sam_grove 2:3e7685cfb2a7 354 }
sam_grove 2:3e7685cfb2a7 355 debug("Event Dispatch\r\n");
sam_grove 2:3e7685cfb2a7 356 event_dispatch();
sam_grove 2:3e7685cfb2a7 357 }
sam_grove 2:3e7685cfb2a7 358
sam_grove 2:3e7685cfb2a7 359 /**
sam_grove 2:3e7685cfb2a7 360 * @brief This function handles Hard Fault exception.
sam_grove 2:3e7685cfb2a7 361 * @param None
sam_grove 2:3e7685cfb2a7 362 * @retval None
sam_grove 2:3e7685cfb2a7 363 */
sam_grove 2:3e7685cfb2a7 364 void HardFault_Handler(void)
sam_grove 2:3e7685cfb2a7 365 {
sam_grove 2:3e7685cfb2a7 366 /* Go to infinite loop when Hard Fault exception occurs */
sam_grove 2:3e7685cfb2a7 367 while (1)
sam_grove 2:3e7685cfb2a7 368 {
sam_grove 2:3e7685cfb2a7 369 }
sam_grove 2:3e7685cfb2a7 370 }
sam_grove 2:3e7685cfb2a7 371 void app_heap_error_handler(heap_fail_t event)
sam_grove 2:3e7685cfb2a7 372 {
sam_grove 2:3e7685cfb2a7 373 switch (event)
sam_grove 2:3e7685cfb2a7 374 {
sam_grove 2:3e7685cfb2a7 375 case NS_DYN_MEM_NULL_FREE:
sam_grove 2:3e7685cfb2a7 376 break;
sam_grove 2:3e7685cfb2a7 377 case NS_DYN_MEM_DOUBLE_FREE:
sam_grove 2:3e7685cfb2a7 378 break;
sam_grove 2:3e7685cfb2a7 379
sam_grove 2:3e7685cfb2a7 380 case NS_DYN_MEM_ALLOCATE_SIZE_NOT_VALID:
sam_grove 2:3e7685cfb2a7 381 break;
sam_grove 2:3e7685cfb2a7 382 case NS_DYN_MEM_POINTER_NOT_VALID:
sam_grove 2:3e7685cfb2a7 383 break;
sam_grove 2:3e7685cfb2a7 384
sam_grove 2:3e7685cfb2a7 385 case NS_DYN_MEM_HEAP_SECTOR_CORRUPTED:
sam_grove 2:3e7685cfb2a7 386 break;
sam_grove 2:3e7685cfb2a7 387
sam_grove 2:3e7685cfb2a7 388 case NS_DYN_MEM_HEAP_SECTOR_UNITIALIZED:
sam_grove 2:3e7685cfb2a7 389 break;
sam_grove 2:3e7685cfb2a7 390
sam_grove 2:3e7685cfb2a7 391 default:
sam_grove 2:3e7685cfb2a7 392
sam_grove 2:3e7685cfb2a7 393 break;
sam_grove 2:3e7685cfb2a7 394 }
sam_grove 2:3e7685cfb2a7 395 while(1);
sam_grove 2:3e7685cfb2a7 396 }
sam_grove 2:3e7685cfb2a7 397
sam_grove 2:3e7685cfb2a7 398
sam_grove 2:3e7685cfb2a7 399 /**
sam_grove 2:3e7685cfb2a7 400 * \brief Network state event handler.
sam_grove 2:3e7685cfb2a7 401 * \param event show network start response or current network state.
sam_grove 2:3e7685cfb2a7 402 *
sam_grove 2:3e7685cfb2a7 403 * - NET_READY: Save NVK peristant data to NVM and Net role
sam_grove 2:3e7685cfb2a7 404 * - NET_NO_BEACON: Link Layer Active Scan Fail, Stack is Already at Idle state
sam_grove 2:3e7685cfb2a7 405 * - NET_NO_ND_ROUTER: No ND Router at current Channel Stack is Already at Idle state
sam_grove 2:3e7685cfb2a7 406 * - NET_BORDER_ROUTER_LOST: Connection to Access point is lost wait for Scan Result
sam_grove 2:3e7685cfb2a7 407 * - NET_PARENT_POLL_FAIL: Host should run net start without any PAN-id filter and all channels
sam_grove 2:3e7685cfb2a7 408 * - NET_PANA_SERVER_AUTH_FAIL: Pana Authentication fail, Stack is Already at Idle state
sam_grove 2:3e7685cfb2a7 409 */
sam_grove 2:3e7685cfb2a7 410 void app_parse_network_event(arm_event_s *event )
sam_grove 2:3e7685cfb2a7 411 {
sam_grove 2:3e7685cfb2a7 412 arm_nwk_interface_status_type_e status = (arm_nwk_interface_status_type_e)event->event_data;
sam_grove 2:3e7685cfb2a7 413 switch (status)
sam_grove 2:3e7685cfb2a7 414 {
sam_grove 2:3e7685cfb2a7 415 case ARM_NWK_BOOTSTRAP_READY:
sam_grove 2:3e7685cfb2a7 416 /* NEtwork is ready and node is connected to Access Point */
sam_grove 2:3e7685cfb2a7 417 if(access_point_status==0)
sam_grove 2:3e7685cfb2a7 418 {
sam_grove 2:3e7685cfb2a7 419 uint8_t temp_ipv6[16];
sam_grove 2:3e7685cfb2a7 420 debug("Network Connection Ready\r\n");
sam_grove 2:3e7685cfb2a7 421 access_point_status=1;
sam_grove 2:3e7685cfb2a7 422 //Read Address
sam_grove 2:3e7685cfb2a7 423
sam_grove 2:3e7685cfb2a7 424 if( arm_nwk_nd_address_read(net_6lowpan_id,&app_nd_address_info) != 0)
sam_grove 2:3e7685cfb2a7 425 {
sam_grove 2:3e7685cfb2a7 426 debug("ND Address read fail\r\n");
sam_grove 2:3e7685cfb2a7 427 }
sam_grove 2:3e7685cfb2a7 428 else
sam_grove 2:3e7685cfb2a7 429 {
sam_grove 2:3e7685cfb2a7 430 debug("ND Access Point: ");
sam_grove 2:3e7685cfb2a7 431 printf_ipv6_address(app_nd_address_info.border_router); //REVIEW
sam_grove 2:3e7685cfb2a7 432
sam_grove 2:3e7685cfb2a7 433 debug("ND Prefix 64: ");
sam_grove 2:3e7685cfb2a7 434 printf_array(app_nd_address_info.prefix, 8); //REVIEW
sam_grove 2:3e7685cfb2a7 435
sam_grove 2:3e7685cfb2a7 436 if(arm_net_address_get(net_6lowpan_id,ADDR_IPV6_GP,temp_ipv6) == 0)
sam_grove 2:3e7685cfb2a7 437 {
sam_grove 2:3e7685cfb2a7 438 debug("GP IPv6: ");
sam_grove 2:3e7685cfb2a7 439 printf_ipv6_address(temp_ipv6); //REVIEW
sam_grove 2:3e7685cfb2a7 440 }
sam_grove 2:3e7685cfb2a7 441 }
sam_grove 2:3e7685cfb2a7 442
sam_grove 2:3e7685cfb2a7 443 if( arm_nwk_mac_address_read(net_6lowpan_id,&app_link_address_info) != 0)
sam_grove 2:3e7685cfb2a7 444 {
sam_grove 2:3e7685cfb2a7 445 debug("MAC Address read fail\r\n");
sam_grove 2:3e7685cfb2a7 446 }
sam_grove 2:3e7685cfb2a7 447 else
sam_grove 2:3e7685cfb2a7 448 {
sam_grove 2:3e7685cfb2a7 449 uint8_t temp[2];
sam_grove 2:3e7685cfb2a7 450 common_write_16_bit(app_link_address_info.mac_short,temp);
sam_grove 2:3e7685cfb2a7 451 debug("MAC 16-bit: ");
sam_grove 2:3e7685cfb2a7 452 printf_array(temp, 2); //REVIEW
sam_grove 2:3e7685cfb2a7 453 common_write_16_bit(app_link_address_info.PANId,temp);
sam_grove 2:3e7685cfb2a7 454 debug("PAN-ID: ");
sam_grove 2:3e7685cfb2a7 455 printf_array(temp, 2); //REVIEW
sam_grove 2:3e7685cfb2a7 456 debug("MAC 64-bit: ");
sam_grove 2:3e7685cfb2a7 457 printf_array(app_link_address_info.long_euid64, 8); //REVIEW
sam_grove 2:3e7685cfb2a7 458 debug("EUID64(Based on MAC 64-bit address): ");
sam_grove 2:3e7685cfb2a7 459 printf_array(app_link_address_info.euid64, 8); //REVIEW
sam_grove 2:3e7685cfb2a7 460 }
sam_grove 2:3e7685cfb2a7 461 }
sam_grove 2:3e7685cfb2a7 462 break;
sam_grove 2:3e7685cfb2a7 463
sam_grove 2:3e7685cfb2a7 464 case ARM_NWK_NWK_SCAN_FAIL:
sam_grove 2:3e7685cfb2a7 465 /* Link Layer Active Scan Fail, Stack is Already at Idle state */
sam_grove 2:3e7685cfb2a7 466 debug("Link Layer Scan Fail: No Beacons\r\n");
sam_grove 2:3e7685cfb2a7 467 access_point_status=0;
sam_grove 2:3e7685cfb2a7 468 //dnssd_disable(1);
sam_grove 2:3e7685cfb2a7 469 break;
sam_grove 2:3e7685cfb2a7 470
sam_grove 2:3e7685cfb2a7 471 case ARM_NWK_IP_ADDRESS_ALLOCATION_FAIL:
sam_grove 2:3e7685cfb2a7 472 /* No ND Router at current Channel Stack is Already at Idle state */
sam_grove 2:3e7685cfb2a7 473 debug("ND Scan/ GP REG fail\r\n");
sam_grove 2:3e7685cfb2a7 474 access_point_status=0;
sam_grove 2:3e7685cfb2a7 475 //dnssd_disable(1);
sam_grove 2:3e7685cfb2a7 476 break;
sam_grove 2:3e7685cfb2a7 477
sam_grove 2:3e7685cfb2a7 478 case ARM_NWK_NWK_CONNECTION_DOWN:
sam_grove 2:3e7685cfb2a7 479 /* Connection to Access point is lost wait for Scan Result */
sam_grove 2:3e7685cfb2a7 480 debug("ND/RPL scan new network\r\n");
sam_grove 2:3e7685cfb2a7 481 access_point_status=0;
sam_grove 2:3e7685cfb2a7 482 break;
sam_grove 2:3e7685cfb2a7 483
sam_grove 2:3e7685cfb2a7 484 case ARM_NWK_NWK_PARENT_POLL_FAIL:
sam_grove 2:3e7685cfb2a7 485 access_point_status=0;
sam_grove 2:3e7685cfb2a7 486 break;
sam_grove 2:3e7685cfb2a7 487
sam_grove 2:3e7685cfb2a7 488 case ARM_NWK_AUHTENTICATION_FAIL:
sam_grove 2:3e7685cfb2a7 489 debug("Network authentication fail\r\n");
sam_grove 2:3e7685cfb2a7 490 access_point_status=0;
sam_grove 2:3e7685cfb2a7 491 break;
sam_grove 2:3e7685cfb2a7 492
sam_grove 2:3e7685cfb2a7 493 default:
sam_grove 2:3e7685cfb2a7 494 debug_hex(status); //REVIEW
sam_grove 2:3e7685cfb2a7 495 debug("Unknow event");
sam_grove 2:3e7685cfb2a7 496 break;
sam_grove 2:3e7685cfb2a7 497 }
sam_grove 2:3e7685cfb2a7 498
sam_grove 2:3e7685cfb2a7 499 if(access_point_status == 0)
sam_grove 2:3e7685cfb2a7 500 {
sam_grove 2:3e7685cfb2a7 501 //Set Timer for new Trig
sam_grove 2:3e7685cfb2a7 502 timer_sys_event(RETRY_TIMER, 10000);
sam_grove 2:3e7685cfb2a7 503 }
sam_grove 2:3e7685cfb2a7 504 }
sam_grove 2:3e7685cfb2a7 505
sam_grove 2:3e7685cfb2a7 506
sam_grove 2:3e7685cfb2a7 507 /**
sam_grove 2:3e7685cfb2a7 508 * \brief Handler for events sent to the application.
sam_grove 2:3e7685cfb2a7 509 * \param event received event.
sam_grove 2:3e7685cfb2a7 510 *
sam_grove 2:3e7685cfb2a7 511 * - EV_NETWORK event, Network Event state event handler
sam_grove 2:3e7685cfb2a7 512 * - EV_INIT, Set Certificate Chain list, init multicast, Start net start if NVM have session
sam_grove 2:3e7685cfb2a7 513 * - EV_DEBUG, Terminal handler
sam_grove 2:3e7685cfb2a7 514 */
sam_grove 2:3e7685cfb2a7 515 void tasklet_main(arm_event_s *event)
sam_grove 2:3e7685cfb2a7 516 {
sam_grove 2:3e7685cfb2a7 517 if(event->sender == 0)
sam_grove 2:3e7685cfb2a7 518 {
sam_grove 2:3e7685cfb2a7 519 arm_library_event_type_e event_type;
sam_grove 2:3e7685cfb2a7 520 event_type = (arm_library_event_type_e)event->event_type;
sam_grove 2:3e7685cfb2a7 521
sam_grove 2:3e7685cfb2a7 522 switch(event_type)
sam_grove 2:3e7685cfb2a7 523 {
sam_grove 2:3e7685cfb2a7 524 case ARM_LIB_NWK_INTERFACE_EVENT:
sam_grove 2:3e7685cfb2a7 525 /* Network Event state event handler */
sam_grove 2:3e7685cfb2a7 526 debug("Event: ARM_LIB_NWK_INTERFACE\r\n");
sam_grove 2:3e7685cfb2a7 527 app_parse_network_event(event);
sam_grove 2:3e7685cfb2a7 528 break;
sam_grove 2:3e7685cfb2a7 529
sam_grove 2:3e7685cfb2a7 530 case ARM_LIB_TASKLET_INIT_EVENT:
sam_grove 2:3e7685cfb2a7 531 /*Init event from stack at start-up*/
sam_grove 2:3e7685cfb2a7 532 debug("Event: ARM_LIB_TASKLET_INIT\r\n");
sam_grove 2:3e7685cfb2a7 533 #if NODE_CONTROLLER
sam_grove 2:3e7685cfb2a7 534 timer_sys_event(ACCELEROMETER_TIMER, ACCEL_SAMPLE_TIME);
sam_grove 2:3e7685cfb2a7 535 #endif
sam_grove 2:3e7685cfb2a7 536 multicast_set_parameters(10,0,20,3,75 );
sam_grove 2:3e7685cfb2a7 537
sam_grove 2:3e7685cfb2a7 538 #if NODE_CONTROLLER
sam_grove 2:3e7685cfb2a7 539 /* open a socket to support control for REMOTE_NODE */
sam_grove 2:3e7685cfb2a7 540 ctrl_udp_socket = socket_open(SOCKET_UDP, SEND_CTRL_UDP_PORT, empty_udp_receive);
sam_grove 2:3e7685cfb2a7 541 #endif
sam_grove 2:3e7685cfb2a7 542
sam_grove 2:3e7685cfb2a7 543 net_6lowpan_id = arm_nwk_interface_init(NET_INTERFACE_RF_6LOWPAN, rf_phy_device_register_id, "6LoWPAN_BORDER_ROUTER");
sam_grove 2:3e7685cfb2a7 544 if(net_6lowpan_id < 0)
sam_grove 2:3e7685cfb2a7 545 {
sam_grove 2:3e7685cfb2a7 546 debug("Interface Generate Fail\r\n");
sam_grove 2:3e7685cfb2a7 547 while(1);
sam_grove 2:3e7685cfb2a7 548 }
sam_grove 2:3e7685cfb2a7 549 else
sam_grove 2:3e7685cfb2a7 550 {
sam_grove 2:3e7685cfb2a7 551 //SET Bootsrap
sam_grove 2:3e7685cfb2a7 552 if(arm_nwk_interface_configure_6lowpan_bootstrap_set(net_6lowpan_id, NET_6LOWPAN_HOST, 1) != 0) // Last parameter enables MLE protocol
sam_grove 2:3e7685cfb2a7 553 {
sam_grove 2:3e7685cfb2a7 554 //Bootsrap SET fail
sam_grove 2:3e7685cfb2a7 555 debug("Bootstrap Fail\r\n");
sam_grove 2:3e7685cfb2a7 556 while(1);
sam_grove 2:3e7685cfb2a7 557 }
sam_grove 2:3e7685cfb2a7 558 else
sam_grove 2:3e7685cfb2a7 559 {
sam_grove 2:3e7685cfb2a7 560 int8_t retval = -1;
sam_grove 2:3e7685cfb2a7 561 arm_nwk_6lowpan_gp_address_mode(net_6lowpan_id, NET_6LOWPAN_GP16_ADDRESS, NODE_SHORT_ADDRESS, 1); // 5 = short address for link-layer // 1 = generate automatically if duplicate address is encountered
sam_grove 2:3e7685cfb2a7 562 arm_nwk_link_layer_security_mode(net_6lowpan_id, NET_SEC_MODE_NO_LINK_SECURITY, 0, 0);
sam_grove 2:3e7685cfb2a7 563 arm_nwk_6lowpan_link_scan_paramameter_set(rf_phy_device_register_id, channel_list, 5);
sam_grove 2:3e7685cfb2a7 564 retval = arm_nwk_interface_up(net_6lowpan_id);
sam_grove 2:3e7685cfb2a7 565 if(retval != 0)
sam_grove 2:3e7685cfb2a7 566 {
sam_grove 2:3e7685cfb2a7 567 //6Lowpan Bootsrap start fail
sam_grove 2:3e7685cfb2a7 568 debug("6LowPAN Bootstrap start Fail\r\n");
sam_grove 2:3e7685cfb2a7 569 while(1);
sam_grove 2:3e7685cfb2a7 570 }
sam_grove 2:3e7685cfb2a7 571 else
sam_grove 2:3e7685cfb2a7 572 {
sam_grove 2:3e7685cfb2a7 573 //6Lowpan Bootsrap start OK
sam_grove 2:3e7685cfb2a7 574 debug("6LowPAN Bootstrap Start OK\r\n");
sam_grove 2:3e7685cfb2a7 575 }
sam_grove 2:3e7685cfb2a7 576 // open sockets
sam_grove 2:3e7685cfb2a7 577 coap_udp_socket = socket_open(SOCKET_UDP, AUDP_SOCKET_PORT, NSDL_receive_socket);
sam_grove 2:3e7685cfb2a7 578 // Start NSDL
sam_grove 2:3e7685cfb2a7 579 nsdl_run();
sam_grove 2:3e7685cfb2a7 580 }
sam_grove 2:3e7685cfb2a7 581 timer_sys_event(NSP_REGISTRATION_TIMER, RD_UPDATE_PERIOD);
sam_grove 0:01fb291427ce 582 }
sam_grove 2:3e7685cfb2a7 583 break;
sam_grove 2:3e7685cfb2a7 584
sam_grove 2:3e7685cfb2a7 585 case ARM_LIB_SYSTEM_TIMER_EVENT:
sam_grove 2:3e7685cfb2a7 586 timer_sys_event_cancel(event->event_id);
sam_grove 2:3e7685cfb2a7 587 if (event->event_id == NSP_REGISTRATION_TIMER)
sam_grove 2:3e7685cfb2a7 588 {
sam_grove 2:3e7685cfb2a7 589 printf("Time to register...\r\n");
sam_grove 2:3e7685cfb2a7 590 NSP_registration();
sam_grove 2:3e7685cfb2a7 591 #if BATTERY
sam_grove 2:3e7685cfb2a7 592 batteryLevel -= 10;
sam_grove 2:3e7685cfb2a7 593 if (batteryLevel == 0)
sam_grove 2:3e7685cfb2a7 594 batteryLevel = 100;
sam_grove 2:3e7685cfb2a7 595 #endif
sam_grove 2:3e7685cfb2a7 596 timer_sys_event(NSP_REGISTRATION_TIMER, RD_UPDATE_PERIOD);
sam_grove 2:3e7685cfb2a7 597 }
sam_grove 2:3e7685cfb2a7 598 else if (event->event_id == RETRY_TIMER)
sam_grove 2:3e7685cfb2a7 599 {
sam_grove 2:3e7685cfb2a7 600 debug("Event: ARM_LIB_SYSTEM_TIMER (event_id = 1)\r\n");
sam_grove 2:3e7685cfb2a7 601 int8_t retval = -1;
sam_grove 2:3e7685cfb2a7 602 retval = arm_nwk_interface_up(net_6lowpan_id);
sam_grove 2:3e7685cfb2a7 603 if(retval != 0)
sam_grove 2:3e7685cfb2a7 604 {
sam_grove 2:3e7685cfb2a7 605 //6Lowpan Bootsrap start fail
sam_grove 2:3e7685cfb2a7 606 debug("6LowPAN Bootstrap Start Failure\r\n");
sam_grove 2:3e7685cfb2a7 607 while(1);
sam_grove 2:3e7685cfb2a7 608 }
sam_grove 2:3e7685cfb2a7 609 else
sam_grove 2:3e7685cfb2a7 610 {
sam_grove 2:3e7685cfb2a7 611 //6Lowpan Bootsrap start OK
sam_grove 2:3e7685cfb2a7 612 debug("6LowPAN Bootstrap Start OK\r\n");
sam_grove 2:3e7685cfb2a7 613 }
sam_grove 2:3e7685cfb2a7 614 }
sam_grove 2:3e7685cfb2a7 615 #if NODE_CONTROLLER
sam_grove 2:3e7685cfb2a7 616 else if (event->event_id == ACCELEROMETER_TIMER)
sam_grove 2:3e7685cfb2a7 617 {
sam_grove 2:3e7685cfb2a7 618 if (accel.getAccX() < -0.85f && accel_enable)
sam_grove 2:3e7685cfb2a7 619 {
sam_grove 2:3e7685cfb2a7 620 accel_enable = 0;
sam_grove 2:3e7685cfb2a7 621 update_LED();
sam_grove 2:3e7685cfb2a7 622 }
sam_grove 2:3e7685cfb2a7 623 if (accel.getAccX() > -0.35f)
sam_grove 2:3e7685cfb2a7 624 accel_enable = 1;
sam_grove 2:3e7685cfb2a7 625
sam_grove 2:3e7685cfb2a7 626 timer_sys_event(ACCELEROMETER_TIMER, ACCEL_SAMPLE_TIME);
sam_grove 2:3e7685cfb2a7 627 }
sam_grove 2:3e7685cfb2a7 628 #endif
sam_grove 3:a38ad504a18c 629
sam_grove 2:3e7685cfb2a7 630 break;
sam_grove 2:3e7685cfb2a7 631
sam_grove 2:3e7685cfb2a7 632 default:
sam_grove 2:3e7685cfb2a7 633 break;
sam_grove 2:3e7685cfb2a7 634 }
sam_grove 2:3e7685cfb2a7 635 }
sam_grove 2:3e7685cfb2a7 636 }
sam_grove 2:3e7685cfb2a7 637
sam_grove 2:3e7685cfb2a7 638 void NSDL_receive_socket(void * cb)
sam_grove 2:3e7685cfb2a7 639 {
sam_grove 2:3e7685cfb2a7 640 socket_callback_t * cb_res =0;
sam_grove 2:3e7685cfb2a7 641 int16_t length;
sam_grove 2:3e7685cfb2a7 642 cb_res = (socket_callback_t *) cb;
sam_grove 2:3e7685cfb2a7 643 uint8_t *payload;
sam_grove 2:3e7685cfb2a7 644
sam_grove 2:3e7685cfb2a7 645 if(cb_res->event_type == SOCKET_DATA)
sam_grove 2:3e7685cfb2a7 646 {
sam_grove 2:3e7685cfb2a7 647 debug("LINK LQI:");
sam_grove 2:3e7685cfb2a7 648 debug_hex(cb_res->LINK_LQI);
sam_grove 2:3e7685cfb2a7 649 create_lqi_resource(cb_res->LINK_LQI);
sam_grove 2:3e7685cfb2a7 650 debug("\r\n");
sam_grove 2:3e7685cfb2a7 651
sam_grove 2:3e7685cfb2a7 652 if ( cb_res->d_len > 0)
sam_grove 2:3e7685cfb2a7 653 {
sam_grove 2:3e7685cfb2a7 654 payload = (uint8_t *) own_alloc(cb_res->d_len);
sam_grove 2:3e7685cfb2a7 655 if(payload)
sam_grove 2:3e7685cfb2a7 656 {
sam_grove 2:3e7685cfb2a7 657 //Read data to the RX buffer
sam_grove 2:3e7685cfb2a7 658 length = socket_read(cb_res->socket_id, &app_src, payload, cb_res->d_len); //replace rx_buffer payload
sam_grove 2:3e7685cfb2a7 659 if(length)
sam_grove 2:3e7685cfb2a7 660 {
sam_grove 2:3e7685cfb2a7 661 if(cb_res->socket_id == coap_udp_socket)
sam_grove 2:3e7685cfb2a7 662 {
sam_grove 2:3e7685cfb2a7 663 // Handles data received in UDP socket
sam_grove 2:3e7685cfb2a7 664 // Call application protocol parser.
sam_grove 2:3e7685cfb2a7 665 sn_addr_s.type = SN_NSDL_ADDRESS_TYPE_IPV6;
sam_grove 2:3e7685cfb2a7 666 sn_addr_s.addr_len = 16;
sam_grove 2:3e7685cfb2a7 667 sn_addr_s.port = app_src.identifier;
sam_grove 2:3e7685cfb2a7 668 sn_addr_s.addr_ptr = app_src.address;
sam_grove 2:3e7685cfb2a7 669 printf("Data 1\r\n");
sam_grove 2:3e7685cfb2a7 670 if(sn_nsdl_process_coap(payload, length, &sn_addr_s)) // 0= ok, -1=failure
sam_grove 2:3e7685cfb2a7 671 {
sam_grove 2:3e7685cfb2a7 672 debug("Error processing CoAP packet\r\n");
sam_grove 2:3e7685cfb2a7 673 }
sam_grove 2:3e7685cfb2a7 674 printf("Data 4\r\n");
sam_grove 2:3e7685cfb2a7 675 }
sam_grove 2:3e7685cfb2a7 676 }
sam_grove 2:3e7685cfb2a7 677 own_free(payload);
sam_grove 2:3e7685cfb2a7 678 }
sam_grove 2:3e7685cfb2a7 679 }
sam_grove 2:3e7685cfb2a7 680 }
sam_grove 2:3e7685cfb2a7 681 #if 1 // enabled for debug
sam_grove 2:3e7685cfb2a7 682 else if(cb_res->event_type == SOCKET_TX_DONE)
sam_grove 2:3e7685cfb2a7 683 {
sam_grove 2:3e7685cfb2a7 684 //debug("*");
sam_grove 2:3e7685cfb2a7 685 }
sam_grove 2:3e7685cfb2a7 686 else if(cb_res->event_type == SOCKET_NO_ROUTE)
sam_grove 2:3e7685cfb2a7 687 {
sam_grove 2:3e7685cfb2a7 688 debug("SOCKET_NO_ROUTE\r\n");
sam_grove 2:3e7685cfb2a7 689 }
sam_grove 2:3e7685cfb2a7 690 else if(cb_res->event_type == SOCKET_TX_FAIL)
sam_grove 2:3e7685cfb2a7 691 {
sam_grove 2:3e7685cfb2a7 692 debug("SOCKET_TX_FAIL\r\n");
sam_grove 2:3e7685cfb2a7 693 }
sam_grove 2:3e7685cfb2a7 694 #endif
sam_grove 2:3e7685cfb2a7 695 }
sam_grove 2:3e7685cfb2a7 696
sam_grove 2:3e7685cfb2a7 697 #if NODE_CONTROLLER
sam_grove 2:3e7685cfb2a7 698 void ctrl_udp_send(uint8_t cmd)
sam_grove 2:3e7685cfb2a7 699 {
sam_grove 2:3e7685cfb2a7 700 uint8_t * payload = 0;
sam_grove 2:3e7685cfb2a7 701 ns_address_t address;
sam_grove 2:3e7685cfb2a7 702 /*SET UDP echo Port*/
sam_grove 2:3e7685cfb2a7 703 address.identifier = RECV_CTRL_UDP_PORT;
sam_grove 2:3e7685cfb2a7 704
sam_grove 2:3e7685cfb2a7 705 uint8_t node_address[16] = REMOTE_NODE;
sam_grove 2:3e7685cfb2a7 706
sam_grove 2:3e7685cfb2a7 707 payload = (uint8_t *) ns_dyn_mem_alloc(1);
sam_grove 2:3e7685cfb2a7 708 if(payload)
sam_grove 2:3e7685cfb2a7 709 {
sam_grove 2:3e7685cfb2a7 710 uint8_t *ptr = payload;
sam_grove 2:3e7685cfb2a7 711
sam_grove 2:3e7685cfb2a7 712 memcpy(address.address,node_address,16);
sam_grove 2:3e7685cfb2a7 713 address.type = ADDRESS_IPV6;
sam_grove 2:3e7685cfb2a7 714 *ptr = cmd;
sam_grove 2:3e7685cfb2a7 715 if(socket_sendto(ctrl_udp_socket, &address, payload, (1)) != 0)
sam_grove 2:3e7685cfb2a7 716 {
sam_grove 2:3e7685cfb2a7 717 debug("Ctrl UDP Failed\r\n");
sam_grove 2:3e7685cfb2a7 718 }
sam_grove 2:3e7685cfb2a7 719 else
sam_grove 2:3e7685cfb2a7 720 {
sam_grove 2:3e7685cfb2a7 721 debug("Ctrl UDP Ok\r\n");
sam_grove 2:3e7685cfb2a7 722 }
sam_grove 2:3e7685cfb2a7 723 ns_dyn_mem_free(payload);
sam_grove 2:3e7685cfb2a7 724 }
sam_grove 2:3e7685cfb2a7 725 else
sam_grove 2:3e7685cfb2a7 726 {
sam_grove 2:3e7685cfb2a7 727 debug("No Heap for Ctrl UDP\r\n");
sam_grove 2:3e7685cfb2a7 728 }
sam_grove 2:3e7685cfb2a7 729 }
sam_grove 2:3e7685cfb2a7 730 // we don't expect to receive data
sam_grove 2:3e7685cfb2a7 731 void empty_udp_receive(void * cb) {
sam_grove 2:3e7685cfb2a7 732
sam_grove 2:3e7685cfb2a7 733 }
sam_grove 2:3e7685cfb2a7 734 #endif
sam_grove 2:3e7685cfb2a7 735