ENEL400 / Mbed 2 deprecated LoRaBaseStation

Wireless interface using LoRa technology

Dependencies:   AlohaTransceiver RingBuffer SX1276Lib SerialInterfaceProtocol mbed L3PDU

main.cpp@24:2136cf94fedb, 2016-09-02 (annotated)

Committer:
rba90
Date:
Fri Sep 02 04:21:34 2016 +0000
Revision:
24:2136cf94fedb
Parent:
23:378bd4d025d0
Child:
25:faa87315c44f
remove unused header

Who changed what in which revision?

UserRevisionLine numberNew contents of line
rba90 0:1e42d79b42e1 1 #include "mbed.h"
rba90 0:1e42d79b42e1 2 #include "AlohaTransceiver.h"
rba90 0:1e42d79b42e1 3 #include "SerialInterfaceProtocol.h"
rba90 0:1e42d79b42e1 4 #include "AlohaFrame.h"
rba90 14:25e836a5a7bf 5 #include "ControlPacket.h"
rba90 14:25e836a5a7bf 6 #include "DataBlockPacket.h"
rba90 0:1e42d79b42e1 7
rba90 0:1e42d79b42e1 8 Serial pc(USBTX, USBRX);
rba90 0:1e42d79b42e1 9
rba90 0:1e42d79b42e1 10 // sip uses two buffer queues
rba90 0:1e42d79b42e1 11 CircularBuffer<uint8_t> SerialInputBuffer;
rba90 0:1e42d79b42e1 12 CircularBuffer<uint8_t> SerialOutputBuffer;
rba90 0:1e42d79b42e1 13 SerialInterfaceProtocol SIP(&SerialInputBuffer, &SerialOutputBuffer);
rba90 0:1e42d79b42e1 14
rba90 0:1e42d79b42e1 15 // aloha transceiver
rba90 8:332099ece6e9 16 AlohaTransceiver aloha(DEVICE_ID);
rba90 0:1e42d79b42e1 17 AlohaFrame txFrame;
rba90 0:1e42d79b42e1 18
rba90 19:6a59fb0ee921 19 // convert fp32 to 4 byte string
rba90 19:6a59fb0ee921 20 typedef union
rba90 19:6a59fb0ee921 21 {
rba90 19:6a59fb0ee921 22 float fp32;
rba90 19:6a59fb0ee921 23 uint8_t bytes[4];
rba90 19:6a59fb0ee921 24 } float_bytes_32;
rba90 19:6a59fb0ee921 25
rba90 19:6a59fb0ee921 26 typedef union
rba90 19:6a59fb0ee921 27 {
rba90 19:6a59fb0ee921 28 int16_t int16;
rba90 19:6a59fb0ee921 29 uint8_t bytes[2];
rba90 19:6a59fb0ee921 30 } int_string_16;
rba90 19:6a59fb0ee921 31
rba90 19:6a59fb0ee921 32
rba90 0:1e42d79b42e1 33 void serialInterruptHandler() {
rba90 0:1e42d79b42e1 34 // Note: you need to actually read from the serial to clear the RX interrupt
rba90 0:1e42d79b42e1 35 int c = pc.getc();
rba90 0:1e42d79b42e1 36
rba90 0:1e42d79b42e1 37 // add to buffer
rba90 0:1e42d79b42e1 38 if (SerialInputBuffer.isLocked())
rba90 0:1e42d79b42e1 39 {
rba90 0:1e42d79b42e1 40 printf("Mutex Locked\r\n");
rba90 0:1e42d79b42e1 41 }
rba90 0:1e42d79b42e1 42 else
rba90 0:1e42d79b42e1 43 {
rba90 0:1e42d79b42e1 44 SerialInputBuffer.enqueue((uint8_t) c);
rba90 0:1e42d79b42e1 45 }
rba90 0:1e42d79b42e1 46 }
rba90 0:1e42d79b42e1 47
rba90 0:1e42d79b42e1 48 int toggleChecksum(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length)
rba90 0:1e42d79b42e1 49 {
rba90 0:1e42d79b42e1 50 // one payload
rba90 0:1e42d79b42e1 51 if (payload_length != 1)
rba90 0:1e42d79b42e1 52 {
rba90 0:1e42d79b42e1 53 sprintf((char *) response, "Wrong Payload Length\r\n");
rba90 0:1e42d79b42e1 54 *response_length = 22;
rba90 0:1e42d79b42e1 55 return 1;
rba90 0:1e42d79b42e1 56 }
rba90 0:1e42d79b42e1 57
rba90 0:1e42d79b42e1 58 if ((bool) payload[0])
rba90 0:1e42d79b42e1 59 {
rba90 0:1e42d79b42e1 60 SIP.enableChecksum();
rba90 0:1e42d79b42e1 61 }
rba90 0:1e42d79b42e1 62 else
rba90 0:1e42d79b42e1 63 {
rba90 0:1e42d79b42e1 64 SIP.disableChecksum();
rba90 0:1e42d79b42e1 65 }
rba90 0:1e42d79b42e1 66
rba90 0:1e42d79b42e1 67 return 0;
rba90 0:1e42d79b42e1 68 }
rba90 0:1e42d79b42e1 69
rba90 9:e13e02aa4a2f 70 /*
rba90 9:e13e02aa4a2f 71 * Format:
rba90 14:25e836a5a7bf 72 * < : start flag
rba90 14:25e836a5a7bf 73 * 02 : command
rba90 14:25e836a5a7bf 74 * xx : length
rba90 14:25e836a5a7bf 75 * xx: : 00: get, 01: set
rba90 14:25e836a5a7bf 76 * xx : index for parameters
rba90 9:e13e02aa4a2f 77 * ...
rba90 14:25e836a5a7bf 78 * ff :checksum (not currently in used)
rba90 9:e13e02aa4a2f 79 * > :end flag
rba90 9:e13e02aa4a2f 80 */
rba90 9:e13e02aa4a2f 81 int configureRadio(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length)
rba90 9:e13e02aa4a2f 82 {
rba90 9:e13e02aa4a2f 83 // read settings from radio
rba90 9:e13e02aa4a2f 84 #if USE_MODEM_LORA == 1
rba90 9:e13e02aa4a2f 85 AlohaTransceiver::LoRaSettings_t *settings = aloha.getSettings();
rba90 9:e13e02aa4a2f 86 #elif USE_MODEM_FSK == 1
rba90 9:e13e02aa4a2f 87 AlohaTransceiver::FskSettings_t *settings = aloha.getSettings();
rba90 9:e13e02aa4a2f 88 #else
rba90 9:e13e02aa4a2f 89 #error "Please define a modem in the compiler options."
rba90 9:e13e02aa4a2f 90 #endif
rba90 9:e13e02aa4a2f 91
rba90 9:e13e02aa4a2f 92 if (payload_length < 2)
rba90 9:e13e02aa4a2f 93 {
rba90 9:e13e02aa4a2f 94 sprintf((char *) response, "Wrong Payload Length\r\n");
rba90 9:e13e02aa4a2f 95 *response_length = 22;
rba90 9:e13e02aa4a2f 96 return 1;
rba90 9:e13e02aa4a2f 97 }
rba90 9:e13e02aa4a2f 98
rba90 9:e13e02aa4a2f 99 // true is set, false is get
rba90 9:e13e02aa4a2f 100 bool isSet = (bool) payload[0];
rba90 9:e13e02aa4a2f 101 uint8_t idx = payload[1];
rba90 9:e13e02aa4a2f 102
rba90 9:e13e02aa4a2f 103 switch(idx)
rba90 9:e13e02aa4a2f 104 {
rba90 9:e13e02aa4a2f 105 case 0x00: // Power
rba90 9:e13e02aa4a2f 106 {
rba90 9:e13e02aa4a2f 107 if (isSet)
rba90 9:e13e02aa4a2f 108 {
rba90 9:e13e02aa4a2f 109 int8_t Power = (int8_t) payload[2];
rba90 9:e13e02aa4a2f 110 settings->Power = Power;
rba90 9:e13e02aa4a2f 111
rba90 9:e13e02aa4a2f 112 return 0;
rba90 9:e13e02aa4a2f 113 }
rba90 9:e13e02aa4a2f 114 else
rba90 9:e13e02aa4a2f 115 {
rba90 9:e13e02aa4a2f 116 response[0] = (uint8_t) settings->Power;
rba90 9:e13e02aa4a2f 117 *response_length = 1;
rba90 9:e13e02aa4a2f 118
rba90 9:e13e02aa4a2f 119 return 0;
rba90 9:e13e02aa4a2f 120 }
rba90 9:e13e02aa4a2f 121 }
rba90 9:e13e02aa4a2f 122
rba90 9:e13e02aa4a2f 123 case 0x01: // Bandwidth
rba90 9:e13e02aa4a2f 124 {
rba90 9:e13e02aa4a2f 125 if (isSet)
rba90 9:e13e02aa4a2f 126 {
rba90 9:e13e02aa4a2f 127 uint32_t Bandwidth = (payload[5]) |
rba90 9:e13e02aa4a2f 128 (payload[4] << 8) |
rba90 9:e13e02aa4a2f 129 (payload[3] << 16) |
rba90 9:e13e02aa4a2f 130 (payload[2] << 24);
rba90 9:e13e02aa4a2f 131 settings->Bandwidth = Bandwidth;
rba90 9:e13e02aa4a2f 132
rba90 9:e13e02aa4a2f 133 return 0;
rba90 9:e13e02aa4a2f 134 }
rba90 9:e13e02aa4a2f 135 else
rba90 9:e13e02aa4a2f 136 {
rba90 9:e13e02aa4a2f 137 response[3] = (uint8_t) (settings->Bandwidth);
rba90 9:e13e02aa4a2f 138 response[2] = (uint8_t) (settings->Bandwidth >> 8);
rba90 9:e13e02aa4a2f 139 response[1] = (uint8_t) (settings->Bandwidth >> 16);
rba90 9:e13e02aa4a2f 140 response[0] = (uint8_t) (settings->Bandwidth >> 24);
rba90 9:e13e02aa4a2f 141 *response_length = 4;
rba90 9:e13e02aa4a2f 142
rba90 9:e13e02aa4a2f 143 return 0;
rba90 9:e13e02aa4a2f 144 }
rba90 9:e13e02aa4a2f 145
rba90 9:e13e02aa4a2f 146 }
rba90 9:e13e02aa4a2f 147
rba90 9:e13e02aa4a2f 148 case 0x02: // Datarate, AKA Spreading Factor
rba90 9:e13e02aa4a2f 149 {
rba90 9:e13e02aa4a2f 150 if (isSet)
rba90 9:e13e02aa4a2f 151 {
rba90 9:e13e02aa4a2f 152 uint32_t Datarate = (payload[5]) |
rba90 9:e13e02aa4a2f 153 (payload[4] << 8) |
rba90 9:e13e02aa4a2f 154 (payload[3] << 16) |
rba90 9:e13e02aa4a2f 155 (payload[2] << 24);
rba90 9:e13e02aa4a2f 156 settings->Datarate = Datarate;
rba90 9:e13e02aa4a2f 157
rba90 9:e13e02aa4a2f 158 return 0;
rba90 9:e13e02aa4a2f 159 }
rba90 9:e13e02aa4a2f 160 else
rba90 9:e13e02aa4a2f 161 {
rba90 9:e13e02aa4a2f 162 response[3] = (uint8_t) (settings->Datarate);
rba90 9:e13e02aa4a2f 163 response[2] = (uint8_t) (settings->Datarate >> 8);
rba90 9:e13e02aa4a2f 164 response[1] = (uint8_t) (settings->Datarate >> 16);
rba90 9:e13e02aa4a2f 165 response[0] = (uint8_t) (settings->Datarate >> 24);
rba90 9:e13e02aa4a2f 166 *response_length = 4;
rba90 9:e13e02aa4a2f 167
rba90 9:e13e02aa4a2f 168 return 0;
rba90 9:e13e02aa4a2f 169 }
rba90 9:e13e02aa4a2f 170 }
rba90 9:e13e02aa4a2f 171
rba90 9:e13e02aa4a2f 172 case 0x03: // Coderate
rba90 9:e13e02aa4a2f 173 {
rba90 9:e13e02aa4a2f 174 if (isSet)
rba90 9:e13e02aa4a2f 175 {
rba90 9:e13e02aa4a2f 176 uint8_t Coderate = payload[2];
rba90 9:e13e02aa4a2f 177 settings->Coderate = Coderate;
rba90 9:e13e02aa4a2f 178
rba90 9:e13e02aa4a2f 179 return 0;
rba90 9:e13e02aa4a2f 180 }
rba90 9:e13e02aa4a2f 181 else
rba90 9:e13e02aa4a2f 182 {
rba90 9:e13e02aa4a2f 183 response[0] = (uint8_t) settings->Coderate;
rba90 9:e13e02aa4a2f 184 *response_length = 1;
rba90 9:e13e02aa4a2f 185
rba90 9:e13e02aa4a2f 186 return 0;
rba90 9:e13e02aa4a2f 187 }
rba90 9:e13e02aa4a2f 188 }
rba90 9:e13e02aa4a2f 189
rba90 9:e13e02aa4a2f 190 case 0x04: //Preamble Length
rba90 9:e13e02aa4a2f 191 {
rba90 9:e13e02aa4a2f 192 if (isSet)
rba90 9:e13e02aa4a2f 193 {
rba90 9:e13e02aa4a2f 194 uint16_t PreambleLen = payload[3] | (payload[2] << 8);
rba90 9:e13e02aa4a2f 195 settings->PreambleLen = PreambleLen;
rba90 9:e13e02aa4a2f 196 return 0;
rba90 9:e13e02aa4a2f 197 }
rba90 9:e13e02aa4a2f 198 else
rba90 9:e13e02aa4a2f 199 {
rba90 9:e13e02aa4a2f 200 response[1] = (uint8_t) (settings->PreambleLen);
rba90 9:e13e02aa4a2f 201 response[0] = (uint8_t)(settings->PreambleLen >> 8);
rba90 9:e13e02aa4a2f 202 *response_length = 2;
rba90 9:e13e02aa4a2f 203
rba90 9:e13e02aa4a2f 204 return 0;
rba90 9:e13e02aa4a2f 205 }
rba90 9:e13e02aa4a2f 206 }
rba90 9:e13e02aa4a2f 207
rba90 9:e13e02aa4a2f 208 case 0x05: //Symbol Timeout
rba90 9:e13e02aa4a2f 209 {
rba90 9:e13e02aa4a2f 210 if (isSet)
rba90 9:e13e02aa4a2f 211 {
rba90 9:e13e02aa4a2f 212 uint16_t SymbolTimeout = payload[3] | (payload[2] << 8);
rba90 9:e13e02aa4a2f 213 settings->SymbolTimeout = SymbolTimeout;
rba90 9:e13e02aa4a2f 214 return 0;
rba90 9:e13e02aa4a2f 215 }
rba90 9:e13e02aa4a2f 216 else
rba90 9:e13e02aa4a2f 217 {
rba90 9:e13e02aa4a2f 218 response[1] = (uint8_t) (settings->SymbolTimeout);
rba90 9:e13e02aa4a2f 219 response[0] = (uint8_t) (settings->SymbolTimeout >> 8);
rba90 9:e13e02aa4a2f 220 *response_length = 2;
rba90 9:e13e02aa4a2f 221
rba90 9:e13e02aa4a2f 222 return 0;
rba90 9:e13e02aa4a2f 223 }
rba90 9:e13e02aa4a2f 224 }
rba90 9:e13e02aa4a2f 225
rba90 9:e13e02aa4a2f 226 case 0x06: //FixLen
rba90 9:e13e02aa4a2f 227 {
rba90 9:e13e02aa4a2f 228 if (isSet)
rba90 9:e13e02aa4a2f 229 {
rba90 9:e13e02aa4a2f 230 bool FixLen = payload[2];
rba90 9:e13e02aa4a2f 231 settings->FixLen = FixLen;
rba90 9:e13e02aa4a2f 232 return 0;
rba90 9:e13e02aa4a2f 233 }
rba90 9:e13e02aa4a2f 234 else
rba90 9:e13e02aa4a2f 235 {
rba90 9:e13e02aa4a2f 236 response[0] = (bool) (settings->SymbolTimeout);
rba90 9:e13e02aa4a2f 237 *response_length = 1;
rba90 9:e13e02aa4a2f 238
rba90 9:e13e02aa4a2f 239 return 0;
rba90 9:e13e02aa4a2f 240 }
rba90 9:e13e02aa4a2f 241 }
rba90 9:e13e02aa4a2f 242
rba90 9:e13e02aa4a2f 243 case 0x07: //PayloadLen
rba90 9:e13e02aa4a2f 244 {
rba90 9:e13e02aa4a2f 245 if (isSet)
rba90 9:e13e02aa4a2f 246 {
rba90 9:e13e02aa4a2f 247 uint8_t PayloadLen = payload[2];
rba90 9:e13e02aa4a2f 248 settings->PayloadLen = PayloadLen;
rba90 9:e13e02aa4a2f 249 return 0;
rba90 9:e13e02aa4a2f 250 }
rba90 9:e13e02aa4a2f 251 else
rba90 9:e13e02aa4a2f 252 {
rba90 9:e13e02aa4a2f 253 response[0] = (uint8_t) (settings->PayloadLen);
rba90 9:e13e02aa4a2f 254
rba90 9:e13e02aa4a2f 255 return 0;
rba90 9:e13e02aa4a2f 256 }
rba90 9:e13e02aa4a2f 257 }
rba90 9:e13e02aa4a2f 258
rba90 9:e13e02aa4a2f 259 case 0x08: //CrcOn
rba90 9:e13e02aa4a2f 260 {
rba90 9:e13e02aa4a2f 261 if (isSet) {
rba90 9:e13e02aa4a2f 262 bool CrcOn = payload[2];
rba90 9:e13e02aa4a2f 263 settings->CrcOn = CrcOn;
rba90 9:e13e02aa4a2f 264 return 0;
rba90 9:e13e02aa4a2f 265 }
rba90 9:e13e02aa4a2f 266 else
rba90 9:e13e02aa4a2f 267 {
rba90 9:e13e02aa4a2f 268 response[0] = (bool) (settings->CrcOn);
rba90 9:e13e02aa4a2f 269
rba90 9:e13e02aa4a2f 270 return 0;
rba90 9:e13e02aa4a2f 271 }
rba90 9:e13e02aa4a2f 272 }
rba90 9:e13e02aa4a2f 273
rba90 9:e13e02aa4a2f 274 case 0x09: //FreqHopOn
rba90 9:e13e02aa4a2f 275 {
rba90 9:e13e02aa4a2f 276 if (isSet) {
rba90 9:e13e02aa4a2f 277 bool FreqHopOn = payload[2];
rba90 9:e13e02aa4a2f 278 settings->FreqHopOn = FreqHopOn;
rba90 9:e13e02aa4a2f 279 return 0;
rba90 9:e13e02aa4a2f 280 }
rba90 9:e13e02aa4a2f 281 else
rba90 9:e13e02aa4a2f 282 {
rba90 9:e13e02aa4a2f 283 response[0] = (bool) (settings->FreqHopOn);
rba90 9:e13e02aa4a2f 284
rba90 9:e13e02aa4a2f 285 return 0;
rba90 9:e13e02aa4a2f 286 }
rba90 9:e13e02aa4a2f 287 }
rba90 9:e13e02aa4a2f 288
rba90 9:e13e02aa4a2f 289 case 0x0A: //HopPeriod
rba90 9:e13e02aa4a2f 290 {
rba90 9:e13e02aa4a2f 291 if (isSet) {
rba90 9:e13e02aa4a2f 292 uint8_t HopPeriod = payload[2];
rba90 9:e13e02aa4a2f 293 settings->HopPeriod = HopPeriod;
rba90 9:e13e02aa4a2f 294 return 0;
rba90 9:e13e02aa4a2f 295 }
rba90 9:e13e02aa4a2f 296 else
rba90 9:e13e02aa4a2f 297 {
rba90 9:e13e02aa4a2f 298 response[0] = (uint8_t) (settings->HopPeriod);
rba90 9:e13e02aa4a2f 299 return 0;
rba90 9:e13e02aa4a2f 300 }
rba90 9:e13e02aa4a2f 301 }
rba90 9:e13e02aa4a2f 302
rba90 9:e13e02aa4a2f 303 case 0x0B: //IqInverted
rba90 9:e13e02aa4a2f 304 {
rba90 9:e13e02aa4a2f 305 if (isSet) {
rba90 9:e13e02aa4a2f 306 bool IqInverted = payload[2];
rba90 9:e13e02aa4a2f 307 settings->IqInverted = IqInverted;
rba90 9:e13e02aa4a2f 308 return 0;
rba90 9:e13e02aa4a2f 309 }
rba90 9:e13e02aa4a2f 310 else
rba90 9:e13e02aa4a2f 311 {
rba90 9:e13e02aa4a2f 312 response[0] = (bool) (settings->IqInverted);
rba90 9:e13e02aa4a2f 313 return 0;
rba90 9:e13e02aa4a2f 314 }
rba90 9:e13e02aa4a2f 315 }
rba90 9:e13e02aa4a2f 316
rba90 9:e13e02aa4a2f 317 case 0x0C: //RxContinuous
rba90 9:e13e02aa4a2f 318 {
rba90 9:e13e02aa4a2f 319 if(isSet)
rba90 9:e13e02aa4a2f 320 {
rba90 9:e13e02aa4a2f 321 bool RxContinuous = payload[2];
rba90 9:e13e02aa4a2f 322 settings->RxContinuous = RxContinuous;
rba90 9:e13e02aa4a2f 323 return 0;
rba90 9:e13e02aa4a2f 324 }
rba90 9:e13e02aa4a2f 325 else
rba90 9:e13e02aa4a2f 326 {
rba90 9:e13e02aa4a2f 327 response[0] = (bool) (settings->RxContinuous);
rba90 9:e13e02aa4a2f 328 return 0;
rba90 9:e13e02aa4a2f 329 }
rba90 9:e13e02aa4a2f 330 }
rba90 9:e13e02aa4a2f 331
rba90 9:e13e02aa4a2f 332 case 0x0D: //TxTimeout
rba90 9:e13e02aa4a2f 333 {
rba90 9:e13e02aa4a2f 334 if (isSet)
rba90 9:e13e02aa4a2f 335 {
rba90 9:e13e02aa4a2f 336 uint32_t TxTimeout = (payload[5]) |
rba90 9:e13e02aa4a2f 337 (payload[4] << 8) |
rba90 9:e13e02aa4a2f 338 (payload[3] << 16) |
rba90 9:e13e02aa4a2f 339 (payload[2] << 24);
rba90 9:e13e02aa4a2f 340 settings->TxTimeout = TxTimeout;
rba90 9:e13e02aa4a2f 341 return 0;
rba90 9:e13e02aa4a2f 342 }
rba90 9:e13e02aa4a2f 343 else
rba90 9:e13e02aa4a2f 344 {
rba90 9:e13e02aa4a2f 345 response[3] = (uint8_t) (settings->TxTimeout);
rba90 9:e13e02aa4a2f 346 response[2] = (uint8_t) (settings->TxTimeout >> 8);
rba90 9:e13e02aa4a2f 347 response[1] = (uint8_t) (settings->TxTimeout >> 16);
rba90 9:e13e02aa4a2f 348 response[0] = (uint8_t) (settings->TxTimeout >> 24);
rba90 9:e13e02aa4a2f 349 *response_length = 4;
rba90 9:e13e02aa4a2f 350
rba90 9:e13e02aa4a2f 351 return 0;
rba90 9:e13e02aa4a2f 352 }
rba90 9:e13e02aa4a2f 353 }
rba90 9:e13e02aa4a2f 354
rba90 9:e13e02aa4a2f 355
rba90 9:e13e02aa4a2f 356 default:
rba90 9:e13e02aa4a2f 357 {
rba90 9:e13e02aa4a2f 358 break;
rba90 9:e13e02aa4a2f 359 }
rba90 9:e13e02aa4a2f 360
rba90 9:e13e02aa4a2f 361 //case
rba90 9:e13e02aa4a2f 362 }
rba90 9:e13e02aa4a2f 363
rba90 9:e13e02aa4a2f 364
rba90 9:e13e02aa4a2f 365 return 0;
rba90 9:e13e02aa4a2f 366 }
rba90 9:e13e02aa4a2f 367
rba90 9:e13e02aa4a2f 368 int radioUpdateSettings(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length)
rba90 9:e13e02aa4a2f 369 {
rba90 9:e13e02aa4a2f 370 aloha.updateSettings();
rba90 9:e13e02aa4a2f 371
rba90 9:e13e02aa4a2f 372 return 0;
rba90 9:e13e02aa4a2f 373 }
rba90 9:e13e02aa4a2f 374
rba90 14:25e836a5a7bf 375 /*
rba90 14:25e836a5a7bf 376 * Format:
rba90 14:25e836a5a7bf 377 * < : start flag
rba90 14:25e836a5a7bf 378 * 04 : command
rba90 14:25e836a5a7bf 379 * 02 : length (2 bytes in this case)
rba90 14:25e836a5a7bf 380 * 00/01 : query for temperature or door sensor
rba90 14:25e836a5a7bf 381 * xx : node to query
rba90 14:25e836a5a7bf 382 * ff : checksum (not currently in used)
rba90 14:25e836a5a7bf 383 * > : end flag
rba90 14:25e836a5a7bf 384 */
rba90 14:25e836a5a7bf 385 int querySensors(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length)
rba90 6:19457108c899 386 {
rba90 14:25e836a5a7bf 387 // check with payloads
rba90 14:25e836a5a7bf 388 if (payload_length != 2)
rba90 14:25e836a5a7bf 389 {
rba90 14:25e836a5a7bf 390 sprintf((char *) response, "Wrong Payload Length");
rba90 14:25e836a5a7bf 391 *response_length = 20;
rba90 14:25e836a5a7bf 392 return 1;
rba90 14:25e836a5a7bf 393 }
rba90 14:25e836a5a7bf 394
rba90 14:25e836a5a7bf 395 // decode the user message
rba90 23:378bd4d025d0 396 uint8_t source_type = payload[0];
rba90 14:25e836a5a7bf 397 uint8_t node_id = payload[1];
rba90 6:19457108c899 398
rba90 14:25e836a5a7bf 399 // create a command packet
rba90 14:25e836a5a7bf 400 ControlPacket packet;
rba90 14:25e836a5a7bf 401
rba90 14:25e836a5a7bf 402 // sequence id is not in used in this case
rba90 14:25e836a5a7bf 403 packet.setSequenceID(0x0);
rba90 14:25e836a5a7bf 404
rba90 14:25e836a5a7bf 405 // set source id as current device id
rba90 14:25e836a5a7bf 406 packet.setSourceID(aloha.getDeviceID());
rba90 14:25e836a5a7bf 407
rba90 14:25e836a5a7bf 408 // set destination id as node id
rba90 14:25e836a5a7bf 409 packet.setDestinationID(node_id);
rba90 6:19457108c899 410
rba90 19:6a59fb0ee921 411 // set command as query (0 in this case)
rba90 19:6a59fb0ee921 412 packet.setCommand(0x0);
rba90 6:19457108c899 413
rba90 14:25e836a5a7bf 414 // store sensor type in data block 0
rba90 23:378bd4d025d0 415 packet.setData(0, source_type);
rba90 14:25e836a5a7bf 416
rba90 14:25e836a5a7bf 417 // generate crc
rba90 14:25e836a5a7bf 418 packet.generateCrc();
rba90 14:25e836a5a7bf 419
rba90 14:25e836a5a7bf 420 // create buffer for transmission
rba90 14:25e836a5a7bf 421 uint8_t buffer[8];
rba90 6:19457108c899 422 memset(buffer, 0x0, sizeof(buffer));
rba90 6:19457108c899 423
rba90 14:25e836a5a7bf 424 // copy bytes into buffer
rba90 14:25e836a5a7bf 425 packet.serialize(buffer);
rba90 14:25e836a5a7bf 426
rba90 14:25e836a5a7bf 427 // send to aloha transceiver
rba90 14:25e836a5a7bf 428 aloha.send(buffer, 8, node_id);
rba90 11:9590f3c9d915 429
rba90 11:9590f3c9d915 430 return 0;
rba90 11:9590f3c9d915 431 }
rba90 11:9590f3c9d915 432
rba90 19:6a59fb0ee921 433 int queryServiceQuality(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length)
rba90 19:6a59fb0ee921 434 {
rba90 19:6a59fb0ee921 435 // decode user message
rba90 19:6a59fb0ee921 436 uint8_t node_id = payload[0];
rba90 23:378bd4d025d0 437 uint8_t source_type = 0x2; // query for service quality
rba90 19:6a59fb0ee921 438
rba90 19:6a59fb0ee921 439 // create a command packet
rba90 19:6a59fb0ee921 440 ControlPacket packet;
rba90 19:6a59fb0ee921 441
rba90 19:6a59fb0ee921 442 // layer 3 sequence id is not used in this case
rba90 19:6a59fb0ee921 443 packet.setSequenceID(0x0);
rba90 19:6a59fb0ee921 444
rba90 19:6a59fb0ee921 445 // set source id as current device id
rba90 19:6a59fb0ee921 446 packet.setSourceID(aloha.getDeviceID());
rba90 19:6a59fb0ee921 447
rba90 19:6a59fb0ee921 448 // set destination id as node id
rba90 19:6a59fb0ee921 449 packet.setDestinationID(node_id);
rba90 19:6a59fb0ee921 450
rba90 23:378bd4d025d0 451 // set command as query (treat it similar to sensor)
rba90 23:378bd4d025d0 452 packet.setCommand(0x0);
rba90 23:378bd4d025d0 453
rba90 23:378bd4d025d0 454 // store sensor type in data block 0
rba90 23:378bd4d025d0 455 packet.setData(0, source_type);
rba90 19:6a59fb0ee921 456
rba90 19:6a59fb0ee921 457 // generate crc
rba90 19:6a59fb0ee921 458 packet.generateCrc();
rba90 19:6a59fb0ee921 459
rba90 19:6a59fb0ee921 460 // create buffer for transmission
rba90 19:6a59fb0ee921 461 uint8_t buffer[8];
rba90 19:6a59fb0ee921 462 memset(buffer, 0x0, sizeof(buffer));
rba90 19:6a59fb0ee921 463
rba90 19:6a59fb0ee921 464 // copy bytes into buffer
rba90 19:6a59fb0ee921 465 packet.serialize(buffer);
rba90 19:6a59fb0ee921 466
rba90 19:6a59fb0ee921 467 // send to aloha transceiver
rba90 19:6a59fb0ee921 468 aloha.send(buffer, 8, node_id);
rba90 19:6a59fb0ee921 469
rba90 19:6a59fb0ee921 470 return 0;
rba90 19:6a59fb0ee921 471 }
rba90 19:6a59fb0ee921 472
rba90 14:25e836a5a7bf 473 void AlohaDataPacketHandler(uint8_t *payload, uint8_t payload_length, uint8_t src_addr)
rba90 14:25e836a5a7bf 474 {
rba90 14:25e836a5a7bf 475 // try to decode packet
rba90 14:25e836a5a7bf 476 BasicPacket packet(payload);
rba90 2:ae85337d4ca7 477
rba90 14:25e836a5a7bf 478 // verify crc
rba90 15:182b95c25cf2 479 // skip this for now
rba90 14:25e836a5a7bf 480
rba90 14:25e836a5a7bf 481 // process the packet based on different feature id
rba90 14:25e836a5a7bf 482 BasicPacket::L3Fid_t fid = (BasicPacket::L3Fid_t) packet.getFid();
rba90 2:ae85337d4ca7 483
rba90 14:25e836a5a7bf 484 // we don't care about the type conversion. just create a new one.
rba90 14:25e836a5a7bf 485 switch (fid)
rba90 3:a4f6abad9378 486 {
rba90 14:25e836a5a7bf 487 case BasicPacket::L3ControlPacket:
rba90 14:25e836a5a7bf 488 {
rba90 14:25e836a5a7bf 489 ControlPacket controlPacket(payload);
rba90 14:25e836a5a7bf 490
rba90 19:6a59fb0ee921 491 // execute command
rba90 19:6a59fb0ee921 492 uint8_t command = controlPacket.getCommand();
rba90 19:6a59fb0ee921 493 switch(command)
rba90 19:6a59fb0ee921 494 {
rba90 23:378bd4d025d0 495 case 0x0: // query
rba90 19:6a59fb0ee921 496 {
rba90 23:378bd4d025d0 497 // execute query
rba90 23:378bd4d025d0 498 uint8_t sensor_type = controlPacket.getData(0);
rba90 23:378bd4d025d0 499 switch (sensor_type)
rba90 23:378bd4d025d0 500 {
rba90 23:378bd4d025d0 501 case 0x0: // temperature: NULL
rba90 23:378bd4d025d0 502 {
rba90 23:378bd4d025d0 503 break;
rba90 23:378bd4d025d0 504 }
rba90 23:378bd4d025d0 505 case 0x1: // door: NULL
rba90 23:378bd4d025d0 506 {
rba90 23:378bd4d025d0 507 break;
rba90 23:378bd4d025d0 508 }
rba90 23:378bd4d025d0 509 case 0x2: // service quality
rba90 23:378bd4d025d0 510 {
rba90 23:378bd4d025d0 511 int_string_16 rssi;
rba90 23:378bd4d025d0 512 uint8_t snr;
rba90 23:378bd4d025d0 513
rba90 23:378bd4d025d0 514 // get rssi and snr
rba90 23:378bd4d025d0 515 rssi.int16 = aloha.getRssi();
rba90 23:378bd4d025d0 516 snr = aloha.getSnr();
rba90 23:378bd4d025d0 517
rba90 23:378bd4d025d0 518 // create a response
rba90 23:378bd4d025d0 519 DataBlockPacket response;
rba90 23:378bd4d025d0 520
rba90 23:378bd4d025d0 521 // set sequence id (the sequence id is configured as incoming sequence id + 1)
rba90 23:378bd4d025d0 522 response.setSequenceID(controlPacket.getSequenceID() + 1);
rba90 23:378bd4d025d0 523
rba90 23:378bd4d025d0 524 // set source id (the source id is the current device ID)
rba90 23:378bd4d025d0 525 response.setSourceID(aloha.getDeviceID());
rba90 23:378bd4d025d0 526
rba90 23:378bd4d025d0 527 // set destination id (the destination ID is the original source address)
rba90 23:378bd4d025d0 528 response.setDestinationID(controlPacket.getSourceID());
rba90 23:378bd4d025d0 529
rba90 23:378bd4d025d0 530 // set source type (service quality)
rba90 23:378bd4d025d0 531 response.setSourceType(0x2);
rba90 23:378bd4d025d0 532
rba90 23:378bd4d025d0 533 // set payload type (byte)
rba90 23:378bd4d025d0 534 response.setPayloadType(0x0);
rba90 23:378bd4d025d0 535
rba90 23:378bd4d025d0 536 // set payload
rba90 23:378bd4d025d0 537 response.setData(0, (uint8_t) snr); // store SNR
rba90 23:378bd4d025d0 538 response.setData(1, (uint8_t) rssi.bytes[0]); // store higher bits of RSSI
rba90 23:378bd4d025d0 539 response.setData(2, (uint8_t) rssi.bytes[1]); // store lower bits of RSSI
rba90 23:378bd4d025d0 540
rba90 23:378bd4d025d0 541 // calculate crc
rba90 23:378bd4d025d0 542 response.generateCrc();
rba90 23:378bd4d025d0 543
rba90 23:378bd4d025d0 544 // serialize and send it
rba90 23:378bd4d025d0 545 uint8_t buffer[8];
rba90 23:378bd4d025d0 546 memset(buffer, 0x0, sizeof(buffer));
rba90 23:378bd4d025d0 547
rba90 23:378bd4d025d0 548 // copy bytes into buffer
rba90 23:378bd4d025d0 549 response.serialize(buffer);
rba90 23:378bd4d025d0 550
rba90 23:378bd4d025d0 551 // send to aloha transceiver
rba90 23:378bd4d025d0 552 aloha.send(buffer, 8, src_addr);
rba90 23:378bd4d025d0 553
rba90 23:378bd4d025d0 554 break;
rba90 23:378bd4d025d0 555 }
rba90 23:378bd4d025d0 556
rba90 23:378bd4d025d0 557 default:
rba90 23:378bd4d025d0 558 break;
rba90 23:378bd4d025d0 559 }
rba90 19:6a59fb0ee921 560
rba90 19:6a59fb0ee921 561 break;
rba90 19:6a59fb0ee921 562 }
rba90 23:378bd4d025d0 563
rba90 19:6a59fb0ee921 564 default:
rba90 19:6a59fb0ee921 565 break;
rba90 19:6a59fb0ee921 566 }
rba90 14:25e836a5a7bf 567
rba90 14:25e836a5a7bf 568 break;
rba90 14:25e836a5a7bf 569 }
rba90 19:6a59fb0ee921 570
rba90 14:25e836a5a7bf 571 case BasicPacket::L3DataBlockPacket:
rba90 14:25e836a5a7bf 572 {
rba90 14:25e836a5a7bf 573 DataBlockPacket dataBlockPacket(payload);
rba90 14:25e836a5a7bf 574
rba90 23:378bd4d025d0 575 uint8_t source_type = dataBlockPacket.getSourceType();
rba90 23:378bd4d025d0 576 switch(source_type)
rba90 15:182b95c25cf2 577 {
rba90 15:182b95c25cf2 578 case 0x0: // temperature sensor
rba90 15:182b95c25cf2 579 {
rba90 16:ab2d9341997a 580 uint8_t payload[3];
rba90 16:ab2d9341997a 581
rba90 16:ab2d9341997a 582 // copy sensor type
rba90 23:378bd4d025d0 583 payload[0] = 0x0; // assume 0x00 is temperature sensor
rba90 16:ab2d9341997a 584
rba90 16:ab2d9341997a 585 // copy sensor data
rba90 23:378bd4d025d0 586 payload[1] = dataBlockPacket.getSourceID(); // assume we only use one byte
rba90 16:ab2d9341997a 587
rba90 16:ab2d9341997a 588 // copy address of source node
rba90 16:ab2d9341997a 589 payload[2] = dataBlockPacket.getData(0);
rba90 16:ab2d9341997a 590
rba90 16:ab2d9341997a 591 // make response
rba90 16:ab2d9341997a 592 SIP.respond(0xf0, payload, 3);
rba90 16:ab2d9341997a 593
rba90 15:182b95c25cf2 594 break;
rba90 15:182b95c25cf2 595 }
rba90 16:ab2d9341997a 596 case 0x1: // door sensor
rba90 15:182b95c25cf2 597 {
rba90 16:ab2d9341997a 598 uint8_t payload[3];
rba90 16:ab2d9341997a 599
rba90 16:ab2d9341997a 600 // copy sensor type
rba90 23:378bd4d025d0 601 payload[0] = 0x1;
rba90 16:ab2d9341997a 602
rba90 16:ab2d9341997a 603 // copy sensor data
rba90 23:378bd4d025d0 604 payload[1] = dataBlockPacket.getSourceID();
rba90 16:ab2d9341997a 605
rba90 16:ab2d9341997a 606 // copy address of source node
rba90 16:ab2d9341997a 607 payload[2] = dataBlockPacket.getData(0);
rba90 16:ab2d9341997a 608
rba90 16:ab2d9341997a 609 // make response
rba90 16:ab2d9341997a 610 SIP.respond(0xf0, payload, 3);
rba90 16:ab2d9341997a 611
rba90 15:182b95c25cf2 612 break;
rba90 15:182b95c25cf2 613 }
rba90 23:378bd4d025d0 614 case 0x2: // service quality
rba90 23:378bd4d025d0 615 {
rba90 23:378bd4d025d0 616 uint8_t payload[8];
rba90 23:378bd4d025d0 617
rba90 23:378bd4d025d0 618 // copy source type
rba90 23:378bd4d025d0 619 payload[0] = 0x2;
rba90 23:378bd4d025d0 620
rba90 23:378bd4d025d0 621 // copy sensor data
rba90 23:378bd4d025d0 622 payload[1] = dataBlockPacket.getSourceID();
rba90 23:378bd4d025d0 623
rba90 23:378bd4d025d0 624 // first byte is the snr of foreign host
rba90 23:378bd4d025d0 625 payload[2] = dataBlockPacket.getData(0);
rba90 23:378bd4d025d0 626
rba90 23:378bd4d025d0 627 // second and third byte are the rssi of foreign host
rba90 23:378bd4d025d0 628 payload[3] = dataBlockPacket.getData(1);
rba90 23:378bd4d025d0 629 payload[4] = dataBlockPacket.getData(2);
rba90 23:378bd4d025d0 630
rba90 23:378bd4d025d0 631 // fourth byte is the snr of local host
rba90 23:378bd4d025d0 632 payload[5] = (uint8_t) aloha.getSnr();
rba90 23:378bd4d025d0 633
rba90 23:378bd4d025d0 634 // fifth and sixth byte are the rssi of local host
rba90 23:378bd4d025d0 635 int_string_16 rssi;
rba90 23:378bd4d025d0 636 rssi.int16 = aloha.getRssi();
rba90 23:378bd4d025d0 637
rba90 23:378bd4d025d0 638 payload[6] = rssi.bytes[0];
rba90 23:378bd4d025d0 639 payload[7] = rssi.bytes[1];
rba90 23:378bd4d025d0 640
rba90 23:378bd4d025d0 641 // make response
rba90 23:378bd4d025d0 642 SIP.respond(0xf0, payload, 8);
rba90 23:378bd4d025d0 643
rba90 23:378bd4d025d0 644 break;
rba90 23:378bd4d025d0 645 }
rba90 23:378bd4d025d0 646
rba90 15:182b95c25cf2 647 default:
rba90 15:182b95c25cf2 648 break;
rba90 15:182b95c25cf2 649 }
rba90 15:182b95c25cf2 650
rba90 14:25e836a5a7bf 651 break;
rba90 14:25e836a5a7bf 652 }
rba90 14:25e836a5a7bf 653 default:
rba90 14:25e836a5a7bf 654 break;
rba90 3:a4f6abad9378 655 }
rba90 0:1e42d79b42e1 656 }
rba90 0:1e42d79b42e1 657
rba90 14:25e836a5a7bf 658
rba90 0:1e42d79b42e1 659 int main() {
rba90 0:1e42d79b42e1 660 // initialize radio module
rba90 5:445f35444a6a 661 aloha.boardInit();
rba90 6:19457108c899 662 aloha.updateSettings();
rba90 6:19457108c899 663 aloha.enable();
rba90 0:1e42d79b42e1 664
rba90 0:1e42d79b42e1 665 // attach serial interrupt handler
rba90 0:1e42d79b42e1 666 pc.attach(&serialInterruptHandler);
rba90 0:1e42d79b42e1 667
rba90 0:1e42d79b42e1 668 // register callback functions for SIP
rba90 0:1e42d79b42e1 669 SIP.registerCommand(0x00, toggleChecksum);
rba90 19:6a59fb0ee921 670 SIP.registerCommand(0x01, queryServiceQuality);
rba90 9:e13e02aa4a2f 671 SIP.registerCommand(0x02, configureRadio);
rba90 9:e13e02aa4a2f 672 SIP.registerCommand(0x03, radioUpdateSettings);
rba90 14:25e836a5a7bf 673 SIP.registerCommand(0x04, querySensors);
rba90 0:1e42d79b42e1 674
rba90 0:1e42d79b42e1 675 // register callback functions for aloha transceiver
rba90 14:25e836a5a7bf 676 aloha.registerType(AlohaFrame::Aloha_Data, AlohaDataPacketHandler);
rba90 0:1e42d79b42e1 677
rba90 0:1e42d79b42e1 678 while(1) {
rba90 0:1e42d79b42e1 679 SIP.poll();
rba90 0:1e42d79b42e1 680 aloha.poll();
rba90 0:1e42d79b42e1 681
rba90 0:1e42d79b42e1 682 while (SerialOutputBuffer.getCounter() > 0)
rba90 0:1e42d79b42e1 683 {
rba90 0:1e42d79b42e1 684 uint8_t ch;
rba90 0:1e42d79b42e1 685 ch = SerialOutputBuffer.dequeue();
rba90 0:1e42d79b42e1 686 pc.putc(ch);
rba90 0:1e42d79b42e1 687 }
rba90 0:1e42d79b42e1 688 }
rba90 0:1e42d79b42e1 689 }