![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
Wireless interface using LoRa technology
Dependencies: AlohaTransceiver RingBuffer SX1276Lib SerialInterfaceProtocol mbed L3PDU
main.cpp@30:7f0f887040a2, 2016-09-07 (annotated)
- Committer:
- rba90
- Date:
- Wed Sep 07 05:01:45 2016 +0000
- Revision:
- 30:7f0f887040a2
- Parent:
- 29:020355bfe3a6
update comments
Who changed what in which revision?
User | Revision | Line number | New 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 | 25:faa87315c44f | 420 | aloha.send(&packet); |
rba90 | 11:9590f3c9d915 | 421 | |
rba90 | 11:9590f3c9d915 | 422 | return 0; |
rba90 | 11:9590f3c9d915 | 423 | } |
rba90 | 11:9590f3c9d915 | 424 | |
rba90 | 19:6a59fb0ee921 | 425 | int queryServiceQuality(uint8_t *payload, uint8_t payload_length, uint8_t *response, uint8_t *response_length) |
rba90 | 19:6a59fb0ee921 | 426 | { |
rba90 | 19:6a59fb0ee921 | 427 | // decode user message |
rba90 | 19:6a59fb0ee921 | 428 | uint8_t node_id = payload[0]; |
rba90 | 23:378bd4d025d0 | 429 | uint8_t source_type = 0x2; // query for service quality |
rba90 | 19:6a59fb0ee921 | 430 | |
rba90 | 19:6a59fb0ee921 | 431 | // create a command packet |
rba90 | 19:6a59fb0ee921 | 432 | ControlPacket packet; |
rba90 | 19:6a59fb0ee921 | 433 | |
rba90 | 19:6a59fb0ee921 | 434 | // layer 3 sequence id is not used in this case |
rba90 | 19:6a59fb0ee921 | 435 | packet.setSequenceID(0x0); |
rba90 | 19:6a59fb0ee921 | 436 | |
rba90 | 19:6a59fb0ee921 | 437 | // set source id as current device id |
rba90 | 19:6a59fb0ee921 | 438 | packet.setSourceID(aloha.getDeviceID()); |
rba90 | 19:6a59fb0ee921 | 439 | |
rba90 | 19:6a59fb0ee921 | 440 | // set destination id as node id |
rba90 | 19:6a59fb0ee921 | 441 | packet.setDestinationID(node_id); |
rba90 | 19:6a59fb0ee921 | 442 | |
rba90 | 23:378bd4d025d0 | 443 | // set command as query (treat it similar to sensor) |
rba90 | 23:378bd4d025d0 | 444 | packet.setCommand(0x0); |
rba90 | 23:378bd4d025d0 | 445 | |
rba90 | 23:378bd4d025d0 | 446 | // store sensor type in data block 0 |
rba90 | 23:378bd4d025d0 | 447 | packet.setData(0, source_type); |
rba90 | 19:6a59fb0ee921 | 448 | |
rba90 | 19:6a59fb0ee921 | 449 | // generate crc |
rba90 | 19:6a59fb0ee921 | 450 | packet.generateCrc(); |
rba90 | 19:6a59fb0ee921 | 451 | |
rba90 | 25:faa87315c44f | 452 | aloha.send(&packet); |
rba90 | 19:6a59fb0ee921 | 453 | |
rba90 | 19:6a59fb0ee921 | 454 | return 0; |
rba90 | 19:6a59fb0ee921 | 455 | } |
rba90 | 19:6a59fb0ee921 | 456 | |
rba90 | 14:25e836a5a7bf | 457 | void AlohaDataPacketHandler(uint8_t *payload, uint8_t payload_length, uint8_t src_addr) |
rba90 | 14:25e836a5a7bf | 458 | { |
rba90 | 14:25e836a5a7bf | 459 | // try to decode packet |
rba90 | 14:25e836a5a7bf | 460 | BasicPacket packet(payload); |
rba90 | 2:ae85337d4ca7 | 461 | |
rba90 | 14:25e836a5a7bf | 462 | // verify crc |
rba90 | 15:182b95c25cf2 | 463 | // skip this for now |
rba90 | 14:25e836a5a7bf | 464 | |
rba90 | 14:25e836a5a7bf | 465 | // process the packet based on different feature id |
rba90 | 14:25e836a5a7bf | 466 | BasicPacket::L3Fid_t fid = (BasicPacket::L3Fid_t) packet.getFid(); |
rba90 | 2:ae85337d4ca7 | 467 | |
rba90 | 14:25e836a5a7bf | 468 | // we don't care about the type conversion. just create a new one. |
rba90 | 14:25e836a5a7bf | 469 | switch (fid) |
rba90 | 3:a4f6abad9378 | 470 | { |
rba90 | 14:25e836a5a7bf | 471 | case BasicPacket::L3ControlPacket: |
rba90 | 14:25e836a5a7bf | 472 | { |
rba90 | 14:25e836a5a7bf | 473 | ControlPacket controlPacket(payload); |
rba90 | 14:25e836a5a7bf | 474 | |
rba90 | 19:6a59fb0ee921 | 475 | // execute command |
rba90 | 19:6a59fb0ee921 | 476 | uint8_t command = controlPacket.getCommand(); |
rba90 | 19:6a59fb0ee921 | 477 | switch(command) |
rba90 | 19:6a59fb0ee921 | 478 | { |
rba90 | 23:378bd4d025d0 | 479 | case 0x0: // query |
rba90 | 19:6a59fb0ee921 | 480 | { |
rba90 | 23:378bd4d025d0 | 481 | // execute query |
rba90 | 23:378bd4d025d0 | 482 | uint8_t sensor_type = controlPacket.getData(0); |
rba90 | 23:378bd4d025d0 | 483 | switch (sensor_type) |
rba90 | 23:378bd4d025d0 | 484 | { |
rba90 | 23:378bd4d025d0 | 485 | case 0x0: // temperature: NULL |
rba90 | 23:378bd4d025d0 | 486 | { |
rba90 | 23:378bd4d025d0 | 487 | break; |
rba90 | 23:378bd4d025d0 | 488 | } |
rba90 | 23:378bd4d025d0 | 489 | case 0x1: // door: NULL |
rba90 | 23:378bd4d025d0 | 490 | { |
rba90 | 23:378bd4d025d0 | 491 | break; |
rba90 | 23:378bd4d025d0 | 492 | } |
rba90 | 23:378bd4d025d0 | 493 | case 0x2: // service quality |
rba90 | 23:378bd4d025d0 | 494 | { |
rba90 | 23:378bd4d025d0 | 495 | int_string_16 rssi; |
rba90 | 23:378bd4d025d0 | 496 | uint8_t snr; |
rba90 | 23:378bd4d025d0 | 497 | |
rba90 | 23:378bd4d025d0 | 498 | // get rssi and snr |
rba90 | 23:378bd4d025d0 | 499 | rssi.int16 = aloha.getRssi(); |
rba90 | 23:378bd4d025d0 | 500 | snr = aloha.getSnr(); |
rba90 | 23:378bd4d025d0 | 501 | |
rba90 | 23:378bd4d025d0 | 502 | // create a response |
rba90 | 23:378bd4d025d0 | 503 | DataBlockPacket response; |
rba90 | 23:378bd4d025d0 | 504 | |
rba90 | 23:378bd4d025d0 | 505 | // set sequence id (the sequence id is configured as incoming sequence id + 1) |
rba90 | 23:378bd4d025d0 | 506 | response.setSequenceID(controlPacket.getSequenceID() + 1); |
rba90 | 23:378bd4d025d0 | 507 | |
rba90 | 23:378bd4d025d0 | 508 | // set source id (the source id is the current device ID) |
rba90 | 23:378bd4d025d0 | 509 | response.setSourceID(aloha.getDeviceID()); |
rba90 | 23:378bd4d025d0 | 510 | |
rba90 | 23:378bd4d025d0 | 511 | // set destination id (the destination ID is the original source address) |
rba90 | 23:378bd4d025d0 | 512 | response.setDestinationID(controlPacket.getSourceID()); |
rba90 | 23:378bd4d025d0 | 513 | |
rba90 | 23:378bd4d025d0 | 514 | // set source type (service quality) |
rba90 | 23:378bd4d025d0 | 515 | response.setSourceType(0x2); |
rba90 | 23:378bd4d025d0 | 516 | |
rba90 | 23:378bd4d025d0 | 517 | // set payload type (byte) |
rba90 | 23:378bd4d025d0 | 518 | response.setPayloadType(0x0); |
rba90 | 23:378bd4d025d0 | 519 | |
rba90 | 23:378bd4d025d0 | 520 | // set payload |
rba90 | 23:378bd4d025d0 | 521 | response.setData(0, (uint8_t) snr); // store SNR |
rba90 | 23:378bd4d025d0 | 522 | response.setData(1, (uint8_t) rssi.bytes[0]); // store higher bits of RSSI |
rba90 | 23:378bd4d025d0 | 523 | response.setData(2, (uint8_t) rssi.bytes[1]); // store lower bits of RSSI |
rba90 | 23:378bd4d025d0 | 524 | |
rba90 | 23:378bd4d025d0 | 525 | // calculate crc |
rba90 | 23:378bd4d025d0 | 526 | response.generateCrc(); |
rba90 | 23:378bd4d025d0 | 527 | |
rba90 | 25:faa87315c44f | 528 | aloha.send(&response); |
rba90 | 23:378bd4d025d0 | 529 | |
rba90 | 23:378bd4d025d0 | 530 | break; |
rba90 | 23:378bd4d025d0 | 531 | } |
rba90 | 23:378bd4d025d0 | 532 | |
rba90 | 23:378bd4d025d0 | 533 | default: |
rba90 | 23:378bd4d025d0 | 534 | break; |
rba90 | 23:378bd4d025d0 | 535 | } |
rba90 | 19:6a59fb0ee921 | 536 | |
rba90 | 19:6a59fb0ee921 | 537 | break; |
rba90 | 19:6a59fb0ee921 | 538 | } |
rba90 | 23:378bd4d025d0 | 539 | |
rba90 | 19:6a59fb0ee921 | 540 | default: |
rba90 | 19:6a59fb0ee921 | 541 | break; |
rba90 | 19:6a59fb0ee921 | 542 | } |
rba90 | 14:25e836a5a7bf | 543 | |
rba90 | 14:25e836a5a7bf | 544 | break; |
rba90 | 14:25e836a5a7bf | 545 | } |
rba90 | 19:6a59fb0ee921 | 546 | |
rba90 | 14:25e836a5a7bf | 547 | case BasicPacket::L3DataBlockPacket: |
rba90 | 14:25e836a5a7bf | 548 | { |
rba90 | 14:25e836a5a7bf | 549 | DataBlockPacket dataBlockPacket(payload); |
rba90 | 14:25e836a5a7bf | 550 | |
rba90 | 23:378bd4d025d0 | 551 | uint8_t source_type = dataBlockPacket.getSourceType(); |
rba90 | 23:378bd4d025d0 | 552 | switch(source_type) |
rba90 | 15:182b95c25cf2 | 553 | { |
rba90 | 15:182b95c25cf2 | 554 | case 0x0: // temperature sensor |
rba90 | 15:182b95c25cf2 | 555 | { |
rba90 | 28:0c59edd704a0 | 556 | uint8_t payload[9]; |
rba90 | 16:ab2d9341997a | 557 | |
rba90 | 16:ab2d9341997a | 558 | // copy sensor type |
rba90 | 23:378bd4d025d0 | 559 | payload[0] = 0x0; // assume 0x00 is temperature sensor |
rba90 | 16:ab2d9341997a | 560 | |
rba90 | 29:020355bfe3a6 | 561 | // copy source address |
rba90 | 23:378bd4d025d0 | 562 | payload[1] = dataBlockPacket.getSourceID(); // assume we only use one byte |
rba90 | 16:ab2d9341997a | 563 | |
rba90 | 29:020355bfe3a6 | 564 | // copy temperature |
rba90 | 28:0c59edd704a0 | 565 | for (uint8_t i = 0; i < 4; i++) |
rba90 | 28:0c59edd704a0 | 566 | { |
rba90 | 29:020355bfe3a6 | 567 | payload[i + 2] = dataBlockPacket.getData(i); |
rba90 | 28:0c59edd704a0 | 568 | } |
rba90 | 28:0c59edd704a0 | 569 | |
rba90 | 28:0c59edd704a0 | 570 | // copy snr |
rba90 | 28:0c59edd704a0 | 571 | payload[6] = (uint8_t) aloha.getSnr(); |
rba90 | 28:0c59edd704a0 | 572 | |
rba90 | 28:0c59edd704a0 | 573 | // copy rssi |
rba90 | 28:0c59edd704a0 | 574 | int_string_16 rssi; |
rba90 | 28:0c59edd704a0 | 575 | rssi.int16 = aloha.getRssi(); |
rba90 | 28:0c59edd704a0 | 576 | |
rba90 | 28:0c59edd704a0 | 577 | payload[7] = rssi.bytes[0]; |
rba90 | 28:0c59edd704a0 | 578 | payload[8] = rssi.bytes[1]; |
rba90 | 16:ab2d9341997a | 579 | |
rba90 | 16:ab2d9341997a | 580 | // make response |
rba90 | 28:0c59edd704a0 | 581 | SIP.respond(0xf0, payload, 9); |
rba90 | 16:ab2d9341997a | 582 | |
rba90 | 15:182b95c25cf2 | 583 | break; |
rba90 | 15:182b95c25cf2 | 584 | } |
rba90 | 16:ab2d9341997a | 585 | case 0x1: // door sensor |
rba90 | 15:182b95c25cf2 | 586 | { |
rba90 | 28:0c59edd704a0 | 587 | uint8_t payload[6]; |
rba90 | 16:ab2d9341997a | 588 | |
rba90 | 16:ab2d9341997a | 589 | // copy sensor type |
rba90 | 23:378bd4d025d0 | 590 | payload[0] = 0x1; |
rba90 | 16:ab2d9341997a | 591 | |
rba90 | 30:7f0f887040a2 | 592 | // copy source id |
rba90 | 23:378bd4d025d0 | 593 | payload[1] = dataBlockPacket.getSourceID(); |
rba90 | 16:ab2d9341997a | 594 | |
rba90 | 30:7f0f887040a2 | 595 | // copy state data |
rba90 | 16:ab2d9341997a | 596 | payload[2] = dataBlockPacket.getData(0); |
rba90 | 16:ab2d9341997a | 597 | |
rba90 | 28:0c59edd704a0 | 598 | // copy snr |
rba90 | 28:0c59edd704a0 | 599 | payload[3] = (uint8_t) aloha.getSnr(); |
rba90 | 28:0c59edd704a0 | 600 | |
rba90 | 28:0c59edd704a0 | 601 | // copy rssi |
rba90 | 28:0c59edd704a0 | 602 | int_string_16 rssi; |
rba90 | 28:0c59edd704a0 | 603 | rssi.int16 = aloha.getRssi(); |
rba90 | 28:0c59edd704a0 | 604 | |
rba90 | 28:0c59edd704a0 | 605 | payload[4] = rssi.bytes[0]; |
rba90 | 28:0c59edd704a0 | 606 | payload[5] = rssi.bytes[1]; |
rba90 | 28:0c59edd704a0 | 607 | |
rba90 | 16:ab2d9341997a | 608 | // make response |
rba90 | 28:0c59edd704a0 | 609 | SIP.respond(0xf0, payload, 6); |
rba90 | 16:ab2d9341997a | 610 | |
rba90 | 15:182b95c25cf2 | 611 | break; |
rba90 | 15:182b95c25cf2 | 612 | } |
rba90 | 23:378bd4d025d0 | 613 | case 0x2: // service quality |
rba90 | 23:378bd4d025d0 | 614 | { |
rba90 | 23:378bd4d025d0 | 615 | uint8_t payload[8]; |
rba90 | 23:378bd4d025d0 | 616 | |
rba90 | 23:378bd4d025d0 | 617 | // copy source type |
rba90 | 23:378bd4d025d0 | 618 | payload[0] = 0x2; |
rba90 | 23:378bd4d025d0 | 619 | |
rba90 | 30:7f0f887040a2 | 620 | // copy source id |
rba90 | 23:378bd4d025d0 | 621 | payload[1] = dataBlockPacket.getSourceID(); |
rba90 | 23:378bd4d025d0 | 622 | |
rba90 | 30:7f0f887040a2 | 623 | // copy snr of foreign host |
rba90 | 23:378bd4d025d0 | 624 | payload[2] = dataBlockPacket.getData(0); |
rba90 | 23:378bd4d025d0 | 625 | |
rba90 | 30:7f0f887040a2 | 626 | // copy rssi of foreign host |
rba90 | 23:378bd4d025d0 | 627 | payload[3] = dataBlockPacket.getData(1); |
rba90 | 23:378bd4d025d0 | 628 | payload[4] = dataBlockPacket.getData(2); |
rba90 | 23:378bd4d025d0 | 629 | |
rba90 | 30:7f0f887040a2 | 630 | // copy snr of local host |
rba90 | 23:378bd4d025d0 | 631 | payload[5] = (uint8_t) aloha.getSnr(); |
rba90 | 23:378bd4d025d0 | 632 | |
rba90 | 30:7f0f887040a2 | 633 | // copy rssi of local host |
rba90 | 23:378bd4d025d0 | 634 | int_string_16 rssi; |
rba90 | 23:378bd4d025d0 | 635 | rssi.int16 = aloha.getRssi(); |
rba90 | 23:378bd4d025d0 | 636 | |
rba90 | 23:378bd4d025d0 | 637 | payload[6] = rssi.bytes[0]; |
rba90 | 23:378bd4d025d0 | 638 | payload[7] = rssi.bytes[1]; |
rba90 | 23:378bd4d025d0 | 639 | |
rba90 | 23:378bd4d025d0 | 640 | // make response |
rba90 | 23:378bd4d025d0 | 641 | SIP.respond(0xf0, payload, 8); |
rba90 | 23:378bd4d025d0 | 642 | |
rba90 | 23:378bd4d025d0 | 643 | break; |
rba90 | 23:378bd4d025d0 | 644 | } |
rba90 | 23:378bd4d025d0 | 645 | |
rba90 | 15:182b95c25cf2 | 646 | default: |
rba90 | 15:182b95c25cf2 | 647 | break; |
rba90 | 15:182b95c25cf2 | 648 | } |
rba90 | 15:182b95c25cf2 | 649 | |
rba90 | 14:25e836a5a7bf | 650 | break; |
rba90 | 14:25e836a5a7bf | 651 | } |
rba90 | 14:25e836a5a7bf | 652 | default: |
rba90 | 14:25e836a5a7bf | 653 | break; |
rba90 | 3:a4f6abad9378 | 654 | } |
rba90 | 0:1e42d79b42e1 | 655 | } |
rba90 | 0:1e42d79b42e1 | 656 | |
rba90 | 14:25e836a5a7bf | 657 | |
rba90 | 0:1e42d79b42e1 | 658 | int main() { |
rba90 | 0:1e42d79b42e1 | 659 | // initialize radio module |
rba90 | 5:445f35444a6a | 660 | aloha.boardInit(); |
rba90 | 6:19457108c899 | 661 | aloha.updateSettings(); |
rba90 | 6:19457108c899 | 662 | aloha.enable(); |
rba90 | 0:1e42d79b42e1 | 663 | |
rba90 | 0:1e42d79b42e1 | 664 | // attach serial interrupt handler |
rba90 | 0:1e42d79b42e1 | 665 | pc.attach(&serialInterruptHandler); |
rba90 | 0:1e42d79b42e1 | 666 | |
rba90 | 0:1e42d79b42e1 | 667 | // register callback functions for SIP |
rba90 | 0:1e42d79b42e1 | 668 | SIP.registerCommand(0x00, toggleChecksum); |
rba90 | 19:6a59fb0ee921 | 669 | SIP.registerCommand(0x01, queryServiceQuality); |
rba90 | 9:e13e02aa4a2f | 670 | SIP.registerCommand(0x02, configureRadio); |
rba90 | 9:e13e02aa4a2f | 671 | SIP.registerCommand(0x03, radioUpdateSettings); |
rba90 | 14:25e836a5a7bf | 672 | SIP.registerCommand(0x04, querySensors); |
rba90 | 0:1e42d79b42e1 | 673 | |
rba90 | 0:1e42d79b42e1 | 674 | // register callback functions for aloha transceiver |
rba90 | 14:25e836a5a7bf | 675 | aloha.registerType(AlohaFrame::Aloha_Data, AlohaDataPacketHandler); |
rba90 | 0:1e42d79b42e1 | 676 | |
rba90 | 0:1e42d79b42e1 | 677 | while(1) { |
rba90 | 0:1e42d79b42e1 | 678 | SIP.poll(); |
rba90 | 0:1e42d79b42e1 | 679 | aloha.poll(); |
rba90 | 0:1e42d79b42e1 | 680 | |
rba90 | 0:1e42d79b42e1 | 681 | while (SerialOutputBuffer.getCounter() > 0) |
rba90 | 0:1e42d79b42e1 | 682 | { |
rba90 | 0:1e42d79b42e1 | 683 | uint8_t ch; |
rba90 | 0:1e42d79b42e1 | 684 | ch = SerialOutputBuffer.dequeue(); |
rba90 | 0:1e42d79b42e1 | 685 | pc.putc(ch); |
rba90 | 0:1e42d79b42e1 | 686 | } |
rba90 | 0:1e42d79b42e1 | 687 | } |
rba90 | 0:1e42d79b42e1 | 688 | } |