A libery to connect to telegesis zigbee module. Bassed on implemtation of XBEE
Fork of xbee_lib by
telegesis.cpp@32:e44448cee1e1, 2014-11-28 (annotated)
- Committer:
- gert_lauritsen
- Date:
- Fri Nov 28 12:26:46 2014 +0000
- Revision:
- 32:e44448cee1e1
- Parent:
- 31:c59bc92a047e
- Child:
- 33:101f953225a6
Now with interruptbased communikation
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
gert_lauritsen | 7:45511c3d2950 | 1 | #include "telegesis.h" |
gert_lauritsen | 14:dcf2390f89e2 | 2 | #define CR 0x0D |
gert_lauritsen | 14:dcf2390f89e2 | 3 | #define LF 0x0A |
gert_lauritsen | 32:e44448cee1e1 | 4 | #define IRQCtrl |
tristanjph | 0:2656fb225c5d | 5 | |
gert_lauritsen | 18:10fcddf238c9 | 6 | zigbee::zigbee(PinName tx, PinName rx): _zbee(tx, rx) |
gert_lauritsen | 18:10fcddf238c9 | 7 | { |
tristanjph | 0:2656fb225c5d | 8 | _tx = tx; |
tristanjph | 0:2656fb225c5d | 9 | _rx = rx; |
gert_lauritsen | 18:10fcddf238c9 | 10 | _zbee.baud(19200); |
gert_lauritsen | 28:c724a8921f01 | 11 | Ok=1; PacketAck=1; |
gert_lauritsen | 18:10fcddf238c9 | 12 | #ifdef IRQCtrl |
gert_lauritsen | 18:10fcddf238c9 | 13 | _zbee.attach(this, &zigbee::SeePacket, Serial::RxIrq); |
gert_lauritsen | 18:10fcddf238c9 | 14 | #endif |
tristanjph | 0:2656fb225c5d | 15 | } |
tristanjph | 0:2656fb225c5d | 16 | |
gert_lauritsen | 30:f9cdb6f62586 | 17 | size_t zigbee::comma_parse ( char *line, char *list[], size_t size ) |
gert_lauritsen | 30:f9cdb6f62586 | 18 | { |
gert_lauritsen | 30:f9cdb6f62586 | 19 | char *p; |
gert_lauritsen | 30:f9cdb6f62586 | 20 | size_t n; |
gert_lauritsen | 30:f9cdb6f62586 | 21 | |
gert_lauritsen | 30:f9cdb6f62586 | 22 | p = line; |
gert_lauritsen | 30:f9cdb6f62586 | 23 | n = 0; |
gert_lauritsen | 30:f9cdb6f62586 | 24 | for ( ; ; ) { |
gert_lauritsen | 30:f9cdb6f62586 | 25 | /* Ditch leading commas */ |
gert_lauritsen | 30:f9cdb6f62586 | 26 | while ( *p == ',' ) |
gert_lauritsen | 30:f9cdb6f62586 | 27 | p++; |
gert_lauritsen | 30:f9cdb6f62586 | 28 | /* Nothing of use */ |
gert_lauritsen | 30:f9cdb6f62586 | 29 | if ( *p == '\0' ) |
gert_lauritsen | 30:f9cdb6f62586 | 30 | return n; |
gert_lauritsen | 30:f9cdb6f62586 | 31 | /* Save the string */ |
gert_lauritsen | 30:f9cdb6f62586 | 32 | list[n++] = p; |
gert_lauritsen | 30:f9cdb6f62586 | 33 | /* Find the next field */ |
gert_lauritsen | 30:f9cdb6f62586 | 34 | while ( *p != ',' && *p != '\0' ) |
gert_lauritsen | 30:f9cdb6f62586 | 35 | p++; |
gert_lauritsen | 30:f9cdb6f62586 | 36 | /* Nothing else of use or too many fields */ |
gert_lauritsen | 30:f9cdb6f62586 | 37 | if ( *p == '\0' || n >= size ) |
gert_lauritsen | 30:f9cdb6f62586 | 38 | return n; |
gert_lauritsen | 30:f9cdb6f62586 | 39 | /* Split the field */ |
gert_lauritsen | 30:f9cdb6f62586 | 40 | *p++ = '\0'; |
gert_lauritsen | 30:f9cdb6f62586 | 41 | } |
gert_lauritsen | 30:f9cdb6f62586 | 42 | } |
gert_lauritsen | 30:f9cdb6f62586 | 43 | |
gert_lauritsen | 30:f9cdb6f62586 | 44 | |
gert_lauritsen | 7:45511c3d2950 | 45 | zigbee::~zigbee() |
tristanjph | 0:2656fb225c5d | 46 | { |
tristanjph | 0:2656fb225c5d | 47 | } |
tristanjph | 0:2656fb225c5d | 48 | |
gert_lauritsen | 26:2a85af491d92 | 49 | bool zigbee::Work() |
gert_lauritsen | 26:2a85af491d92 | 50 | { |
gert_lauritsen | 24:5ed5311266b0 | 51 | //read and waits for the packet |
gert_lauritsen | 32:e44448cee1e1 | 52 | #ifndef IRQCtrl //dette skal kun kaldes hvis vi vi køre i pull mode |
gert_lauritsen | 26:2a85af491d92 | 53 | bool datain=false; |
gert_lauritsen | 24:5ed5311266b0 | 54 | b=0; |
gert_lauritsen | 28:c724a8921f01 | 55 | if (_zbee.readable()) { |
gert_lauritsen | 26:2a85af491d92 | 56 | datain=true; |
gert_lauritsen | 26:2a85af491d92 | 57 | SeePacket(); |
gert_lauritsen | 28:c724a8921f01 | 58 | } |
gert_lauritsen | 26:2a85af491d92 | 59 | return datain; |
gert_lauritsen | 32:e44448cee1e1 | 60 | #endif |
gert_lauritsen | 18:10fcddf238c9 | 61 | } |
gert_lauritsen | 18:10fcddf238c9 | 62 | |
gert_lauritsen | 20:070dc2050052 | 63 | bool zigbee::wait4str(char *p) //joinpan |
gert_lauritsen | 20:070dc2050052 | 64 | { |
gert_lauritsen | 20:070dc2050052 | 65 | Timer t; |
gert_lauritsen | 20:070dc2050052 | 66 | t.reset(); |
gert_lauritsen | 20:070dc2050052 | 67 | t.start(); |
gert_lauritsen | 25:31120552e53c | 68 | while ((strstr(_responseFrameString,p)==0) && (t.read_ms() < 5000)) readPacket(); |
gert_lauritsen | 26:2a85af491d92 | 69 | t.stop(); |
gert_lauritsen | 26:2a85af491d92 | 70 | return (strstr(_responseFrameString,p)>0); |
gert_lauritsen | 20:070dc2050052 | 71 | } |
gert_lauritsen | 20:070dc2050052 | 72 | |
gert_lauritsen | 20:070dc2050052 | 73 | |
gert_lauritsen | 20:070dc2050052 | 74 | bool zigbee::wait4JPAN() //joinpan |
gert_lauritsen | 20:070dc2050052 | 75 | { |
gert_lauritsen | 20:070dc2050052 | 76 | Timer t; |
gert_lauritsen | 20:070dc2050052 | 77 | t.reset(); |
gert_lauritsen | 20:070dc2050052 | 78 | t.start(); |
gert_lauritsen | 20:070dc2050052 | 79 | readPacket(); |
gert_lauritsen | 25:31120552e53c | 80 | while ((strstr(_responseFrameString,"JPAN")==0) && (t.read_ms() < 5000)) readPacket(); |
gert_lauritsen | 26:2a85af491d92 | 81 | t.stop(); |
gert_lauritsen | 26:2a85af491d92 | 82 | return (strstr(_responseFrameString,"JPAN")>0); |
gert_lauritsen | 20:070dc2050052 | 83 | } |
gert_lauritsen | 20:070dc2050052 | 84 | |
gert_lauritsen | 20:070dc2050052 | 85 | |
gert_lauritsen | 20:070dc2050052 | 86 | bool zigbee::wait4Offline() |
gert_lauritsen | 20:070dc2050052 | 87 | { |
gert_lauritsen | 20:070dc2050052 | 88 | Timer t; |
gert_lauritsen | 20:070dc2050052 | 89 | t.reset(); |
gert_lauritsen | 20:070dc2050052 | 90 | t.start(); |
gert_lauritsen | 20:070dc2050052 | 91 | readPacket(); |
gert_lauritsen | 25:31120552e53c | 92 | while ((PanOnline>0) && (t.read_ms() < 3000)) readPacket(); |
gert_lauritsen | 26:2a85af491d92 | 93 | t.stop(); |
gert_lauritsen | 26:2a85af491d92 | 94 | return PanOnline; |
gert_lauritsen | 20:070dc2050052 | 95 | } |
gert_lauritsen | 20:070dc2050052 | 96 | |
gert_lauritsen | 20:070dc2050052 | 97 | |
gert_lauritsen | 18:10fcddf238c9 | 98 | bool zigbee::wait4OK() |
gert_lauritsen | 18:10fcddf238c9 | 99 | { |
gert_lauritsen | 12:debf76f0c0bf | 100 | Timer t; |
gert_lauritsen | 12:debf76f0c0bf | 101 | t.reset(); |
gert_lauritsen | 18:10fcddf238c9 | 102 | t.start(); |
gert_lauritsen | 11:18ff088287ea | 103 | readPacket(); |
gert_lauritsen | 25:31120552e53c | 104 | while ((strstr(_responseFrameString,"OK")==0) && (t.read_ms() < 500)) readPacket(); |
gert_lauritsen | 26:2a85af491d92 | 105 | t.stop(); |
gert_lauritsen | 26:2a85af491d92 | 106 | return (strstr(_responseFrameString,"OK")>0); |
gert_lauritsen | 11:18ff088287ea | 107 | } |
tristanjph | 0:2656fb225c5d | 108 | |
gert_lauritsen | 11:18ff088287ea | 109 | int zigbee::GetSerial() |
gert_lauritsen | 18:10fcddf238c9 | 110 | { |
gert_lauritsen | 11:18ff088287ea | 111 | /** comes with something like this |
gert_lauritsen | 18:10fcddf238c9 | 112 | Telegesis ETRX357-LRS |
gert_lauritsen | 18:10fcddf238c9 | 113 | R305C |
gert_lauritsen | 18:10fcddf238c9 | 114 | 000D6F0000D5F06A |
gert_lauritsen | 18:10fcddf238c9 | 115 | OK |
gert_lauritsen | 18:10fcddf238c9 | 116 | */ |
gert_lauritsen | 11:18ff088287ea | 117 | _zbee.printf("ATI\r"); |
gert_lauritsen | 22:e8a8edf8b45c | 118 | wait4str("Telegesis"); |
gert_lauritsen | 11:18ff088287ea | 119 | sscanf(_responseFrameString,"Telegesis %s",HWType); |
gert_lauritsen | 27:a38b67f5be8f | 120 | readPacket(); //Typen |
gert_lauritsen | 27:a38b67f5be8f | 121 | readPacket(); //ID |
gert_lauritsen | 18:10fcddf238c9 | 122 | strcpy(LocalID,_responseFrameString); //vi lægger den bare over i stringformat. Så kan man altid senere convertere |
gert_lauritsen | 26:2a85af491d92 | 123 | wait4OK(); |
gert_lauritsen | 18:10fcddf238c9 | 124 | // LocalID=hextoint(_responseFrameString); |
gert_lauritsen | 18:10fcddf238c9 | 125 | // wait_ms(5); |
tristanjph | 0:2656fb225c5d | 126 | return 1; |
tristanjph | 0:2656fb225c5d | 127 | } |
tristanjph | 0:2656fb225c5d | 128 | |
gert_lauritsen | 18:10fcddf238c9 | 129 | int zigbee::SetKey(char* key) |
gert_lauritsen | 18:10fcddf238c9 | 130 | { |
gert_lauritsen | 18:10fcddf238c9 | 131 | /** |
gert_lauritsen | 18:10fcddf238c9 | 132 | S09: the link key. Write the same 128-bit number (32 hexadecimal characters) into every device |
gert_lauritsen | 15:8d4990362a80 | 133 | |
gert_lauritsen | 18:10fcddf238c9 | 134 | S0A: security configuration. You must set bit 4 in the coordinator, and set bit 8 in all other devices. |
gert_lauritsen | 18:10fcddf238c9 | 135 | For more security set bit 2 also in the coordinator. The devices ignore the bits that are not relevant |
gert_lauritsen | 18:10fcddf238c9 | 136 | for them, so it is easiest to just set bits 8, 4, and 2 in all devices which gives S0A=0114. |
gert_lauritsen | 18:10fcddf238c9 | 137 | */ |
gert_lauritsen | 18:10fcddf238c9 | 138 | char psw[50]; |
gert_lauritsen | 15:8d4990362a80 | 139 | sprintf(psw,"ATS09=%s;password\r",key); |
gert_lauritsen | 15:8d4990362a80 | 140 | _zbee.printf(psw); |
gert_lauritsen | 18:10fcddf238c9 | 141 | wait4OK(); |
gert_lauritsen | 15:8d4990362a80 | 142 | _zbee.printf("ATS0A=0114;password\r"); |
tristanjph | 0:2656fb225c5d | 143 | return 1; |
tristanjph | 0:2656fb225c5d | 144 | } |
tristanjph | 0:2656fb225c5d | 145 | |
tristanjph | 0:2656fb225c5d | 146 | |
tristanjph | 0:2656fb225c5d | 147 | |
gert_lauritsen | 7:45511c3d2950 | 148 | void zigbee::RecieveData(char *data_buf, int numchar) |
tristanjph | 1:c3d9bdcb0b03 | 149 | { |
tristanjph | 1:c3d9bdcb0b03 | 150 | int count=0; |
tristanjph | 2:cb627ea9b817 | 151 | if(numchar == 0) { |
tristanjph | 2:cb627ea9b817 | 152 | numchar = sizeof(data_buf); |
tristanjph | 2:cb627ea9b817 | 153 | } |
gert_lauritsen | 18:10fcddf238c9 | 154 | |
tristanjph | 1:c3d9bdcb0b03 | 155 | while(numchar!=count) { |
gert_lauritsen | 11:18ff088287ea | 156 | if(_zbee.readable()) { |
gert_lauritsen | 11:18ff088287ea | 157 | *data_buf = _zbee.getc(); |
tristanjph | 3:682615a0717e | 158 | data_buf+=1; |
tristanjph | 3:682615a0717e | 159 | count++; |
tristanjph | 1:c3d9bdcb0b03 | 160 | } |
tristanjph | 1:c3d9bdcb0b03 | 161 | |
tristanjph | 1:c3d9bdcb0b03 | 162 | } |
tristanjph | 2:cb627ea9b817 | 163 | } |
tristanjph | 1:c3d9bdcb0b03 | 164 | |
gert_lauritsen | 12:debf76f0c0bf | 165 | int zigbee::Reset() |
gert_lauritsen | 12:debf76f0c0bf | 166 | { |
gert_lauritsen | 28:c724a8921f01 | 167 | PacketAck=0; |
gert_lauritsen | 12:debf76f0c0bf | 168 | _zbee.printf("ATZ\r"); |
gert_lauritsen | 12:debf76f0c0bf | 169 | wait4OK(); |
gert_lauritsen | 28:c724a8921f01 | 170 | |
gert_lauritsen | 12:debf76f0c0bf | 171 | return 1; |
gert_lauritsen | 12:debf76f0c0bf | 172 | } |
gert_lauritsen | 12:debf76f0c0bf | 173 | |
gert_lauritsen | 7:45511c3d2950 | 174 | int zigbee::ATI() |
gert_lauritsen | 7:45511c3d2950 | 175 | { |
gert_lauritsen | 28:c724a8921f01 | 176 | PacketAck=0; |
gert_lauritsen | 12:debf76f0c0bf | 177 | GetSerial(); |
gert_lauritsen | 7:45511c3d2950 | 178 | return 1; |
gert_lauritsen | 7:45511c3d2950 | 179 | } |
gert_lauritsen | 7:45511c3d2950 | 180 | |
gert_lauritsen | 7:45511c3d2950 | 181 | |
gert_lauritsen | 7:45511c3d2950 | 182 | int zigbee::PingOut() |
gert_lauritsen | 18:10fcddf238c9 | 183 | { |
gert_lauritsen | 18:10fcddf238c9 | 184 | //just return a OK (sends it ID out out the pan) |
gert_lauritsen | 28:c724a8921f01 | 185 | PacketAck=0; |
gert_lauritsen | 11:18ff088287ea | 186 | _zbee.printf("AT+ANNCE\r"); |
gert_lauritsen | 12:debf76f0c0bf | 187 | wait4OK(); |
gert_lauritsen | 7:45511c3d2950 | 188 | return 1; |
gert_lauritsen | 7:45511c3d2950 | 189 | } |
gert_lauritsen | 7:45511c3d2950 | 190 | |
gert_lauritsen | 7:45511c3d2950 | 191 | |
gert_lauritsen | 7:45511c3d2950 | 192 | int zigbee::PanScan() |
gert_lauritsen | 18:10fcddf238c9 | 193 | { |
gert_lauritsen | 18:10fcddf238c9 | 194 | // |
gert_lauritsen | 31:c59bc92a047e | 195 | PacketAck=0; NPanVisible=0; |
gert_lauritsen | 11:18ff088287ea | 196 | _zbee.printf("AT+PANSCAN\r"); |
gert_lauritsen | 30:f9cdb6f62586 | 197 | wait4OK(); |
gert_lauritsen | 7:45511c3d2950 | 198 | return 1; |
gert_lauritsen | 7:45511c3d2950 | 199 | } |
gert_lauritsen | 7:45511c3d2950 | 200 | |
gert_lauritsen | 7:45511c3d2950 | 201 | |
gert_lauritsen | 7:45511c3d2950 | 202 | int zigbee::Establish_Network() |
gert_lauritsen | 18:10fcddf238c9 | 203 | { |
gert_lauritsen | 18:10fcddf238c9 | 204 | // |
gert_lauritsen | 28:c724a8921f01 | 205 | PacketAck=0; |
gert_lauritsen | 11:18ff088287ea | 206 | _zbee.printf("AT+EN\r"); |
gert_lauritsen | 26:2a85af491d92 | 207 | wait4JPAN(); |
gert_lauritsen | 26:2a85af491d92 | 208 | wait4OK(); |
tristanjph | 2:cb627ea9b817 | 209 | return 1; |
tristanjph | 2:cb627ea9b817 | 210 | } |
tristanjph | 3:682615a0717e | 211 | |
gert_lauritsen | 7:45511c3d2950 | 212 | |
gert_lauritsen | 20:070dc2050052 | 213 | int zigbee::LeaveNetwork() |
gert_lauritsen | 20:070dc2050052 | 214 | { |
gert_lauritsen | 28:c724a8921f01 | 215 | PacketAck=0; |
gert_lauritsen | 20:070dc2050052 | 216 | _zbee.printf("AT+DASSL\r"); |
gert_lauritsen | 26:2a85af491d92 | 217 | wait4OK(); |
gert_lauritsen | 26:2a85af491d92 | 218 | wait4Offline(); |
gert_lauritsen | 20:070dc2050052 | 219 | return 1; |
gert_lauritsen | 20:070dc2050052 | 220 | } |
gert_lauritsen | 20:070dc2050052 | 221 | |
gert_lauritsen | 7:45511c3d2950 | 222 | int zigbee::JoinNetwork() |
gert_lauritsen | 7:45511c3d2950 | 223 | { |
gert_lauritsen | 28:c724a8921f01 | 224 | PacketAck=0; |
gert_lauritsen | 11:18ff088287ea | 225 | _zbee.printf("AT+JN\r"); |
gert_lauritsen | 28:c724a8921f01 | 226 | Ok=0; |
gert_lauritsen | 7:45511c3d2950 | 227 | return 1; |
gert_lauritsen | 7:45511c3d2950 | 228 | } |
gert_lauritsen | 7:45511c3d2950 | 229 | |
gert_lauritsen | 7:45511c3d2950 | 230 | int zigbee::ScanNetwork() |
gert_lauritsen | 7:45511c3d2950 | 231 | { |
gert_lauritsen | 28:c724a8921f01 | 232 | PacketAck=0; |
gert_lauritsen | 11:18ff088287ea | 233 | _zbee.printf("AT+SN\r"); |
gert_lauritsen | 28:c724a8921f01 | 234 | Ok=0; |
gert_lauritsen | 28:c724a8921f01 | 235 | return 1; |
gert_lauritsen | 7:45511c3d2950 | 236 | } |
gert_lauritsen | 7:45511c3d2950 | 237 | |
gert_lauritsen | 7:45511c3d2950 | 238 | int zigbee::NetworkInfo() |
gert_lauritsen | 7:45511c3d2950 | 239 | { |
gert_lauritsen | 7:45511c3d2950 | 240 | //Return something like this "+N=COO,12,-11,29F0,55C0E0DCE605C522" |
gert_lauritsen | 28:c724a8921f01 | 241 | PacketAck=0; |
gert_lauritsen | 11:18ff088287ea | 242 | _zbee.printf("AT+N\r"); |
gert_lauritsen | 28:c724a8921f01 | 243 | Ok=wait4OK(); |
gert_lauritsen | 7:45511c3d2950 | 244 | return 1; |
gert_lauritsen | 7:45511c3d2950 | 245 | } |
gert_lauritsen | 7:45511c3d2950 | 246 | |
gert_lauritsen | 9:c8e4339ccc29 | 247 | int zigbee::UniCast(char *adr,char *payload) //Ascii mode with null terminated string |
gert_lauritsen | 7:45511c3d2950 | 248 | { |
gert_lauritsen | 28:c724a8921f01 | 249 | PacketAck=0; |
gert_lauritsen | 11:18ff088287ea | 250 | _zbee.printf("AT+UCAST:%s=%s\r",adr,payload); |
gert_lauritsen | 26:2a85af491d92 | 251 | // printf("AT+UCAST:%s=%s\r",adr,payload); |
gert_lauritsen | 12:debf76f0c0bf | 252 | // _zbee.scanf ("UCAST:%X,%X=%s ",&EUI64,&framesize,Zdata); |
gert_lauritsen | 28:c724a8921f01 | 253 | Ok=0; |
gert_lauritsen | 7:45511c3d2950 | 254 | return 1; |
gert_lauritsen | 7:45511c3d2950 | 255 | } |
gert_lauritsen | 7:45511c3d2950 | 256 | |
gert_lauritsen | 9:c8e4339ccc29 | 257 | int zigbee::UniCastb(char *adr,char *payload, char payloadSize) //sends data in binary format |
gert_lauritsen | 7:45511c3d2950 | 258 | { |
gert_lauritsen | 28:c724a8921f01 | 259 | PacketAck=0; |
gert_lauritsen | 11:18ff088287ea | 260 | _zbee.printf("AT+UCASTB:%X,%s\r",adr,payloadSize); |
gert_lauritsen | 12:debf76f0c0bf | 261 | //_zbee.scanf ("%*s"); |
gert_lauritsen | 7:45511c3d2950 | 262 | return 1; |
gert_lauritsen | 7:45511c3d2950 | 263 | } |
gert_lauritsen | 7:45511c3d2950 | 264 | |
gert_lauritsen | 12:debf76f0c0bf | 265 | //-----------------------Handle incoming data------------------------------ |
tristanjph | 3:682615a0717e | 266 | |
gert_lauritsen | 11:18ff088287ea | 267 | unsigned long zigbee::hextolong(const char *hex) |
gert_lauritsen | 7:45511c3d2950 | 268 | { |
gert_lauritsen | 7:45511c3d2950 | 269 | //return 32 bit |
gert_lauritsen | 7:45511c3d2950 | 270 | unsigned long result = 0; |
gert_lauritsen | 7:45511c3d2950 | 271 | while (*hex) { //så længe det ikke er null |
gert_lauritsen | 7:45511c3d2950 | 272 | if (*hex >= '0' && *hex <= '9') |
gert_lauritsen | 7:45511c3d2950 | 273 | result += (*hex - '0'); |
gert_lauritsen | 7:45511c3d2950 | 274 | else if (*hex >= 'A' && *hex <= 'F') |
gert_lauritsen | 7:45511c3d2950 | 275 | result += (*hex - 'A' +10); |
gert_lauritsen | 7:45511c3d2950 | 276 | else if (*hex >= 'a' && *hex <= 'f') |
gert_lauritsen | 7:45511c3d2950 | 277 | result += (*hex - 'a'+ 10); |
gert_lauritsen | 7:45511c3d2950 | 278 | |
gert_lauritsen | 12:debf76f0c0bf | 279 | if (*++hex) //if the neext isn't a null |
gert_lauritsen | 7:45511c3d2950 | 280 | result <<= 4; |
gert_lauritsen | 7:45511c3d2950 | 281 | } |
gert_lauritsen | 7:45511c3d2950 | 282 | return result; |
gert_lauritsen | 7:45511c3d2950 | 283 | } |
gert_lauritsen | 7:45511c3d2950 | 284 | |
gert_lauritsen | 7:45511c3d2950 | 285 | |
gert_lauritsen | 11:18ff088287ea | 286 | unsigned int zigbee::hextoint(const char *hex) |
gert_lauritsen | 7:45511c3d2950 | 287 | { |
gert_lauritsen | 7:45511c3d2950 | 288 | //return 16 bit |
gert_lauritsen | 7:45511c3d2950 | 289 | unsigned int result = 0; |
gert_lauritsen | 7:45511c3d2950 | 290 | while (*hex) { //så længe det ikke er null |
gert_lauritsen | 7:45511c3d2950 | 291 | if (*hex >= '0' && *hex <= '9') |
gert_lauritsen | 7:45511c3d2950 | 292 | result += (*hex - '0'); |
gert_lauritsen | 7:45511c3d2950 | 293 | else if (*hex >= 'A' && *hex <= 'F') |
gert_lauritsen | 7:45511c3d2950 | 294 | result += (*hex - 'A' +10); |
gert_lauritsen | 7:45511c3d2950 | 295 | else if (*hex >= 'a' && *hex <= 'f') |
gert_lauritsen | 7:45511c3d2950 | 296 | result += (*hex - 'a'+ 10); |
gert_lauritsen | 7:45511c3d2950 | 297 | |
gert_lauritsen | 12:debf76f0c0bf | 298 | if (*++hex) //if the neext isn't a null |
gert_lauritsen | 7:45511c3d2950 | 299 | result <<= 4; |
gert_lauritsen | 7:45511c3d2950 | 300 | } |
gert_lauritsen | 7:45511c3d2950 | 301 | return result; |
gert_lauritsen | 7:45511c3d2950 | 302 | } |
gert_lauritsen | 7:45511c3d2950 | 303 | //--------------------------------------------------------------- |
gert_lauritsen | 7:45511c3d2950 | 304 | |
gert_lauritsen | 11:18ff088287ea | 305 | |
gert_lauritsen | 18:10fcddf238c9 | 306 | void zigbee::SeePacket() |
gert_lauritsen | 18:10fcddf238c9 | 307 | { |
gert_lauritsen | 18:10fcddf238c9 | 308 | char *p; |
gert_lauritsen | 18:10fcddf238c9 | 309 | static uint8_t _pos; |
gert_lauritsen | 12:debf76f0c0bf | 310 | b = _zbee.getc(); |
gert_lauritsen | 32:e44448cee1e1 | 311 | |
gert_lauritsen | 26:2a85af491d92 | 312 | if ((b!=CR) && (b!=LF)) { |
gert_lauritsen | 26:2a85af491d92 | 313 | _responseFrameString[_pos]=b; |
gert_lauritsen | 26:2a85af491d92 | 314 | _pos=(_pos+1) % MAX_FRAME_DATA_SIZE; |
gert_lauritsen | 26:2a85af491d92 | 315 | } |
gert_lauritsen | 12:debf76f0c0bf | 316 | if (b==CR) { |
gert_lauritsen | 18:10fcddf238c9 | 317 | // memcpy(&_responseFrameString,&_responseFrameData,_pos); |
gert_lauritsen | 18:10fcddf238c9 | 318 | GotFrame=1; |
gert_lauritsen | 18:10fcddf238c9 | 319 | _responseFrameString[_pos]=0; //Nul terminate |
gert_lauritsen | 18:10fcddf238c9 | 320 | _pos=0; |
gert_lauritsen | 29:6711180763b6 | 321 | // printf("%s \r\n",_responseFrameString); |
gert_lauritsen | 18:10fcddf238c9 | 322 | if (strstr(_responseFrameString,"+UCAST:")) { //returns on that we have sendt something |
gert_lauritsen | 18:10fcddf238c9 | 323 | //Do something |
gert_lauritsen | 18:10fcddf238c9 | 324 | } else if (strstr(_responseFrameString,"UCAST:")) { //checke for incoming UCAST data |
gert_lauritsen | 18:10fcddf238c9 | 325 | //if (sscanf (_responseFrameString,"UCAST:%X,%X=%s ",&EUI64,&framesize,Zdata)>0) |
gert_lauritsen | 26:2a85af491d92 | 326 | p=strstr(_responseFrameString,"UCAST:"); |
gert_lauritsen | 21:9c5b72a64495 | 327 | p=p+6; |
gert_lauritsen | 29:6711180763b6 | 328 | strncpy(In.ID,p,16); |
gert_lauritsen | 29:6711180763b6 | 329 | In.ID[16]=0; |
gert_lauritsen | 29:6711180763b6 | 330 | //Zdat=1; |
gert_lauritsen | 18:10fcddf238c9 | 331 | p=strstr(_responseFrameString,"="); |
gert_lauritsen | 18:10fcddf238c9 | 332 | if (p) { |
gert_lauritsen | 18:10fcddf238c9 | 333 | p++; |
gert_lauritsen | 29:6711180763b6 | 334 | strcpy(In.Data,p); |
gert_lauritsen | 29:6711180763b6 | 335 | In.Ready=1; |
gert_lauritsen | 18:10fcddf238c9 | 336 | } |
gert_lauritsen | 18:10fcddf238c9 | 337 | } |
gert_lauritsen | 30:f9cdb6f62586 | 338 | if (strstr(_responseFrameString,"+PANSCAN:")) { //info om nærliggende pan |
gert_lauritsen | 31:c59bc92a047e | 339 | p=strstr(_responseFrameString,":"); p++; //P indholder nu SEQ nummer |
gert_lauritsen | 31:c59bc92a047e | 340 | comma_parse(p,list,ZdataSize); |
gert_lauritsen | 31:c59bc92a047e | 341 | PanVisible[NPanVisible].channel=atoi(list[0]); |
gert_lauritsen | 31:c59bc92a047e | 342 | strcpy(PanVisible[NPanVisible].PID,list[1]); |
gert_lauritsen | 31:c59bc92a047e | 343 | NPanVisible++; |
gert_lauritsen | 30:f9cdb6f62586 | 344 | } |
gert_lauritsen | 31:c59bc92a047e | 345 | if (strstr(_responseFrameString,"LeftPAN")) PanOnline=0; //Local node has left the Pan |
gert_lauritsen | 31:c59bc92a047e | 346 | if (strstr(_responseFrameString,"LostPAN")) PanOnline=0; //Local node has left the Pan |
gert_lauritsen | 18:10fcddf238c9 | 347 | if (strstr(_responseFrameString,"ERROR:")) { |
gert_lauritsen | 18:10fcddf238c9 | 348 | p=strstr(_responseFrameString,":"); |
gert_lauritsen | 18:10fcddf238c9 | 349 | p++; //P indholder nu SEQ nummer |
gert_lauritsen | 17:5a3f81b10a61 | 350 | ErrorCode=hextoint(p); |
gert_lauritsen | 18:10fcddf238c9 | 351 | } |
gert_lauritsen | 18:10fcddf238c9 | 352 | |
gert_lauritsen | 18:10fcddf238c9 | 353 | if (strstr(_responseFrameString,"NEWNODE:")) { //NEWNODE: <NodeID>,<EUI64>,<Parent NodeID> |
gert_lauritsen | 18:10fcddf238c9 | 354 | //new node on the pan |
gert_lauritsen | 20:070dc2050052 | 355 | p=strstr(_responseFrameString,"NEWNODE:"); |
gert_lauritsen | 26:2a85af491d92 | 356 | p=p+13; |
gert_lauritsen | 26:2a85af491d92 | 357 | NetInfo=1; |
gert_lauritsen | 26:2a85af491d92 | 358 | strncpy(NetNodeID,p,16); |
gert_lauritsen | 18:10fcddf238c9 | 359 | } |
gert_lauritsen | 11:18ff088287ea | 360 | |
gert_lauritsen | 25:31120552e53c | 361 | if ((strstr(_responseFrameString,"OK")>0) && (strstr(_responseFrameString,"TOKDUMP")==0) ) { |
gert_lauritsen | 18:10fcddf238c9 | 362 | //if (ScriptState) ConnectScript(); |
gert_lauritsen | 28:c724a8921f01 | 363 | Ok=1; |
gert_lauritsen | 28:c724a8921f01 | 364 | //Cmd=0; LineNo=0; |
gert_lauritsen | 18:10fcddf238c9 | 365 | } |
gert_lauritsen | 20:070dc2050052 | 366 | if (strstr(_responseFrameString,"FFD:")) { |
gert_lauritsen | 20:070dc2050052 | 367 | //FFD:000D6F00026C5BEA,0000 |
gert_lauritsen | 20:070dc2050052 | 368 | p=strstr(_responseFrameString,"FFD:"); |
gert_lauritsen | 26:2a85af491d92 | 369 | p=p+4; |
gert_lauritsen | 26:2a85af491d92 | 370 | NetInfo=1; |
gert_lauritsen | 27:a38b67f5be8f | 371 | strncpy(NetNodeID,p,16); |
gert_lauritsen | 26:2a85af491d92 | 372 | } |
gert_lauritsen | 27:a38b67f5be8f | 373 | if (strstr(_responseFrameString,"N=")) { |
gert_lauritsen | 26:2a85af491d92 | 374 | // sscanf (_responseFrameString,"+N=%s,%d,%d,%4X,",Devicetype,&channel,&NodeID,&EPID); |
gert_lauritsen | 30:f9cdb6f62586 | 375 | size_t n; |
gert_lauritsen | 27:a38b67f5be8f | 376 | p=strstr(_responseFrameString,"="); |
gert_lauritsen | 27:a38b67f5be8f | 377 | p++; |
gert_lauritsen | 30:f9cdb6f62586 | 378 | n=comma_parse(p,list,ZdataSize); |
gert_lauritsen | 30:f9cdb6f62586 | 379 | strcpy(Devicetype,list[0]); |
gert_lauritsen | 31:c59bc92a047e | 380 | AktuelPan.channel=atoi(list[1]); |
gert_lauritsen | 31:c59bc92a047e | 381 | strcpy(AktuelPan.PID,list[3]); |
gert_lauritsen | 18:10fcddf238c9 | 382 | } |
gert_lauritsen | 18:10fcddf238c9 | 383 | if (strstr(_responseFrameString,"ACK")) { // |
gert_lauritsen | 26:2a85af491d92 | 384 | PacketAck=1; |
gert_lauritsen | 18:10fcddf238c9 | 385 | p=strstr(_responseFrameString,":"); |
gert_lauritsen | 18:10fcddf238c9 | 386 | p++; //P indholder nu SEQ nummer |
gert_lauritsen | 12:debf76f0c0bf | 387 | SeqNumber=hextoint(p); |
gert_lauritsen | 18:10fcddf238c9 | 388 | } |
gert_lauritsen | 18:10fcddf238c9 | 389 | if (strstr(_responseFrameString,"NAK")) { |
gert_lauritsen | 18:10fcddf238c9 | 390 | PacketAck=0; |
gert_lauritsen | 18:10fcddf238c9 | 391 | p=strstr(_responseFrameString,":"); |
gert_lauritsen | 18:10fcddf238c9 | 392 | p++; //P indholder nu SEQ nummer |
gert_lauritsen | 18:10fcddf238c9 | 393 | SeqNumber=hextoint(p); |
gert_lauritsen | 18:10fcddf238c9 | 394 | } |
gert_lauritsen | 18:10fcddf238c9 | 395 | if (strstr(_responseFrameString,"SEQ")) { // |
gert_lauritsen | 26:2a85af491d92 | 396 | // PacketAck=1; |
gert_lauritsen | 18:10fcddf238c9 | 397 | p=strstr(_responseFrameString,":"); |
gert_lauritsen | 18:10fcddf238c9 | 398 | p++; //P indholder nu SEQ nummer |
gert_lauritsen | 12:debf76f0c0bf | 399 | SeqNumber=hextoint(p); |
gert_lauritsen | 18:10fcddf238c9 | 400 | } |
gert_lauritsen | 31:c59bc92a047e | 401 | if (strstr(_responseFrameString,"JPAN:")) { |
gert_lauritsen | 31:c59bc92a047e | 402 | //JPAN:<channel>,<PID>,<EPID> |
gert_lauritsen | 31:c59bc92a047e | 403 | p=strstr(_responseFrameString,":"); p++; |
gert_lauritsen | 31:c59bc92a047e | 404 | comma_parse(p,list,ZdataSize); |
gert_lauritsen | 31:c59bc92a047e | 405 | strcpy(Devicetype,list[0]); |
gert_lauritsen | 31:c59bc92a047e | 406 | AktuelPan.channel=atoi(list[1]); |
gert_lauritsen | 31:c59bc92a047e | 407 | strcpy(AktuelPan.PID,list[2]); |
gert_lauritsen | 31:c59bc92a047e | 408 | PanOnline=1; |
gert_lauritsen | 31:c59bc92a047e | 409 | } |
gert_lauritsen | 31:c59bc92a047e | 410 | } |
gert_lauritsen | 11:18ff088287ea | 411 | } |
gert_lauritsen | 18:10fcddf238c9 | 412 | |
gert_lauritsen | 18:10fcddf238c9 | 413 | //-----------------------NON IRQ mode -------------------------------------------------------------------- |
gert_lauritsen | 18:10fcddf238c9 | 414 | void zigbee::readPacket() |
gert_lauritsen | 18:10fcddf238c9 | 415 | { |
gert_lauritsen | 18:10fcddf238c9 | 416 | //read and waits for the packet |
gert_lauritsen | 32:e44448cee1e1 | 417 | |
gert_lauritsen | 19:78f44233a12f | 418 | Timer t; |
gert_lauritsen | 19:78f44233a12f | 419 | t.reset(); |
gert_lauritsen | 26:2a85af491d92 | 420 | t.start(); |
gert_lauritsen | 19:78f44233a12f | 421 | b=0; |
gert_lauritsen | 32:e44448cee1e1 | 422 | #ifndef IRQCtrl |
gert_lauritsen | 25:31120552e53c | 423 | while((b!=CR) && (t.read_ms() < 1000)) |
gert_lauritsen | 18:10fcddf238c9 | 424 | if (_zbee.readable()) SeePacket(); |
gert_lauritsen | 26:2a85af491d92 | 425 | t.stop(); |
gert_lauritsen | 32:e44448cee1e1 | 426 | #else |
gert_lauritsen | 32:e44448cee1e1 | 427 | while((b!=CR) && (t.read_ms() < 1000)) {} //vent |
gert_lauritsen | 32:e44448cee1e1 | 428 | t.stop(); |
gert_lauritsen | 32:e44448cee1e1 | 429 | #endif |
gert_lauritsen | 18:10fcddf238c9 | 430 | } |
gert_lauritsen | 18:10fcddf238c9 | 431 | |
gert_lauritsen | 31:c59bc92a047e | 432 | |
gert_lauritsen | 29:6711180763b6 | 433 | |
gert_lauritsen | 29:6711180763b6 | 434 | |
gert_lauritsen | 29:6711180763b6 | 435 | void zigbee::SletZdata(void){ |
gert_lauritsen | 29:6711180763b6 | 436 | int i; |
gert_lauritsen | 29:6711180763b6 | 437 | for (i=0; i<ZdataSize ; i++) In.Data[i]=0; |
gert_lauritsen | 31:c59bc92a047e | 438 | } |
gert_lauritsen | 31:c59bc92a047e | 439 | |
gert_lauritsen | 31:c59bc92a047e | 440 |