canuck lehead / MTDOT-UDKDemo_Senet

UDK + Shield

Dependencies:   DOGS102 ISL29011 MMA845x MPL3115A2 NCP5623B libmDot_1012-hotifx mbed-rtos mbed-src Senet_Packet X_NUCLEO_IKS01A1

Fork of MTDOT-EVBDemo_Senet by Dave Kjendal

main.cpp@18:856ebfac428b, 2016-08-24 (annotated)

Committer:
Shaun Nelson
Date:
Wed Aug 24 15:16:49 2016 -0400
Revision:
18:856ebfac428b
Parent:
17:162e42587b4d
Parent:
16:7b3cc3221db1
Child:
19:62f4a6bae943
Merge remote changes

Who changed what in which revision?

UserRevisionLine numberNew contents of line
falingtrea 0:bdd16076aaa5 1 /**
falingtrea 0:bdd16076aaa5 2 * @file main.cpp
falingtrea 0:bdd16076aaa5 3 * @brief Main application for mDot-EVB demo
falingtrea 0:bdd16076aaa5 4 * @author Tim Barr MultiTech Systems Inc.
falingtrea 3:68e974f5f532 5 * @version 1.03
falingtrea 0:bdd16076aaa5 6 * @see
falingtrea 0:bdd16076aaa5 7 *
falingtrea 0:bdd16076aaa5 8 * Copyright (c) 2015
falingtrea 0:bdd16076aaa5 9 *
falingtrea 0:bdd16076aaa5 10 * Licensed under the Apache License, Version 2.0 (the "License");
falingtrea 0:bdd16076aaa5 11 * you may not use this file except in compliance with the License.
falingtrea 0:bdd16076aaa5 12 * You may obtain a copy of the License at
falingtrea 0:bdd16076aaa5 13 *
falingtrea 0:bdd16076aaa5 14 * http://www.apache.org/licenses/LICENSE-2.0
falingtrea 0:bdd16076aaa5 15 *
falingtrea 0:bdd16076aaa5 16 * Unless required by applicable law or agreed to in writing, software
falingtrea 0:bdd16076aaa5 17 * distributed under the License is distributed on an "AS IS" BASIS,
falingtrea 0:bdd16076aaa5 18 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
falingtrea 0:bdd16076aaa5 19 * See the License for the specific language governing permissions and
falingtrea 0:bdd16076aaa5 20 * limitations under the License.
falingtrea 1:ac9595d0f0e7 21 *
falingtrea 1:ac9595d0f0e7 22 * 1.01 TAB 7/6/15 Removed NULL pointer from evbAmbientLight creation call.
falingtrea 2:75adc72aa6a0 23 *
falingtrea 3:68e974f5f532 24 * 1.02 TAB 7/8/15 Send logo to LCD before attempting connection to LoRa network. Added
falingtrea 2:75adc72aa6a0 25 * information on setting up for public LoRa network. Moved SW setup to
falingtrea 2:75adc72aa6a0 26 * beginning of main. Removed printf call from ISR functions. Added
falingtrea 2:75adc72aa6a0 27 * additional checks for exit_program.
falingtrea 3:68e974f5f532 28 *
falingtrea 3:68e974f5f532 29 * 1.03 TAB 7/15/15 Added threads for push button switch debounce.
falingtrea 3:68e974f5f532 30 *
falingtrea 0:bdd16076aaa5 31 */
falingtrea 0:bdd16076aaa5 32
falingtrea 0:bdd16076aaa5 33 #include "mbed.h"
Shaun Nelson 10:658720d51610 34 #include "senet_packet.h"
Shaun Nelson 10:658720d51610 35
Shaun Nelson 10:658720d51610 36 // EVB Sensors
Shaun Nelson 10:658720d51610 37 #ifdef MTDOT_EVB
Shaun Nelson 12:ad92bbb6312f 38
falingtrea 0:bdd16076aaa5 39 #include "MMA845x.h"
falingtrea 0:bdd16076aaa5 40 #include "MPL3115A2.h"
falingtrea 0:bdd16076aaa5 41 #include "ISL29011.h"
falingtrea 0:bdd16076aaa5 42 #include "NCP5623B.h"
falingtrea 0:bdd16076aaa5 43 #include "DOGS102.h"
falingtrea 0:bdd16076aaa5 44 #include "font_6x8.h"
falingtrea 0:bdd16076aaa5 45 #include "MultiTech_Logo.h"
Shaun Nelson 12:ad92bbb6312f 46
Shaun Nelson 17:162e42587b4d 47 // Added period delay
Shaun Nelson 17:162e42587b4d 48 #define PERIOD_DELAY 0
Shaun Nelson 14:07ff01da6bbf 49
Shaun Nelson 17:162e42587b4d 50 // Fast send period
Shaun Nelson 17:162e42587b4d 51 #define FAST_SEND_PERIOD pckt_time
Shaun Nelson 14:07ff01da6bbf 52
Shaun Nelson 17:162e42587b4d 53 // Send frame period
Shaun Nelson 17:162e42587b4d 54 #define SEND_PERIOD 100
Shaun Nelson 14:07ff01da6bbf 55
Shaun Nelson 10:658720d51610 56 #elif defined(MTDOT_UDK)
Shaun Nelson 12:ad92bbb6312f 57
Shaun Nelson 10:658720d51610 58 #include "x_nucleo_iks01a1.h"
Shaun Nelson 12:ad92bbb6312f 59
Shaun Nelson 17:162e42587b4d 60 // Added period delay
Shaun Nelson 17:162e42587b4d 61 #define PERIOD_DELAY 3000
Shaun Nelson 14:07ff01da6bbf 62
Shaun Nelson 17:162e42587b4d 63 // Fast send period
Shaun Nelson 17:162e42587b4d 64 #define FAST_SEND_PERIOD 1
Shaun Nelson 14:07ff01da6bbf 65
Shaun Nelson 17:162e42587b4d 66 // Send frame period
Shaun Nelson 17:162e42587b4d 67 #define SEND_PERIOD 12
Shaun Nelson 14:07ff01da6bbf 68
Shaun Nelson 14:07ff01da6bbf 69
Shaun Nelson 14:07ff01da6bbf 70
Shaun Nelson 10:658720d51610 71 #endif
Shaun Nelson 10:658720d51610 72
falingtrea 0:bdd16076aaa5 73 #include "mDot.h"
falingtrea 0:bdd16076aaa5 74 #include "rtos.h"
falingtrea 0:bdd16076aaa5 75 #include <string>
falingtrea 0:bdd16076aaa5 76 #include <vector>
falingtrea 0:bdd16076aaa5 77
Shaun Nelson 12:ad92bbb6312f 78 /*
Shaun Nelson 12:ad92bbb6312f 79 * Board sensor data
falingtrea 0:bdd16076aaa5 80 */
Shaun Nelson 10:658720d51610 81 struct BoardSensorData
Shaun Nelson 10:658720d51610 82 {
Shaun Nelson 10:658720d51610 83 float temperature;
Shaun Nelson 10:658720d51610 84 float pressure;
Shaun Nelson 10:658720d51610 85 int32_t accel_x;
Shaun Nelson 10:658720d51610 86 int32_t accel_y;
Shaun Nelson 10:658720d51610 87 int32_t accel_z;
Shaun Nelson 10:658720d51610 88
Shaun Nelson 10:658720d51610 89 inline void init()
Shaun Nelson 10:658720d51610 90 {
Shaun Nelson 10:658720d51610 91 temperature= 0;
Shaun Nelson 10:658720d51610 92 pressure = 0;
Shaun Nelson 10:658720d51610 93 accel_x = 0;
Shaun Nelson 10:658720d51610 94 accel_y = 0;
Shaun Nelson 10:658720d51610 95 accel_z = 0;
Shaun Nelson 10:658720d51610 96 }
Shaun Nelson 10:658720d51610 97
Shaun Nelson 10:658720d51610 98 BoardSensorData() { init(); }
Shaun Nelson 10:658720d51610 99 };
Shaun Nelson 10:658720d51610 100
shaunkrnelson 16:7b3cc3221db1 101 #ifdef MTDOT_EVB
falingtrea 0:bdd16076aaa5 102
Shaun Nelson 12:ad92bbb6312f 103 //DigitalIn mDot02(PA_2); // GPIO/UART_TX
Shaun Nelson 12:ad92bbb6312f 104 //DigitalOut mDot03(PA_3); // GPIO/UART_RX
Shaun Nelson 12:ad92bbb6312f 105 //DigitalIn mDot04(PA_6); // GPIO/SPI_MISO
Shaun Nelson 12:ad92bbb6312f 106 //DigitalIn mDot06(PA_8); // GPIO/I2C_SCL
Shaun Nelson 12:ad92bbb6312f 107 //DigitalIn mDot07(PC_9); // GPIO/I2C_SDA
falingtrea 0:bdd16076aaa5 108
Shaun Nelson 12:ad92bbb6312f 109 InterruptIn mDot08(PA_12); // GPIO/USB PB S1 on EVB
Shaun Nelson 12:ad92bbb6312f 110 InterruptIn mDot09(PA_11); // GPIO/USB PB S2 on EVB
Shaun Nelson 12:ad92bbb6312f 111
Shaun Nelson 12:ad92bbb6312f 112 //DigitalIn mDot11(PA_7); // GPIO/SPI_MOSI
falingtrea 0:bdd16076aaa5 113
Shaun Nelson 12:ad92bbb6312f 114 InterruptIn mDot12(PA_0); // GPIO/UART_CTS PRESSURE_INT2 on EVB
Shaun Nelson 12:ad92bbb6312f 115 DigitalOut mDot13(PC_13,1); // GPIO LCD_C/D
Shaun Nelson 12:ad92bbb6312f 116 InterruptIn mDot15(PC_1); // GPIO LIGHT_PROX_INT on EVB
Shaun Nelson 12:ad92bbb6312f 117 InterruptIn mDot16(PA_1); // GPIO/UART_RTS ACCEL_INT2 on EVB
Shaun Nelson 12:ad92bbb6312f 118 DigitalOut mDot17(PA_4,1); // GPIO/SPI_NCS LCD_CS on EVB
falingtrea 0:bdd16076aaa5 119
Shaun Nelson 12:ad92bbb6312f 120 //DigitalIn mDot18(PA_5); // GPIO/SPI_SCK
falingtrea 0:bdd16076aaa5 121
falingtrea 0:bdd16076aaa5 122 //DigitalInOut mDot19(PB_0,PIN_INPUT,PullNone,0); // GPIO PushPull LED Low=Red High=Green set MODE=INPUT to turn off
Shaun Nelson 12:ad92bbb6312f 123 AnalogIn mDot20(PB_1); // GPIO Current Sense Analog in on EVB
Shaun Nelson 12:ad92bbb6312f 124 Serial debugUART(PA_9, PA_10); // mDot debug UART
Shaun Nelson 12:ad92bbb6312f 125 //Serial mDotUART(PA_2, PA_3); // mDot external UART mDot02 and mDot03
Shaun Nelson 12:ad92bbb6312f 126 I2C mDoti2c(PC_9,PA_8); // mDot External I2C mDot6 and mDot7
falingtrea 0:bdd16076aaa5 127
Shaun Nelson 12:ad92bbb6312f 128 SPI mDotspi(PA_7,PA_6,PA_5); // mDot external SPI mDot11, mDot4, and mDot18
Shaun Nelson 10:658720d51610 129 #elif defined(MTDOT_UDK)
Shaun Nelson 10:658720d51610 130
Shaun Nelson 12:ad92bbb6312f 131 Serial debugUART(USBTX, USBRX); // mDot debug UART
Shaun Nelson 10:658720d51610 132
Shaun Nelson 10:658720d51610 133 #endif
falingtrea 0:bdd16076aaa5 134
Shaun Nelson 12:ad92bbb6312f 135 /*
Shaun Nelson 12:ad92bbb6312f 136 * LoRaWAN Configuration
falingtrea 2:75adc72aa6a0 137 */
Shaun Nelson 12:ad92bbb6312f 138 static uint8_t app_id[8] = {0x00,0x25,0x0C,0x00,0x00,0x01,0x00,0x01};
shaunkrnelson 16:7b3cc3221db1 139 static uint8_t app_key[16] = {0x00,0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,0x09,0x0A,0x0B,0x0C,0x0D,0x0E,0x0F};
Shaun Nelson 12:ad92bbb6312f 140 static std::vector<uint8_t> config_app_id(app_id,app_id+sizeof(app_id)/sizeof(uint8_t));
Shaun Nelson 12:ad92bbb6312f 141 static std::vector<uint8_t> config_app_key(app_key,app_key+sizeof(app_key)/sizeof(uint8_t));
Shaun Nelson 12:ad92bbb6312f 142 static uint8_t config_frequency_sub_band = 0;
Shaun Nelson 12:ad92bbb6312f 143 static bool config_adr_on = true;
falingtrea 0:bdd16076aaa5 144
Shaun Nelson 14:07ff01da6bbf 145 bool position_changed = true;
Shaun Nelson 14:07ff01da6bbf 146 uint32_t sample_period = 0;
Shaun Nelson 14:07ff01da6bbf 147
Shaun Nelson 10:658720d51610 148 #ifdef MTDOT_EVB
falingtrea 0:bdd16076aaa5 149 MMA845x_DATA accel_data;
falingtrea 0:bdd16076aaa5 150 MPL3115A2_DATA baro_data;
falingtrea 0:bdd16076aaa5 151 uint16_t lux_data;
Shaun Nelson 12:ad92bbb6312f 152 MMA845x* evbAccel;
Shaun Nelson 12:ad92bbb6312f 153 MPL3115A2* evbBaro;
Shaun Nelson 12:ad92bbb6312f 154 ISL29011* evbAmbLight;
Shaun Nelson 12:ad92bbb6312f 155 NCP5623B* evbBackLight;
Shaun Nelson 12:ad92bbb6312f 156 DOGS102* evbLCD;
Shaun Nelson 10:658720d51610 157
Shaun Nelson 12:ad92bbb6312f 158 /*
Shaun Nelson 12:ad92bbb6312f 159 * EVB Application state
Shaun Nelson 12:ad92bbb6312f 160 */
Shaun Nelson 12:ad92bbb6312f 161 uint8_t position_value = 0xFF; // 00 unknown, 01 is flat, 02 is vertical
Shaun Nelson 12:ad92bbb6312f 162 uint8_t reflected_value = 0xFE;
Shaun Nelson 10:658720d51610 163
Shaun Nelson 12:ad92bbb6312f 164 unsigned char test;
Shaun Nelson 12:ad92bbb6312f 165 char txtstr[17];
Shaun Nelson 12:ad92bbb6312f 166 int32_t num_whole;
Shaun Nelson 12:ad92bbb6312f 167 uint32_t pressure;
Shaun Nelson 12:ad92bbb6312f 168 int16_t num_frac;
Shaun Nelson 12:ad92bbb6312f 169 uint8_t result, pckt_time=100;
Shaun Nelson 12:ad92bbb6312f 170 char data;
falingtrea 3:68e974f5f532 171 // flags for pushbutton debounce code
falingtrea 3:68e974f5f532 172 bool pb1_low = false;
falingtrea 3:68e974f5f532 173 bool pb2_low = false;
falingtrea 3:68e974f5f532 174
falingtrea 0:bdd16076aaa5 175 void pb1ISR(void);
falingtrea 0:bdd16076aaa5 176 void pb2ISR(void);
falingtrea 3:68e974f5f532 177 void pb1_debounce(void const *args);
falingtrea 3:68e974f5f532 178 void pb2_debounce(void const *args);
falingtrea 3:68e974f5f532 179 Thread* thread_3;
falingtrea 0:bdd16076aaa5 180
falingtrea 0:bdd16076aaa5 181 void config_pkt_xmit (void const *args);
falingtrea 0:bdd16076aaa5 182
Shaun Nelson 12:ad92bbb6312f 183 #elif defined(MTDOT_UDK)
Shaun Nelson 12:ad92bbb6312f 184
Shaun Nelson 14:07ff01da6bbf 185 uint16_t position_value = 0;
Shaun Nelson 14:07ff01da6bbf 186 uint16_t reflected_value = 0;
Shaun Nelson 14:07ff01da6bbf 187
Shaun Nelson 12:ad92bbb6312f 188 static X_NUCLEO_IKS01A1 *mems_shield;
Shaun Nelson 12:ad92bbb6312f 189
Shaun Nelson 12:ad92bbb6312f 190 #endif
Shaun Nelson 12:ad92bbb6312f 191
Shaun Nelson 12:ad92bbb6312f 192 mDot* mdot_radio;
Shaun Nelson 12:ad92bbb6312f 193 bool exit_program = false;
Shaun Nelson 14:07ff01da6bbf 194 Ticker joinTicker;
Shaun Nelson 12:ad92bbb6312f 195
Shaun Nelson 12:ad92bbb6312f 196 /*
Shaun Nelson 12:ad92bbb6312f 197 * Process downlink
Shaun Nelson 12:ad92bbb6312f 198 */
Shaun Nelson 12:ad92bbb6312f 199 static void ReceiveData(std::vector<uint8_t> frame);
Shaun Nelson 12:ad92bbb6312f 200
Shaun Nelson 12:ad92bbb6312f 201 static bool checkForExit(bool exit);
Shaun Nelson 12:ad92bbb6312f 202
Shaun Nelson 12:ad92bbb6312f 203 /*
Shaun Nelson 12:ad92bbb6312f 204 * prints of mDot error
Shaun Nelson 12:ad92bbb6312f 205 */
Shaun Nelson 12:ad92bbb6312f 206 void log_error(mDot* dot, const char* msg, int32_t retval)
Shaun Nelson 12:ad92bbb6312f 207 {
Shaun Nelson 12:ad92bbb6312f 208 printf("%s - %ld:%s, %s\r\n", msg, retval, mDot::getReturnCodeString(retval).c_str(), dot->getLastError().c_str());
Shaun Nelson 12:ad92bbb6312f 209 }
Shaun Nelson 12:ad92bbb6312f 210
Shaun Nelson 12:ad92bbb6312f 211 /*
Shaun Nelson 12:ad92bbb6312f 212 * Send frame
Shaun Nelson 12:ad92bbb6312f 213 */
Shaun Nelson 10:658720d51610 214 void SendFrame(std::vector<uint8_t> frame)
falingtrea 0:bdd16076aaa5 215 {
Shaun Nelson 14:07ff01da6bbf 216 int32_t mdot_ret;
Shaun Nelson 12:ad92bbb6312f 217
Shaun Nelson 10:658720d51610 218 if ((mdot_ret = mdot_radio->send(frame)) != mDot::MDOT_OK) {
Shaun Nelson 10:658720d51610 219 log_error(mdot_radio, "failed to send", mdot_ret);
Shaun Nelson 10:658720d51610 220 }
Shaun Nelson 10:658720d51610 221 else {
Shaun Nelson 14:07ff01da6bbf 222 printf("successfully sent data\r\n");
Shaun Nelson 10:658720d51610 223 frame.clear();
Shaun Nelson 14:07ff01da6bbf 224 if ((mdot_ret = mdot_radio->recv(frame)) == mDot::MDOT_OK) {
Shaun Nelson 10:658720d51610 225 printf("recv data: ");
Shaun Nelson 10:658720d51610 226 for(uint32_t i = 0;i < frame.size();i++)
Shaun Nelson 10:658720d51610 227 printf("%02X",frame[i]);
Shaun Nelson 10:658720d51610 228 printf("\r\n");
Shaun Nelson 12:ad92bbb6312f 229
Shaun Nelson 12:ad92bbb6312f 230 ReceiveData(frame);
Shaun Nelson 10:658720d51610 231 }
Shaun Nelson 14:07ff01da6bbf 232 position_changed = false;
Shaun Nelson 10:658720d51610 233 }
Shaun Nelson 10:658720d51610 234 }
falingtrea 0:bdd16076aaa5 235
shaunkrnelson 16:7b3cc3221db1 236 #ifdef MTDOT_EVB
Shaun Nelson 12:ad92bbb6312f 237
Shaun Nelson 12:ad92bbb6312f 238 void ReceiveData(std::vector<uint8_t> frame)
Shaun Nelson 12:ad92bbb6312f 239 {
Shaun Nelson 12:ad92bbb6312f 240 reflected_value = frame[0];
Shaun Nelson 12:ad92bbb6312f 241
Shaun Nelson 12:ad92bbb6312f 242 if(reflected_value == position_value)
Shaun Nelson 12:ad92bbb6312f 243 {
Shaun Nelson 12:ad92bbb6312f 244 evbBackLight->setLEDCurrent(16);
Shaun Nelson 12:ad92bbb6312f 245 }
Shaun Nelson 12:ad92bbb6312f 246 else
Shaun Nelson 12:ad92bbb6312f 247 {
Shaun Nelson 12:ad92bbb6312f 248 evbBackLight->setLEDCurrent(0);
Shaun Nelson 12:ad92bbb6312f 249 }
Shaun Nelson 12:ad92bbb6312f 250 }
Shaun Nelson 12:ad92bbb6312f 251
Shaun Nelson 10:658720d51610 252 void BoardInit()
Shaun Nelson 10:658720d51610 253 {
Shaun Nelson 10:658720d51610 254 static Thread thread_1(pb1_debounce); // threads for de-bouncing pushbutton switches
Shaun Nelson 10:658720d51610 255 static Thread thread_2(pb2_debounce);
falingtrea 0:bdd16076aaa5 256
dkjendal 4:9ea6ae34157c 257 debugUART.baud(115200);
Shaun Nelson 12:ad92bbb6312f 258 // mDotUART.baud(9600); // mdot UART unused but available on external connector
falingtrea 0:bdd16076aaa5 259
Shaun Nelson 12:ad92bbb6312f 260 thread_3 = new Thread(config_pkt_xmit); // start thread that sends LoRa packet when SW2 pressed
falingtrea 2:75adc72aa6a0 261
Shaun Nelson 12:ad92bbb6312f 262 evbAccel = new MMA845x(mDoti2c,MMA845x::SA0_VSS); // setup Accelerometer
Shaun Nelson 12:ad92bbb6312f 263 evbBaro = new MPL3115A2(mDoti2c); // setup Barometric sensor
Shaun Nelson 12:ad92bbb6312f 264 evbAmbLight = new ISL29011(mDoti2c); // Setup Ambient Light Sensor
Shaun Nelson 12:ad92bbb6312f 265 evbBackLight = new NCP5623B(mDoti2c); // setup backlight and LED 2 driver chip
Shaun Nelson 12:ad92bbb6312f 266 evbLCD = new DOGS102(mDotspi, mDot17, mDot13); // setup LCD
falingtrea 0:bdd16076aaa5 267
falingtrea 2:75adc72aa6a0 268 /*
falingtrea 2:75adc72aa6a0 269 * Setup SW1 as program stop function
falingtrea 2:75adc72aa6a0 270 */
falingtrea 2:75adc72aa6a0 271 mDot08.disable_irq();
falingtrea 2:75adc72aa6a0 272 mDot08.fall(&pb1ISR);
falingtrea 2:75adc72aa6a0 273
falingtrea 2:75adc72aa6a0 274 /*
falingtrea 2:75adc72aa6a0 275 * need to call this function after rise or fall because rise/fall sets
falingtrea 2:75adc72aa6a0 276 * mode to PullNone
falingtrea 2:75adc72aa6a0 277 */
falingtrea 2:75adc72aa6a0 278 mDot08.mode(PullUp);
falingtrea 2:75adc72aa6a0 279
falingtrea 2:75adc72aa6a0 280 mDot08.enable_irq();
falingtrea 2:75adc72aa6a0 281
falingtrea 2:75adc72aa6a0 282 /*
falingtrea 2:75adc72aa6a0 283 * Setup SW2 as packet time change
falingtrea 2:75adc72aa6a0 284 */
falingtrea 2:75adc72aa6a0 285 mDot09.disable_irq();
falingtrea 2:75adc72aa6a0 286 mDot09.fall(&pb2ISR);
falingtrea 2:75adc72aa6a0 287
falingtrea 2:75adc72aa6a0 288 /*
falingtrea 2:75adc72aa6a0 289 * need to call this function after rise or fall because rise/fall sets
falingtrea 2:75adc72aa6a0 290 * mode to PullNone
falingtrea 2:75adc72aa6a0 291 */
falingtrea 2:75adc72aa6a0 292 mDot09.mode(PullUp);
falingtrea 2:75adc72aa6a0 293
falingtrea 2:75adc72aa6a0 294 mDot09.enable_irq();
falingtrea 2:75adc72aa6a0 295
falingtrea 2:75adc72aa6a0 296 /*
falingtrea 2:75adc72aa6a0 297 * Setting other InterruptIn pins with Pull Ups
falingtrea 2:75adc72aa6a0 298 */
falingtrea 2:75adc72aa6a0 299 mDot12.mode(PullUp);
falingtrea 2:75adc72aa6a0 300 mDot15.mode(PullUp);
falingtrea 2:75adc72aa6a0 301 mDot16.mode(PullUp);
falingtrea 2:75adc72aa6a0 302
falingtrea 2:75adc72aa6a0 303 printf("font table address %p\n\r",&font_6x8);
falingtrea 2:75adc72aa6a0 304 printf("bitmap address %p\n\r",&MultiTech_Logo);
falingtrea 2:75adc72aa6a0 305
falingtrea 2:75adc72aa6a0 306 // Setup and display logo on LCD
falingtrea 2:75adc72aa6a0 307 evbLCD->startUpdate();
falingtrea 2:75adc72aa6a0 308
falingtrea 2:75adc72aa6a0 309 evbLCD->writeBitmap(0,0,MultiTech_Logo);
falingtrea 2:75adc72aa6a0 310
falingtrea 2:75adc72aa6a0 311 sprintf(txtstr,"MTDOT");
falingtrea 2:75adc72aa6a0 312 evbLCD->writeText(24,3,font_6x8,txtstr,strlen(txtstr));
falingtrea 2:75adc72aa6a0 313 sprintf(txtstr,"Evaluation");
falingtrea 2:75adc72aa6a0 314 evbLCD->writeText(24,4,font_6x8,txtstr,strlen(txtstr));
falingtrea 2:75adc72aa6a0 315 sprintf(txtstr,"Board");
falingtrea 2:75adc72aa6a0 316 evbLCD->writeText(24,5,font_6x8,txtstr,strlen(txtstr));
falingtrea 2:75adc72aa6a0 317
falingtrea 2:75adc72aa6a0 318 evbLCD->endUpdate();
falingtrea 2:75adc72aa6a0 319
Shaun Nelson 10:658720d51610 320 pckt_time = 10;
Shaun Nelson 10:658720d51610 321 }
falingtrea 2:75adc72aa6a0 322
Shaun Nelson 10:658720d51610 323 void PostJoinInit()
Shaun Nelson 10:658720d51610 324 {
falingtrea 0:bdd16076aaa5 325 osDelay(200);
falingtrea 0:bdd16076aaa5 326 evbBackLight->setPWM(NCP5623B::LED_3,16); // enable LED2 on EVB and set to 50% PWM
falingtrea 0:bdd16076aaa5 327
falingtrea 2:75adc72aa6a0 328 // sets LED2 to 50% max current
falingtrea 0:bdd16076aaa5 329 evbBackLight->setLEDCurrent(16);
falingtrea 0:bdd16076aaa5 330
falingtrea 0:bdd16076aaa5 331 printf("Start of Test\n\r");
falingtrea 0:bdd16076aaa5 332
Shaun Nelson 12:ad92bbb6312f 333 osDelay (500); // allows other threads to process
falingtrea 2:75adc72aa6a0 334 printf("shutdown LED:\n\r");
falingtrea 2:75adc72aa6a0 335 evbBackLight->shutdown();
falingtrea 0:bdd16076aaa5 336
Shaun Nelson 12:ad92bbb6312f 337 osDelay (500); // allows other threads to process
falingtrea 0:bdd16076aaa5 338 printf("Turn on LED2\n\r");
falingtrea 0:bdd16076aaa5 339 evbBackLight->setLEDCurrent(16);
falingtrea 0:bdd16076aaa5 340
falingtrea 0:bdd16076aaa5 341 data = evbAccel->getWhoAmI();
falingtrea 0:bdd16076aaa5 342 printf("Accelerometer who_am_i value = %x \n\r", data);
falingtrea 0:bdd16076aaa5 343
falingtrea 0:bdd16076aaa5 344 result = evbAccel->getStatus();
falingtrea 0:bdd16076aaa5 345 printf("status byte = %x \n\r", result);
falingtrea 0:bdd16076aaa5 346
falingtrea 0:bdd16076aaa5 347 printf("Barometer who_am_i check = %s \n\r", evbBaro->testWhoAmI() ? "TRUE" : "FALSE");
falingtrea 0:bdd16076aaa5 348
falingtrea 0:bdd16076aaa5 349 result = evbBaro->getStatus();
falingtrea 0:bdd16076aaa5 350 printf("status byte = %x \n\r", result);
falingtrea 0:bdd16076aaa5 351
falingtrea 0:bdd16076aaa5 352 /*
falingtrea 0:bdd16076aaa5 353 * Setup the Accelerometer for 8g range, 14 bit resolution, Noise reduction off, sample rate 1.56 Hz
falingtrea 0:bdd16076aaa5 354 * normal oversample mode, High pass filter off
falingtrea 0:bdd16076aaa5 355 */
falingtrea 0:bdd16076aaa5 356 evbAccel->setCommonParameters(MMA845x::RANGE_8g,MMA845x::RES_MAX,MMA845x::LN_OFF,
falingtrea 0:bdd16076aaa5 357 MMA845x::DR_1_56,MMA845x::OS_NORMAL,MMA845x::HPF_OFF );
falingtrea 0:bdd16076aaa5 358
falingtrea 0:bdd16076aaa5 359 /*
falingtrea 0:bdd16076aaa5 360 * Setup the Barometric sensor for post processed Ambient pressure, 4 samples per data acquisition.
falingtrea 0:bdd16076aaa5 361 * and a sample taken every second when in active mode
falingtrea 0:bdd16076aaa5 362 */
falingtrea 0:bdd16076aaa5 363 evbBaro->setParameters(MPL3115A2::DATA_NORMAL, MPL3115A2::DM_BAROMETER, MPL3115A2::OR_16,
falingtrea 0:bdd16076aaa5 364 MPL3115A2::AT_1);
falingtrea 0:bdd16076aaa5 365 /*
falingtrea 0:bdd16076aaa5 366 * Setup the Ambient Light Sensor for continuous Ambient Light Sensing, 16 bit resolution,
falingtrea 0:bdd16076aaa5 367 * and 16000 lux range
falingtrea 0:bdd16076aaa5 368 */
falingtrea 0:bdd16076aaa5 369
falingtrea 0:bdd16076aaa5 370 evbAmbLight->setMode(ISL29011::ALS_CONT);
falingtrea 0:bdd16076aaa5 371 evbAmbLight->setResolution(ISL29011::ADC_16BIT);
falingtrea 0:bdd16076aaa5 372 evbAmbLight->setRange(ISL29011::RNG_16000);
falingtrea 0:bdd16076aaa5 373
falingtrea 0:bdd16076aaa5 374 /*
falingtrea 0:bdd16076aaa5 375 * Set the accelerometer for active mode
falingtrea 0:bdd16076aaa5 376 */
falingtrea 0:bdd16076aaa5 377 evbAccel->activeMode();
falingtrea 0:bdd16076aaa5 378
falingtrea 0:bdd16076aaa5 379 /*
falingtrea 0:bdd16076aaa5 380 * Clear the min-max registers in the Barometric Sensor
falingtrea 0:bdd16076aaa5 381 */
falingtrea 0:bdd16076aaa5 382 evbBaro->clearMinMaxRegs();
falingtrea 0:bdd16076aaa5 383
falingtrea 0:bdd16076aaa5 384 evbBackLight->setLEDCurrent(0);
falingtrea 0:bdd16076aaa5 385
falingtrea 0:bdd16076aaa5 386 /*
falingtrea 2:75adc72aa6a0 387 * Check for PB1 press during network join attempt
falingtrea 2:75adc72aa6a0 388 */
falingtrea 2:75adc72aa6a0 389 if (exit_program) {
falingtrea 2:75adc72aa6a0 390 printf("Exiting program\n\r");
falingtrea 2:75adc72aa6a0 391 evbLCD->clearBuffer();
falingtrea 2:75adc72aa6a0 392 sprintf(txtstr,"Exiting Program");
falingtrea 2:75adc72aa6a0 393 evbLCD->writeText(0,4,font_6x8,txtstr,strlen(txtstr));
falingtrea 2:75adc72aa6a0 394 exit(1);
falingtrea 2:75adc72aa6a0 395 }
Shaun Nelson 10:658720d51610 396 }
Shaun Nelson 10:658720d51610 397
Shaun Nelson 10:658720d51610 398 void ReadSensors(BoardSensorData &sensorData)
Shaun Nelson 10:658720d51610 399 {
Shaun Nelson 10:658720d51610 400 MMA845x_DATA accel_data;
Shaun Nelson 10:658720d51610 401 /*
Shaun Nelson 10:658720d51610 402 * Test Accelerometer XYZ data ready bit to see if acquisition complete
Shaun Nelson 10:658720d51610 403 */
Shaun Nelson 10:658720d51610 404 do {
Shaun Nelson 12:ad92bbb6312f 405 osDelay(100); // allows other threads to process
Shaun Nelson 10:658720d51610 406 result = evbAccel->getStatus();
Shaun Nelson 10:658720d51610 407 } while ((result & MMA845x::XYZDR) == 0 );
Shaun Nelson 10:658720d51610 408
Shaun Nelson 10:658720d51610 409 /*
Shaun Nelson 10:658720d51610 410 * Retrieve and print out accelerometer data
Shaun Nelson 10:658720d51610 411 */
Shaun Nelson 10:658720d51610 412 accel_data = evbAccel->getXYZ();
Shaun Nelson 10:658720d51610 413
Shaun Nelson 10:658720d51610 414 sprintf(txtstr,"Accelerometer");
Shaun Nelson 10:658720d51610 415 evbLCD->writeText(0,0,font_6x8,txtstr,strlen(txtstr));
Shaun Nelson 10:658720d51610 416 sprintf(txtstr, "x = %d", accel_data._x);
Shaun Nelson 10:658720d51610 417 evbLCD->writeText(20,1,font_6x8,txtstr,strlen(txtstr));
Shaun Nelson 10:658720d51610 418 sprintf(txtstr, "y = %d", accel_data._y);
Shaun Nelson 10:658720d51610 419 evbLCD->writeText(20,2,font_6x8,txtstr,strlen(txtstr));
Shaun Nelson 10:658720d51610 420 sprintf(txtstr, "z = %d", accel_data._z );
Shaun Nelson 10:658720d51610 421 evbLCD->writeText(20,3,font_6x8,txtstr,strlen(txtstr));
Shaun Nelson 10:658720d51610 422
shaunkrnelson 16:7b3cc3221db1 423 sensorData.accel_x = accel_data._x;
shaunkrnelson 16:7b3cc3221db1 424 sensorData.accel_y = accel_data._y;
shaunkrnelson 16:7b3cc3221db1 425 sensorData.accel_z = accel_data._z;
Shaun Nelson 10:658720d51610 426
Shaun Nelson 10:658720d51610 427 // Update accelerometer state
Shaun Nelson 10:658720d51610 428 evbLCD->startUpdate();
Shaun Nelson 10:658720d51610 429 evbLCD->clearBuffer();
Shaun Nelson 10:658720d51610 430
Shaun Nelson 10:658720d51610 431 // convert to simple position value for use in send/recv
Shaun Nelson 10:658720d51610 432 if((accel_data._x > 500)&&(accel_data._z < 500))
Shaun Nelson 10:658720d51610 433 {
Shaun Nelson 10:658720d51610 434 if(position_value != 0x02)
Shaun Nelson 10:658720d51610 435 position_changed = true;
Shaun Nelson 10:658720d51610 436 position_value = 0x02;
Shaun Nelson 10:658720d51610 437 }
Shaun Nelson 10:658720d51610 438 else if((accel_data._x < 500)&&(accel_data._z > 500))
Shaun Nelson 10:658720d51610 439 {
Shaun Nelson 10:658720d51610 440 if(position_value != 0x01)
Shaun Nelson 10:658720d51610 441 position_changed = true;
Shaun Nelson 10:658720d51610 442 position_value = 0x01;
Shaun Nelson 10:658720d51610 443 }
Shaun Nelson 10:658720d51610 444 else
Shaun Nelson 10:658720d51610 445 {
Shaun Nelson 10:658720d51610 446 if(position_value != 0x00)
Shaun Nelson 10:658720d51610 447 position_changed = true;
Shaun Nelson 10:658720d51610 448 position_value= 0x00;
Shaun Nelson 10:658720d51610 449 }
Shaun Nelson 10:658720d51610 450
shaunkrnelson 16:7b3cc3221db1 451 if(position_changed)
Shaun Nelson 10:658720d51610 452 evbBackLight->setLEDCurrent(0);
Shaun Nelson 10:658720d51610 453 /*
Shaun Nelson 10:658720d51610 454 * Trigger a Pressure reading
Shaun Nelson 10:658720d51610 455 */
Shaun Nelson 10:658720d51610 456 evbBaro->setParameters(MPL3115A2::DATA_NORMAL, MPL3115A2::DM_BAROMETER, MPL3115A2::OR_16,
Shaun Nelson 10:658720d51610 457 MPL3115A2::AT_1);
Shaun Nelson 10:658720d51610 458 evbBaro->triggerOneShot();
Shaun Nelson 10:658720d51610 459
Shaun Nelson 10:658720d51610 460 /*
Shaun Nelson 10:658720d51610 461 * Test barometer device status to see if acquisition is complete
Shaun Nelson 10:658720d51610 462 */
Shaun Nelson 10:658720d51610 463 do {
Shaun Nelson 10:658720d51610 464 osDelay(100); // allows other threads to process
Shaun Nelson 10:658720d51610 465 result = evbBaro->getStatus();
Shaun Nelson 10:658720d51610 466 } while ((result & MPL3115A2::PTDR) == 0 );
Shaun Nelson 10:658720d51610 467
Shaun Nelson 10:658720d51610 468 /*
Shaun Nelson 10:658720d51610 469 * Retrieve and print out barometric pressure
Shaun Nelson 10:658720d51610 470 */
Shaun Nelson 10:658720d51610 471 pressure = evbBaro->getBaroData() >> 12; // convert 32 bit signed to 20 bit unsigned value
Shaun Nelson 10:658720d51610 472 num_whole = pressure >> 2; // 18 bit integer significant
Shaun Nelson 10:658720d51610 473 num_frac = (pressure & 0x3) * 25; // 2 bit fractional 0.25 per bit
Shaun Nelson 10:658720d51610 474 sensorData.pressure = pressure + (.25 * num_frac);
Shaun Nelson 10:658720d51610 475
Shaun Nelson 10:658720d51610 476 sprintf(txtstr,"Press=%ld.%02d Pa", num_whole, num_frac);
Shaun Nelson 10:658720d51610 477 evbLCD->writeText(0,4,font_6x8,txtstr,strlen(txtstr));
Shaun Nelson 10:658720d51610 478
Shaun Nelson 10:658720d51610 479 /*
Shaun Nelson 10:658720d51610 480 * Trigger a Altitude reading
Shaun Nelson 10:658720d51610 481 */
Shaun Nelson 10:658720d51610 482 evbBaro->setParameters(MPL3115A2::DATA_NORMAL, MPL3115A2::DM_ALTIMETER, MPL3115A2::OR_16,
Shaun Nelson 10:658720d51610 483 MPL3115A2::AT_1);
Shaun Nelson 10:658720d51610 484 evbBaro->triggerOneShot();
Shaun Nelson 10:658720d51610 485
Shaun Nelson 10:658720d51610 486 /*
Shaun Nelson 10:658720d51610 487 * Test barometer device status to see if acquisition is complete
Shaun Nelson 10:658720d51610 488 */
Shaun Nelson 10:658720d51610 489 do {
Shaun Nelson 10:658720d51610 490 osDelay(100); // allows other threads to process
Shaun Nelson 10:658720d51610 491 result = evbBaro->getStatus();
Shaun Nelson 10:658720d51610 492 } while ((result & MPL3115A2::PTDR) == 0 );
Shaun Nelson 10:658720d51610 493
Shaun Nelson 10:658720d51610 494 /*
Shaun Nelson 10:658720d51610 495 * Retrieve and print out altitude and temperature
Shaun Nelson 10:658720d51610 496 */
Shaun Nelson 10:658720d51610 497 baro_data = evbBaro->getAllData(false);
Shaun Nelson 10:658720d51610 498 baro_data._baro /= 4096; // convert 32 bit signed to 20 bit signed value
Shaun Nelson 10:658720d51610 499 num_whole = baro_data._baro / 16; // 18 bit signed significant integer
Shaun Nelson 10:658720d51610 500 num_frac = (baro_data._baro & 0xF) * 625 / 100; // 4 bit fractional .0625 per bit
Shaun Nelson 10:658720d51610 501 sprintf(txtstr,"Alti=%ld.%03d m", num_whole, num_frac);
Shaun Nelson 10:658720d51610 502 evbLCD->writeText(0,5,font_6x8,txtstr,strlen(txtstr));
Shaun Nelson 10:658720d51610 503 num_whole = baro_data._temp / 16; // 8 bit signed significant integer
Shaun Nelson 10:658720d51610 504 num_frac = (baro_data._temp & 0x0F) * 625 / 100; // 4 bit fractional .0625 per bit
shaunkrnelson 16:7b3cc3221db1 505 sensorData.temperature = num_whole + ((float)num_frac / 100);
Shaun Nelson 10:658720d51610 506 sprintf(txtstr,"Temp=%ld.%03d C", num_whole, num_frac);
Shaun Nelson 10:658720d51610 507 evbLCD->writeText(0,6,font_6x8,txtstr,strlen(txtstr));
Shaun Nelson 10:658720d51610 508
Shaun Nelson 10:658720d51610 509 /*
Shaun Nelson 10:658720d51610 510 * retrieve and print out Ambient Light level
Shaun Nelson 10:658720d51610 511 */
Shaun Nelson 10:658720d51610 512 lux_data = evbAmbLight->getData();
Shaun Nelson 10:658720d51610 513 num_whole = lux_data * 24 / 100; // 16000 lux full scale .24 lux per bit
Shaun Nelson 10:658720d51610 514 num_frac = lux_data * 24 % 100;
Shaun Nelson 10:658720d51610 515 sprintf(txtstr, "Light=%ld.%02d lux", num_whole, num_frac );
Shaun Nelson 10:658720d51610 516 evbLCD->writeText(0,7,font_6x8,txtstr,strlen(txtstr));
Shaun Nelson 10:658720d51610 517
Shaun Nelson 10:658720d51610 518 evbLCD->endUpdate();
Shaun Nelson 10:658720d51610 519 }
Shaun Nelson 10:658720d51610 520
Shaun Nelson 12:ad92bbb6312f 521 uint32_t PrepareFrame(std::vector<uint8_t> &frame, BoardSensorData &data)
Shaun Nelson 12:ad92bbb6312f 522 {
Shaun Nelson 14:07ff01da6bbf 523 frame.clear();
Shaun Nelson 14:07ff01da6bbf 524
Shaun Nelson 17:162e42587b4d 525 #ifdef REFLECT_FAST_TX
Shaun Nelson 17:162e42587b4d 526 if((reflected_value != position_value)|| position_changed || ( ( sample_period % SEND_PERIOD ) == 0 ) )
Shaun Nelson 17:162e42587b4d 527 #else
Shaun Nelson 17:162e42587b4d 528 if( position_changed || ( ( sample_period % SEND_PERIOD ) == 0 ) )
Shaun Nelson 17:162e42587b4d 529 #endif
Shaun Nelson 12:ad92bbb6312f 530 {
Shaun Nelson 12:ad92bbb6312f 531 // we will send a simple byte descriptor of the current position of the device: 01 is laying flat, 02 is vertically oriented
Shaun Nelson 12:ad92bbb6312f 532 frame.push_back(0x00);
Shaun Nelson 12:ad92bbb6312f 533 frame.push_back(position_value);
Shaun Nelson 12:ad92bbb6312f 534 }
Shaun Nelson 12:ad92bbb6312f 535
Shaun Nelson 14:07ff01da6bbf 536 return frame.size();
Shaun Nelson 12:ad92bbb6312f 537 }
Shaun Nelson 12:ad92bbb6312f 538
Shaun Nelson 12:ad92bbb6312f 539 bool checkForExit(bool _exit)
Shaun Nelson 12:ad92bbb6312f 540 {
Shaun Nelson 12:ad92bbb6312f 541 // Check for PB1 press during network join attempt
Shaun Nelson 12:ad92bbb6312f 542 if (exit_program) {
Shaun Nelson 14:07ff01da6bbf 543 printf("Exiting program\n\r");
Shaun Nelson 12:ad92bbb6312f 544 evbLCD->clearBuffer();
Shaun Nelson 12:ad92bbb6312f 545 sprintf(txtstr,"Exiting Program");
Shaun Nelson 12:ad92bbb6312f 546 evbLCD->writeText(0,4,font_6x8,txtstr,strlen(txtstr));
Shaun Nelson 12:ad92bbb6312f 547 if(_exit)
Shaun Nelson 12:ad92bbb6312f 548 exit(1);
Shaun Nelson 12:ad92bbb6312f 549 }
Shaun Nelson 12:ad92bbb6312f 550
Shaun Nelson 12:ad92bbb6312f 551 return false;
Shaun Nelson 12:ad92bbb6312f 552 }
Shaun Nelson 12:ad92bbb6312f 553
Shaun Nelson 12:ad92bbb6312f 554 void ExitingProgram()
Shaun Nelson 10:658720d51610 555 {
Shaun Nelson 12:ad92bbb6312f 556 evbBaro->triggerOneShot();
Shaun Nelson 12:ad92bbb6312f 557 do {
Shaun Nelson 12:ad92bbb6312f 558 osDelay(200); // allows other threads to process
Shaun Nelson 12:ad92bbb6312f 559 result = evbBaro->getStatus();
Shaun Nelson 12:ad92bbb6312f 560 } while ((result & MPL3115A2::PTDR) == 0 );
Shaun Nelson 12:ad92bbb6312f 561
Shaun Nelson 12:ad92bbb6312f 562 baro_data = evbBaro->getAllData(true);
Shaun Nelson 12:ad92bbb6312f 563 printf ("minBaro=%ld maxBaro=%ld minTemp=%d maxTemp=%d\n\r", baro_data._minbaro, baro_data._maxbaro,
Shaun Nelson 12:ad92bbb6312f 564 baro_data._mintemp, baro_data._maxtemp);
Shaun Nelson 12:ad92bbb6312f 565 evbLCD->clearBuffer();
Shaun Nelson 12:ad92bbb6312f 566 sprintf(txtstr,"Exiting Program");
Shaun Nelson 12:ad92bbb6312f 567 evbLCD->writeText(0,4,font_6x8,txtstr,strlen(txtstr));
Shaun Nelson 12:ad92bbb6312f 568 printf("End of Test\n\r");
Shaun Nelson 12:ad92bbb6312f 569 }
Shaun Nelson 12:ad92bbb6312f 570
Shaun Nelson 10:658720d51610 571
Shaun Nelson 12:ad92bbb6312f 572 /*
Shaun Nelson 12:ad92bbb6312f 573 * Sets pb1_low flag. Slag is cleared in pb1_debounce thread
Shaun Nelson 12:ad92bbb6312f 574 */
Shaun Nelson 12:ad92bbb6312f 575 void pb1ISR(void)
Shaun Nelson 12:ad92bbb6312f 576 {
Shaun Nelson 12:ad92bbb6312f 577 if (!pb1_low)
Shaun Nelson 12:ad92bbb6312f 578 pb1_low = true;
Shaun Nelson 12:ad92bbb6312f 579 }
Shaun Nelson 12:ad92bbb6312f 580
Shaun Nelson 12:ad92bbb6312f 581 /*
Shaun Nelson 12:ad92bbb6312f 582 * Debounces pb1. Also exits program if pushbutton 1 is pressed
Shaun Nelson 12:ad92bbb6312f 583 */
Shaun Nelson 12:ad92bbb6312f 584 void pb1_debounce(void const *args)
Shaun Nelson 12:ad92bbb6312f 585 {
Shaun Nelson 12:ad92bbb6312f 586 static uint8_t count = 0;
Shaun Nelson 10:658720d51610 587
Shaun Nelson 12:ad92bbb6312f 588 while (true) {
Shaun Nelson 12:ad92bbb6312f 589 if (pb1_low && (mDot08 == 0))
Shaun Nelson 12:ad92bbb6312f 590 count++;
Shaun Nelson 12:ad92bbb6312f 591 else {
Shaun Nelson 12:ad92bbb6312f 592 count = 0;
Shaun Nelson 12:ad92bbb6312f 593 pb1_low = false;
Shaun Nelson 12:ad92bbb6312f 594 }
Shaun Nelson 12:ad92bbb6312f 595
Shaun Nelson 12:ad92bbb6312f 596 if (count == 5)
Shaun Nelson 12:ad92bbb6312f 597 exit_program = true;
Shaun Nelson 12:ad92bbb6312f 598
Shaun Nelson 12:ad92bbb6312f 599 Thread::wait(5);
Shaun Nelson 12:ad92bbb6312f 600 }
Shaun Nelson 12:ad92bbb6312f 601 }
Shaun Nelson 12:ad92bbb6312f 602
Shaun Nelson 12:ad92bbb6312f 603 /*
Shaun Nelson 12:ad92bbb6312f 604 * Sets pb2_low flag. Flag is cleared in pb2_debounce thread
Shaun Nelson 12:ad92bbb6312f 605 */
Shaun Nelson 12:ad92bbb6312f 606 void pb2ISR(void)
Shaun Nelson 12:ad92bbb6312f 607 {
Shaun Nelson 12:ad92bbb6312f 608 if (!pb2_low)
Shaun Nelson 12:ad92bbb6312f 609 pb2_low = true;
Shaun Nelson 12:ad92bbb6312f 610 }
Shaun Nelson 12:ad92bbb6312f 611
Shaun Nelson 12:ad92bbb6312f 612 /*
Shaun Nelson 12:ad92bbb6312f 613 * Debounces pb2. Also changes packet transmit time to every other,
Shaun Nelson 12:ad92bbb6312f 614 * every fifth, or every tenth sample when SW2 pushed
Shaun Nelson 12:ad92bbb6312f 615 * Also triggers a thread to transmit a configuration packet
Shaun Nelson 12:ad92bbb6312f 616 */
Shaun Nelson 12:ad92bbb6312f 617 void pb2_debounce(void const *args)
Shaun Nelson 12:ad92bbb6312f 618 {
Shaun Nelson 12:ad92bbb6312f 619 static uint8_t count = 0;
Shaun Nelson 12:ad92bbb6312f 620
Shaun Nelson 12:ad92bbb6312f 621 while (true) {
Shaun Nelson 10:658720d51610 622
Shaun Nelson 12:ad92bbb6312f 623 if (pb2_low && (mDot09 == 0))
Shaun Nelson 12:ad92bbb6312f 624 count++;
Shaun Nelson 12:ad92bbb6312f 625 else {
Shaun Nelson 12:ad92bbb6312f 626 count = 0;
Shaun Nelson 12:ad92bbb6312f 627 pb2_low = false;
Shaun Nelson 12:ad92bbb6312f 628 }
Shaun Nelson 12:ad92bbb6312f 629
Shaun Nelson 12:ad92bbb6312f 630 if (count == 5){
Shaun Nelson 12:ad92bbb6312f 631 if (pckt_time >= 5)
Shaun Nelson 12:ad92bbb6312f 632 pckt_time /= 2;
Shaun Nelson 12:ad92bbb6312f 633 else
Shaun Nelson 12:ad92bbb6312f 634 pckt_time = 20;
Shaun Nelson 12:ad92bbb6312f 635
Shaun Nelson 12:ad92bbb6312f 636 //thread_3->signal_set(0x10); // signal config_pkt_xmit to send packet
Shaun Nelson 12:ad92bbb6312f 637 position_changed = true;
Shaun Nelson 12:ad92bbb6312f 638 }
Shaun Nelson 12:ad92bbb6312f 639 Thread::wait(5);
Shaun Nelson 12:ad92bbb6312f 640 }
Shaun Nelson 12:ad92bbb6312f 641 }
Shaun Nelson 12:ad92bbb6312f 642
Shaun Nelson 12:ad92bbb6312f 643 /*
Shaun Nelson 12:ad92bbb6312f 644 * Thread that is triggered by SW2 ISR. Sends a packet to the LoRa server with the new Packet Transmission time setting
Shaun Nelson 12:ad92bbb6312f 645 */
Shaun Nelson 12:ad92bbb6312f 646 void config_pkt_xmit (void const *args)
Shaun Nelson 12:ad92bbb6312f 647 {
Shaun Nelson 12:ad92bbb6312f 648 int32_t mdot_ret;
Shaun Nelson 12:ad92bbb6312f 649
Shaun Nelson 12:ad92bbb6312f 650 std::vector<uint8_t> data;
Shaun Nelson 12:ad92bbb6312f 651
Shaun Nelson 12:ad92bbb6312f 652 while (true) {
Shaun Nelson 12:ad92bbb6312f 653 Thread::signal_wait(0x10); // wait for pb2ISR to signal send
Shaun Nelson 12:ad92bbb6312f 654 data.clear();
Shaun Nelson 12:ad92bbb6312f 655 data.push_back(0x0F); // key for Configuration data (packet transmission timer)
Shaun Nelson 12:ad92bbb6312f 656 data.push_back(pckt_time);
Shaun Nelson 12:ad92bbb6312f 657
Shaun Nelson 12:ad92bbb6312f 658 if ((mdot_ret = mdot_radio->send(data)) != mDot::MDOT_OK) {
Shaun Nelson 12:ad92bbb6312f 659 log_error(mdot_radio, "failed to send config data", mdot_ret);
Shaun Nelson 12:ad92bbb6312f 660 } else {
Shaun Nelson 12:ad92bbb6312f 661 printf("sent config data to gateway\r\n");
Shaun Nelson 12:ad92bbb6312f 662 }
Shaun Nelson 10:658720d51610 663 }
Shaun Nelson 10:658720d51610 664 }
Shaun Nelson 10:658720d51610 665
Shaun Nelson 10:658720d51610 666 #elif defined(MTDOT_UDK)
Shaun Nelson 10:658720d51610 667
Shaun Nelson 12:ad92bbb6312f 668 void ReceiveData(std::vector<uint8_t> frame)
Shaun Nelson 12:ad92bbb6312f 669 {
Shaun Nelson 14:07ff01da6bbf 670 uint16_t value;
Shaun Nelson 14:07ff01da6bbf 671
Shaun Nelson 14:07ff01da6bbf 672 if(frame.size() >= 2)
Shaun Nelson 14:07ff01da6bbf 673 {
Shaun Nelson 14:07ff01da6bbf 674 value = frame[0] << 8 | frame[1];
Shaun Nelson 14:07ff01da6bbf 675 if(value == position_value)
Shaun Nelson 14:07ff01da6bbf 676 {
Shaun Nelson 14:07ff01da6bbf 677 reflected_value = value;
Shaun Nelson 14:07ff01da6bbf 678 }
Shaun Nelson 14:07ff01da6bbf 679 }
Shaun Nelson 12:ad92bbb6312f 680 }
Shaun Nelson 12:ad92bbb6312f 681
Shaun Nelson 10:658720d51610 682 void BoardInit()
Shaun Nelson 10:658720d51610 683 {
Shaun Nelson 10:658720d51610 684 debugUART.baud(115200);
Shaun Nelson 10:658720d51610 685
Shaun Nelson 10:658720d51610 686 // ST X-NUCLEO-IKS01A1 MEMS Shield
Shaun Nelson 12:ad92bbb6312f 687 mems_shield = X_NUCLEO_IKS01A1::Instance(NULL, NC);
Shaun Nelson 12:ad92bbb6312f 688 // mems_shield = X_NUCLEO_IKS01A1::Instance();
Shaun Nelson 10:658720d51610 689 }
Shaun Nelson 10:658720d51610 690
Shaun Nelson 10:658720d51610 691 void PostJoinInit() { }
Shaun Nelson 10:658720d51610 692
Shaun Nelson 10:658720d51610 693
Shaun Nelson 10:658720d51610 694 void ReadSensors(BoardSensorData &data)
Shaun Nelson 10:658720d51610 695 {
Shaun Nelson 10:658720d51610 696 uint32_t ret = 0;
Shaun Nelson 10:658720d51610 697 int32_t accel_data[3];
Shaun Nelson 10:658720d51610 698
Shaun Nelson 10:658720d51610 699 // Temperature
Shaun Nelson 10:658720d51610 700 ret |= (!CALL_METH(mems_shield->pt_sensor, GetTemperature, &data.temperature, 0.0f) ? 0x0 : 0x1);
Shaun Nelson 10:658720d51610 701
Shaun Nelson 10:658720d51610 702 // Pressure
Shaun Nelson 10:658720d51610 703 ret |= (!CALL_METH(mems_shield->pt_sensor, GetPressure, &data.pressure, 0.0f) ? 0x0 : 0x1);
Shaun Nelson 10:658720d51610 704
Shaun Nelson 10:658720d51610 705 // Accelerometer
Shaun Nelson 10:658720d51610 706 MotionSensor *motionSensor = mems_shield->GetAccelerometer();
Shaun Nelson 10:658720d51610 707 if( motionSensor != NULL)
Shaun Nelson 10:658720d51610 708 {
Shaun Nelson 10:658720d51610 709 motionSensor->Get_X_Axes(accel_data);
Shaun Nelson 10:658720d51610 710
Shaun Nelson 10:658720d51610 711 data.accel_x = accel_data[0];
Shaun Nelson 10:658720d51610 712 data.accel_y = accel_data[1];
Shaun Nelson 10:658720d51610 713 data.accel_z = accel_data[2];
Shaun Nelson 14:07ff01da6bbf 714 /* z-axis : > 0 = rightside up, < 0 upside down
Shaun Nelson 14:07ff01da6bbf 715 * x-axis: com LED to the left x < 0, x > 0 on the right
Shaun Nelson 14:07ff01da6bbf 716 * y-axis: y > 0 COM LED down, y < 0 COM LED up
Shaun Nelson 14:07ff01da6bbf 717 */
Shaun Nelson 14:07ff01da6bbf 718 bool up = false;
Shaun Nelson 14:07ff01da6bbf 719 bool down = false;
Shaun Nelson 14:07ff01da6bbf 720 bool right = false;
Shaun Nelson 14:07ff01da6bbf 721 bool left = false;
Shaun Nelson 14:07ff01da6bbf 722 bool horizontal = false;
Shaun Nelson 14:07ff01da6bbf 723 bool upsidedown = false;
Shaun Nelson 14:07ff01da6bbf 724 uint16_t next_value = 0;
Shaun Nelson 14:07ff01da6bbf 725
Shaun Nelson 14:07ff01da6bbf 726 // rightside up
Shaun Nelson 14:07ff01da6bbf 727 if(data.accel_z >= 750)
Shaun Nelson 14:07ff01da6bbf 728 {
Shaun Nelson 14:07ff01da6bbf 729 horizontal = true;
Shaun Nelson 14:07ff01da6bbf 730 }
Shaun Nelson 14:07ff01da6bbf 731 // upside down
Shaun Nelson 14:07ff01da6bbf 732 else if(data.accel_z <= -750)
Shaun Nelson 14:07ff01da6bbf 733 {
Shaun Nelson 14:07ff01da6bbf 734 horizontal = true;
Shaun Nelson 14:07ff01da6bbf 735 upsidedown = true;
Shaun Nelson 14:07ff01da6bbf 736 position_value = (2 << 12) | (1 << 8);
Shaun Nelson 14:07ff01da6bbf 737 }
Shaun Nelson 14:07ff01da6bbf 738 // vertical down
Shaun Nelson 14:07ff01da6bbf 739 else if(data.accel_y >= 900 )
Shaun Nelson 14:07ff01da6bbf 740 {
Shaun Nelson 14:07ff01da6bbf 741 down = true;
Shaun Nelson 14:07ff01da6bbf 742 }
Shaun Nelson 14:07ff01da6bbf 743 // vertical up
Shaun Nelson 14:07ff01da6bbf 744 else if(data.accel_y <= -900 )
Shaun Nelson 14:07ff01da6bbf 745 {
Shaun Nelson 14:07ff01da6bbf 746 up = true;
Shaun Nelson 14:07ff01da6bbf 747 }
Shaun Nelson 14:07ff01da6bbf 748 // side right
Shaun Nelson 14:07ff01da6bbf 749 else if(data.accel_x > 900)
Shaun Nelson 14:07ff01da6bbf 750 {
Shaun Nelson 14:07ff01da6bbf 751 right = true;
Shaun Nelson 14:07ff01da6bbf 752 }
Shaun Nelson 14:07ff01da6bbf 753 // side left
Shaun Nelson 14:07ff01da6bbf 754 else
Shaun Nelson 14:07ff01da6bbf 755 {
Shaun Nelson 14:07ff01da6bbf 756 left = true;
Shaun Nelson 14:07ff01da6bbf 757 }
Shaun Nelson 14:07ff01da6bbf 758
Shaun Nelson 14:07ff01da6bbf 759 if(horizontal)
Shaun Nelson 14:07ff01da6bbf 760 {
Shaun Nelson 14:07ff01da6bbf 761 next_value = (2 << 12) | (upsidedown << 8);
Shaun Nelson 14:07ff01da6bbf 762 }
Shaun Nelson 14:07ff01da6bbf 763 else
Shaun Nelson 14:07ff01da6bbf 764 {
Shaun Nelson 14:07ff01da6bbf 765 next_value = (up << 12) | (left << 8) | (down << 4) | right;
Shaun Nelson 14:07ff01da6bbf 766 }
Shaun Nelson 14:07ff01da6bbf 767
Shaun Nelson 14:07ff01da6bbf 768 if(next_value != position_value)
Shaun Nelson 14:07ff01da6bbf 769 {
Shaun Nelson 14:07ff01da6bbf 770 position_value = next_value;
Shaun Nelson 14:07ff01da6bbf 771 position_changed = true;
Shaun Nelson 14:07ff01da6bbf 772 }
Shaun Nelson 10:658720d51610 773 }
Shaun Nelson 10:658720d51610 774
Shaun Nelson 14:07ff01da6bbf 775 printf("%s: position_value=%04x, reflected_value=%04x\r\n",__func__, position_value, reflected_value);
Shaun Nelson 10:658720d51610 776 }
Shaun Nelson 10:658720d51610 777
Shaun Nelson 12:ad92bbb6312f 778 uint32_t PrepareFrame(std::vector<uint8_t> &frame, BoardSensorData &data)
Shaun Nelson 10:658720d51610 779 {
Shaun Nelson 14:07ff01da6bbf 780 static uint8_t buffer[64];
Shaun Nelson 14:07ff01da6bbf 781
Shaun Nelson 14:07ff01da6bbf 782 frame.clear();
Shaun Nelson 10:658720d51610 783
Shaun Nelson 10:658720d51610 784 // Sensor packet type serialized to the LMIC frame buffer
Shaun Nelson 14:07ff01da6bbf 785 SensorPacket packet(buffer, sizeof(buffer));
Shaun Nelson 10:658720d51610 786
Shaun Nelson 17:162e42587b4d 787 #ifdef REFLECT_FAST_TX
Shaun Nelson 17:162e42587b4d 788 if( position_changed || (reflected_value != position_value) || ( ( sample_period % SEND_PERIOD ) == 0 ) )
Shaun Nelson 17:162e42587b4d 789 #else
Shaun Nelson 17:162e42587b4d 790 if( position_changed || ( ( sample_period % SEND_PERIOD ) == 0 ) )
Shaun Nelson 17:162e42587b4d 791 #endif
Shaun Nelson 14:07ff01da6bbf 792 {
Shaun Nelson 14:07ff01da6bbf 793 packet.setPrimarySensor(position_value);
Shaun Nelson 14:07ff01da6bbf 794 packet.setTemperature(data.temperature);
Shaun Nelson 14:07ff01da6bbf 795 packet.setPressure(data.pressure);
Shaun Nelson 14:07ff01da6bbf 796
Shaun Nelson 14:07ff01da6bbf 797 // Serialize packet
Shaun Nelson 14:07ff01da6bbf 798 packet.serialize();
Shaun Nelson 10:658720d51610 799
Shaun Nelson 14:07ff01da6bbf 800 frame.assign(packet.payload(), packet.payload() + packet.length());
Shaun Nelson 14:07ff01da6bbf 801 }
Shaun Nelson 10:658720d51610 802
Shaun Nelson 10:658720d51610 803 return frame.size();
Shaun Nelson 10:658720d51610 804 }
Shaun Nelson 10:658720d51610 805
Shaun Nelson 12:ad92bbb6312f 806 bool checkForExit(bool _exit) { return false;}
Shaun Nelson 12:ad92bbb6312f 807
Shaun Nelson 12:ad92bbb6312f 808
Shaun Nelson 12:ad92bbb6312f 809 void ExitingProgram()
Shaun Nelson 12:ad92bbb6312f 810 {
Shaun Nelson 12:ad92bbb6312f 811 printf("Exiting\n\r");
Shaun Nelson 12:ad92bbb6312f 812 }
Shaun Nelson 12:ad92bbb6312f 813
Shaun Nelson 10:658720d51610 814 #else
Shaun Nelson 10:658720d51610 815 #error Board type not defined!
Shaun Nelson 10:658720d51610 816 #endif
Shaun Nelson 10:658720d51610 817
Shaun Nelson 14:07ff01da6bbf 818 DigitalOut joinLED(PA_0);
Shaun Nelson 14:07ff01da6bbf 819
Shaun Nelson 14:07ff01da6bbf 820 void joinLedToggle()
Shaun Nelson 14:07ff01da6bbf 821 {
Shaun Nelson 14:07ff01da6bbf 822 joinLED = !joinLED;
Shaun Nelson 14:07ff01da6bbf 823 }
Shaun Nelson 14:07ff01da6bbf 824
Shaun Nelson 10:658720d51610 825 void mDotConfigureAndJoin()
Shaun Nelson 10:658720d51610 826 {
Shaun Nelson 12:ad92bbb6312f 827 bool ok;
Shaun Nelson 12:ad92bbb6312f 828 int32_t mdot_ret;
Shaun Nelson 12:ad92bbb6312f 829
Shaun Nelson 12:ad92bbb6312f 830 printf("Configuring mDot\r\n");
Shaun Nelson 10:658720d51610 831
Shaun Nelson 10:658720d51610 832 // get mDot handle
Shaun Nelson 10:658720d51610 833 mdot_radio = mDot::getInstance();
Shaun Nelson 10:658720d51610 834 if(mdot_radio == NULL)
Shaun Nelson 10:658720d51610 835 {
Shaun Nelson 10:658720d51610 836 while(1) {
Shaun Nelson 10:658720d51610 837 printf("radio setup failed\n\r");
Shaun Nelson 10:658720d51610 838 osDelay(1000);
Shaun Nelson 10:658720d51610 839 }
Shaun Nelson 10:658720d51610 840 }
Shaun Nelson 10:658720d51610 841
Shaun Nelson 10:658720d51610 842 do{
Shaun Nelson 10:658720d51610 843 ok = true;
Shaun Nelson 10:658720d51610 844
Shaun Nelson 10:658720d51610 845 printf("\n\r setup mdot\n\r");
Shaun Nelson 10:658720d51610 846
Shaun Nelson 10:658720d51610 847 // reset to default config so we know what state we're in
Shaun Nelson 10:658720d51610 848 mdot_radio->resetConfig();
Shaun Nelson 14:07ff01da6bbf 849 //mdot_radio->setLogLevel(6);
Shaun Nelson 10:658720d51610 850
Shaun Nelson 10:658720d51610 851 mdot_radio->setAntennaGain(-3);
Shaun Nelson 10:658720d51610 852
Shaun Nelson 10:658720d51610 853 // Setting up LED1 as activity LED
shaunkrnelson 16:7b3cc3221db1 854 #ifdef MTDOT_EVB
Shaun Nelson 10:658720d51610 855 mdot_radio->setActivityLedPin(PB_0);
Shaun Nelson 10:658720d51610 856 mdot_radio->setActivityLedEnable(true);
Shaun Nelson 10:658720d51610 857 #endif
Shaun Nelson 10:658720d51610 858
Shaun Nelson 10:658720d51610 859 // Read node ID
Shaun Nelson 10:658720d51610 860 std::vector<uint8_t> mdot_EUI;
Shaun Nelson 10:658720d51610 861 mdot_EUI = mdot_radio->getDeviceId();
Shaun Nelson 10:658720d51610 862 printf("mDot EUI = ");
Shaun Nelson 10:658720d51610 863
Shaun Nelson 10:658720d51610 864 for (uint8_t i=0; i<mdot_EUI.size(); i++) {
Shaun Nelson 10:658720d51610 865 printf("%02x ", mdot_EUI[i]);
Shaun Nelson 10:658720d51610 866 }
Shaun Nelson 12:ad92bbb6312f 867 printf("\n\r");
Shaun Nelson 12:ad92bbb6312f 868
Shaun Nelson 10:658720d51610 869
Shaun Nelson 12:ad92bbb6312f 870 /*
Shaun Nelson 12:ad92bbb6312f 871 * This call sets up private or public mode on the MTDOT. Set the function to true if
Shaun Nelson 12:ad92bbb6312f 872 * connecting to a public network
Shaun Nelson 12:ad92bbb6312f 873 */
Shaun Nelson 10:658720d51610 874 printf("setting Public Network Mode\r\n");
Shaun Nelson 10:658720d51610 875 if ((mdot_ret = mdot_radio->setPublicNetwork(true)) != mDot::MDOT_OK) {
Shaun Nelson 10:658720d51610 876 log_error(mdot_radio, "failed to set Public Network Mode", mdot_ret);
Shaun Nelson 10:658720d51610 877 }
Shaun Nelson 10:658720d51610 878 mdot_radio->setTxDataRate(mDot::DR0);
Shaun Nelson 10:658720d51610 879 mdot_radio->setTxPower(14);
Shaun Nelson 10:658720d51610 880 mdot_radio->setJoinRetries(1);
Shaun Nelson 12:ad92bbb6312f 881 mdot_radio->setJoinMode(mDot::OTA);
Shaun Nelson 10:658720d51610 882
Shaun Nelson 12:ad92bbb6312f 883 /*
Shaun Nelson 12:ad92bbb6312f 884 * Frequency sub-band is valid for NAM only and for Private networks should be set to a value
Shaun Nelson 12:ad92bbb6312f 885 * between 1-8 that matches the the LoRa gateway setting. Public networks use sub-band 0 only.
Shaun Nelson 12:ad92bbb6312f 886 * This function can be commented out for EU networks
Shaun Nelson 12:ad92bbb6312f 887 */
Shaun Nelson 10:658720d51610 888 printf("setting frequency sub band\r\n");
Shaun Nelson 12:ad92bbb6312f 889 if ((mdot_ret = mdot_radio->setFrequencySubBand(config_frequency_sub_band)) != mDot::MDOT_OK) {
Shaun Nelson 10:658720d51610 890 log_error(mdot_radio, "failed to set frequency sub band", mdot_ret);
Shaun Nelson 10:658720d51610 891 ok = false;
Shaun Nelson 10:658720d51610 892 }
Shaun Nelson 10:658720d51610 893
Shaun Nelson 10:658720d51610 894 printf("setting ADR\r\n");
Shaun Nelson 10:658720d51610 895 if ((mdot_ret = mdot_radio->setAdr(config_adr_on)) != mDot::MDOT_OK) {
Shaun Nelson 10:658720d51610 896 log_error(mdot_radio, "failed to set ADR", mdot_ret);
Shaun Nelson 10:658720d51610 897 ok = false;
Shaun Nelson 10:658720d51610 898 }
Shaun Nelson 12:ad92bbb6312f 899
Shaun Nelson 12:ad92bbb6312f 900 /*
Shaun Nelson 12:ad92bbb6312f 901 * setNetworkName is used for private networks.
Shaun Nelson 12:ad92bbb6312f 902 * Use setNetworkID(AppID) for public networks
Shaun Nelson 12:ad92bbb6312f 903 */
Shaun Nelson 10:658720d51610 904 printf("setting network name\r\n");
Shaun Nelson 10:658720d51610 905 if ((mdot_ret = mdot_radio->setNetworkId(config_app_id)) != mDot::MDOT_OK) {
Shaun Nelson 10:658720d51610 906 log_error(mdot_radio, "failed to set network name", mdot_ret);
Shaun Nelson 10:658720d51610 907 ok = false;
Shaun Nelson 10:658720d51610 908 }
Shaun Nelson 10:658720d51610 909
Shaun Nelson 12:ad92bbb6312f 910 /*
Shaun Nelson 12:ad92bbb6312f 911 * setNetworkPassphrase is used for private networks
Shaun Nelson 12:ad92bbb6312f 912 * Use setNetworkKey for public networks
Shaun Nelson 12:ad92bbb6312f 913 */
Shaun Nelson 12:ad92bbb6312f 914 printf("setting network key\r\n");
Shaun Nelson 10:658720d51610 915 if ((mdot_ret = mdot_radio->setNetworkKey(config_app_key)) != mDot::MDOT_OK) {
Shaun Nelson 10:658720d51610 916 log_error(mdot_radio, "failed to set network password", mdot_ret);
Shaun Nelson 10:658720d51610 917 ok = false;
Shaun Nelson 10:658720d51610 918 }
Shaun Nelson 12:ad92bbb6312f 919
Shaun Nelson 12:ad92bbb6312f 920 checkForExit(true);
Shaun Nelson 12:ad92bbb6312f 921
Shaun Nelson 10:658720d51610 922 }while(ok == false);
Shaun Nelson 12:ad92bbb6312f 923
Shaun Nelson 14:07ff01da6bbf 924 joinTicker.attach(joinLedToggle,1);
Shaun Nelson 14:07ff01da6bbf 925
Shaun Nelson 14:07ff01da6bbf 926 // attempt to join the network
Shaun Nelson 14:07ff01da6bbf 927 printf("joining network\r\n");
Shaun Nelson 14:07ff01da6bbf 928 while ((mdot_ret = mdot_radio->joinNetwork()) != mDot::MDOT_OK) {
Shaun Nelson 14:07ff01da6bbf 929 log_error(mdot_radio,"failed to join network:", mdot_ret);
Shaun Nelson 14:07ff01da6bbf 930 if (mdot_radio->getFrequencyBand() == mDot::FB_868){
Shaun Nelson 14:07ff01da6bbf 931 mdot_ret = mdot_radio->getNextTxMs();
Shaun Nelson 14:07ff01da6bbf 932 }
Shaun Nelson 14:07ff01da6bbf 933 else {
Shaun Nelson 14:07ff01da6bbf 934 mdot_ret = 0;
Shaun Nelson 14:07ff01da6bbf 935 }
Shaun Nelson 14:07ff01da6bbf 936 checkForExit(true);
Shaun Nelson 14:07ff01da6bbf 937 printf("delay = %lu\n\r",mdot_ret);
Shaun Nelson 14:07ff01da6bbf 938 osDelay(mdot_ret + 10000);
Shaun Nelson 14:07ff01da6bbf 939 }
Shaun Nelson 14:07ff01da6bbf 940 printf("network joined\r\n");
Shaun Nelson 10:658720d51610 941
Shaun Nelson 14:07ff01da6bbf 942 joinTicker.detach();
Shaun Nelson 14:07ff01da6bbf 943 joinLED=1;
Shaun Nelson 10:658720d51610 944 }
Shaun Nelson 10:658720d51610 945
Shaun Nelson 12:ad92bbb6312f 946
Shaun Nelson 10:658720d51610 947 int main()
Shaun Nelson 10:658720d51610 948 {
Shaun Nelson 10:658720d51610 949 BoardSensorData sensorData;
Shaun Nelson 12:ad92bbb6312f 950 std::vector<uint8_t> frame;
Shaun Nelson 10:658720d51610 951
Shaun Nelson 10:658720d51610 952 // Board specific initialization
Shaun Nelson 10:658720d51610 953 BoardInit();
Shaun Nelson 10:658720d51610 954
Shaun Nelson 12:ad92bbb6312f 955 // Configure mDot and join
Shaun Nelson 12:ad92bbb6312f 956 mDotConfigureAndJoin();
Shaun Nelson 10:658720d51610 957
Shaun Nelson 12:ad92bbb6312f 958 // Do board specific post join configuration
Shaun Nelson 12:ad92bbb6312f 959 PostJoinInit();
falingtrea 2:75adc72aa6a0 960
falingtrea 2:75adc72aa6a0 961 /*
falingtrea 0:bdd16076aaa5 962 * Main data acquisition loop
falingtrea 0:bdd16076aaa5 963 */
Shaun Nelson 14:07ff01da6bbf 964 while(!checkForExit(false))
Shaun Nelson 14:07ff01da6bbf 965 {
Shaun Nelson 17:162e42587b4d 966 if( PERIOD_DELAY > 0 )
Shaun Nelson 17:162e42587b4d 967 osDelay( PERIOD_DELAY );
Shaun Nelson 12:ad92bbb6312f 968
Shaun Nelson 14:07ff01da6bbf 969 // Minimum delay between sampling
Shaun Nelson 17:162e42587b4d 970 if( ( sample_period % FAST_SEND_PERIOD ) == 0 )
Shaun Nelson 14:07ff01da6bbf 971 {
Shaun Nelson 14:07ff01da6bbf 972 // Acquire sensor values
Shaun Nelson 14:07ff01da6bbf 973 ReadSensors(sensorData);
Shaun Nelson 14:07ff01da6bbf 974
Shaun Nelson 14:07ff01da6bbf 975 // Generate frame if send conditions are satisified
Shaun Nelson 14:07ff01da6bbf 976 if( PrepareFrame(frame, sensorData) > 0 )
Shaun Nelson 14:07ff01da6bbf 977 {
Shaun Nelson 14:07ff01da6bbf 978 // Send sensor packets
Shaun Nelson 14:07ff01da6bbf 979 SendFrame( frame );
Shaun Nelson 14:07ff01da6bbf 980 }
Shaun Nelson 10:658720d51610 981 }
Shaun Nelson 14:07ff01da6bbf 982 sample_period++;
Shaun Nelson 14:07ff01da6bbf 983 }
falingtrea 3:68e974f5f532 984
Shaun Nelson 12:ad92bbb6312f 985 ExitingProgram();
falingtrea 3:68e974f5f532 986 }