Renan Alves / XBEE

Xbee

XBEE.cpp@0:fbed291691a6, 2018-10-14 (annotated)

Committer:
renanbmx123
Date:
Sun Oct 14 02:01:07 2018 +0000
Revision:
0:fbed291691a6
Xbee

Who changed what in which revision?

UserRevisionLine numberNew contents of line
renanbmx123 0:fbed291691a6 1 #include "XBEE.h"
renanbmx123 0:fbed291691a6 2 #include <stdlib.h>
renanbmx123 0:fbed291691a6 3
renanbmx123 0:fbed291691a6 4 /* Class constructor */
renanbmx123 0:fbed291691a6 5 XBEE::XBEE(Serial* serial, int baud):xbee(serial)
renanbmx123 0:fbed291691a6 6 {
renanbmx123 0:fbed291691a6 7 xbee->baud(baud);
renanbmx123 0:fbed291691a6 8 /* Enable the reception of bytes on the serial interface by providing a cb */
renanbmx123 0:fbed291691a6 9 xbee->attach(callback(this, &XBEE::recvAttach), Serial::RxIrq);
renanbmx123 0:fbed291691a6 10 }
renanbmx123 0:fbed291691a6 11
renanbmx123 0:fbed291691a6 12 /* Class destructor */
renanbmx123 0:fbed291691a6 13 XBEE::~XBEE()
renanbmx123 0:fbed291691a6 14 {
renanbmx123 0:fbed291691a6 15 if (xbee != NULL) {
renanbmx123 0:fbed291691a6 16 delete xbee;
renanbmx123 0:fbed291691a6 17 }
renanbmx123 0:fbed291691a6 18 }
renanbmx123 0:fbed291691a6 19
renanbmx123 0:fbed291691a6 20 /* Chamada por Interrupcao, RX */
renanbmx123 0:fbed291691a6 21 void XBEE::recvAttach (void)
renanbmx123 0:fbed291691a6 22 {
renanbmx123 0:fbed291691a6 23 if (int_ctrl == 1)
renanbmx123 0:fbed291691a6 24 while(xbee->readable()) {
renanbmx123 0:fbed291691a6 25 buf_rx[count_rx%sizeof(buf_rx)] = xbee->getc();
renanbmx123 0:fbed291691a6 26 //buf_rx.push(xbee->getc());
renanbmx123 0:fbed291691a6 27 count_rx++;
renanbmx123 0:fbed291691a6 28 }
renanbmx123 0:fbed291691a6 29 }
renanbmx123 0:fbed291691a6 30
renanbmx123 0:fbed291691a6 31 /* Initialize the Device XBEE */
renanbmx123 0:fbed291691a6 32 void XBEE::init(void)
renanbmx123 0:fbed291691a6 33 {
renanbmx123 0:fbed291691a6 34 // memset(&NI,0,sizeof(NI));
renanbmx123 0:fbed291691a6 35 ID = 0;
renanbmx123 0:fbed291691a6 36 MY = 0;
renanbmx123 0:fbed291691a6 37 SH = 0;
renanbmx123 0:fbed291691a6 38 SL = 0;
renanbmx123 0:fbed291691a6 39 PL = 0;
renanbmx123 0:fbed291691a6 40 BD = 0;
renanbmx123 0:fbed291691a6 41 AO = 0;
renanbmx123 0:fbed291691a6 42 DB = 0;
renanbmx123 0:fbed291691a6 43 TP = 0;
renanbmx123 0:fbed291691a6 44
renanbmx123 0:fbed291691a6 45 wait(0.5);
renanbmx123 0:fbed291691a6 46
renanbmx123 0:fbed291691a6 47 memset(&buf_rx,0,sizeof(buf_rx));
renanbmx123 0:fbed291691a6 48
renanbmx123 0:fbed291691a6 49 create_CMD("NI",0); // Pan ID da rede
renanbmx123 0:fbed291691a6 50 sendBuffer();
renanbmx123 0:fbed291691a6 51 wait(0.5);
renanbmx123 0:fbed291691a6 52
renanbmx123 0:fbed291691a6 53 recv_NI();
renanbmx123 0:fbed291691a6 54 read_cfg("ID", ID);
renanbmx123 0:fbed291691a6 55 read_cfg("SH", SH);
renanbmx123 0:fbed291691a6 56 read_cfg("SL", SL);
renanbmx123 0:fbed291691a6 57 read_cfg("PL", PL);
renanbmx123 0:fbed291691a6 58 read_cfg("BD", BD);
renanbmx123 0:fbed291691a6 59 read_cfg("AO", AO);
renanbmx123 0:fbed291691a6 60 read_cfg("DB", DB);
renanbmx123 0:fbed291691a6 61 read_cfg("TP", TP);
renanbmx123 0:fbed291691a6 62
renanbmx123 0:fbed291691a6 63 count_rx = 0;
renanbmx123 0:fbed291691a6 64 memset(&buf_rx,0,sizeof(buf_rx));
renanbmx123 0:fbed291691a6 65 }
renanbmx123 0:fbed291691a6 66
renanbmx123 0:fbed291691a6 67 /* Send message to the destination */
renanbmx123 0:fbed291691a6 68 int XBEE::send_msg(char * str, int dest)
renanbmx123 0:fbed291691a6 69 {
renanbmx123 0:fbed291691a6 70 int n = strlen(str);
renanbmx123 0:fbed291691a6 71 if(n > 92) {
renanbmx123 0:fbed291691a6 72 return -1;
renanbmx123 0:fbed291691a6 73 }
renanbmx123 0:fbed291691a6 74 create_TX(str,dest);
renanbmx123 0:fbed291691a6 75 sendBuffer();
renanbmx123 0:fbed291691a6 76 wait(0.2);
renanbmx123 0:fbed291691a6 77 return 0;
renanbmx123 0:fbed291691a6 78 }
renanbmx123 0:fbed291691a6 79
renanbmx123 0:fbed291691a6 80 /* Sets a configuration value into the module device */
renanbmx123 0:fbed291691a6 81 int XBEE::set_cfg(char * cmd, int value)
renanbmx123 0:fbed291691a6 82 {
renanbmx123 0:fbed291691a6 83 int n = strlen(cmd);
renanbmx123 0:fbed291691a6 84 if(n != 2) {
renanbmx123 0:fbed291691a6 85 return -1;
renanbmx123 0:fbed291691a6 86 }
renanbmx123 0:fbed291691a6 87 create_CMD(cmd,hex2dec(value));
renanbmx123 0:fbed291691a6 88 sendBuffer();
renanbmx123 0:fbed291691a6 89 wait(0.2);
renanbmx123 0:fbed291691a6 90
renanbmx123 0:fbed291691a6 91 create_CMD("WR",0);
renanbmx123 0:fbed291691a6 92 sendBuffer();
renanbmx123 0:fbed291691a6 93 wait(0.2);
renanbmx123 0:fbed291691a6 94
renanbmx123 0:fbed291691a6 95 create_CMD("AC",0);
renanbmx123 0:fbed291691a6 96 sendBuffer();
renanbmx123 0:fbed291691a6 97 wait(0.2);
renanbmx123 0:fbed291691a6 98 return 0;
renanbmx123 0:fbed291691a6 99 }
renanbmx123 0:fbed291691a6 100
renanbmx123 0:fbed291691a6 101 /* Receives a message, writes in str */
renanbmx123 0:fbed291691a6 102 int XBEE::recv_msg(char * buf, int tam)
renanbmx123 0:fbed291691a6 103 {
renanbmx123 0:fbed291691a6 104 pkt_tx *p;
renanbmx123 0:fbed291691a6 105 int i;
renanbmx123 0:fbed291691a6 106 int ptam = 0;
renanbmx123 0:fbed291691a6 107 int j = 0;
renanbmx123 0:fbed291691a6 108
renanbmx123 0:fbed291691a6 109 memset(buf,0,tam);
renanbmx123 0:fbed291691a6 110
renanbmx123 0:fbed291691a6 111 for(i = 0; i < count_rx; i++) {
renanbmx123 0:fbed291691a6 112 if(buf_rx[i] == 0x7E) {
renanbmx123 0:fbed291691a6 113
renanbmx123 0:fbed291691a6 114 p = (pkt_tx *) &buf_rx[i];
renanbmx123 0:fbed291691a6 115
renanbmx123 0:fbed291691a6 116 if(p->frame_type == 0x90) {
renanbmx123 0:fbed291691a6 117 ptam = p->length - 0x0C;
renanbmx123 0:fbed291691a6 118 if(tam < ptam + j) {
renanbmx123 0:fbed291691a6 119 return -1;
renanbmx123 0:fbed291691a6 120 }
renanbmx123 0:fbed291691a6 121 // posicao aonde comeca a msg em um pacote de Receive
renanbmx123 0:fbed291691a6 122 memcpy(&buf[j], ((char *)(&p->broadcast_radius)), ptam);
renanbmx123 0:fbed291691a6 123 j += ptam;
renanbmx123 0:fbed291691a6 124 }
renanbmx123 0:fbed291691a6 125 }
renanbmx123 0:fbed291691a6 126 }
renanbmx123 0:fbed291691a6 127 return j;
renanbmx123 0:fbed291691a6 128 }
renanbmx123 0:fbed291691a6 129
renanbmx123 0:fbed291691a6 130 /* Updates the command value, call a request from device configurations */
renanbmx123 0:fbed291691a6 131 int XBEE::read_cfg(char * cmd, int & var)
renanbmx123 0:fbed291691a6 132 {
renanbmx123 0:fbed291691a6 133 int n = strlen(cmd);
renanbmx123 0:fbed291691a6 134 if(n != 2) {
renanbmx123 0:fbed291691a6 135 return -1;
renanbmx123 0:fbed291691a6 136 }
renanbmx123 0:fbed291691a6 137 count_rx = 0;
renanbmx123 0:fbed291691a6 138 memset(&buf_rx,0,sizeof(buf_rx));
renanbmx123 0:fbed291691a6 139
renanbmx123 0:fbed291691a6 140 create_CMD(cmd,0); // Pan ID da rede
renanbmx123 0:fbed291691a6 141 sendBuffer();
renanbmx123 0:fbed291691a6 142 wait(0.5);
renanbmx123 0:fbed291691a6 143 recv_CMD(var);
renanbmx123 0:fbed291691a6 144 return 0;
renanbmx123 0:fbed291691a6 145 }
renanbmx123 0:fbed291691a6 146
renanbmx123 0:fbed291691a6 147 /* Clear all the Receive buffer */
renanbmx123 0:fbed291691a6 148 void XBEE::clear_buf(void)
renanbmx123 0:fbed291691a6 149 {
renanbmx123 0:fbed291691a6 150 count_rx = 0;
renanbmx123 0:fbed291691a6 151 memset(buf_rx,0,sizeof(buf_rx));
renanbmx123 0:fbed291691a6 152 }
renanbmx123 0:fbed291691a6 153
renanbmx123 0:fbed291691a6 154 /* Cria pacote de mensagem */
renanbmx123 0:fbed291691a6 155 int XBEE::create_TX(char * str, int dest)
renanbmx123 0:fbed291691a6 156 {
renanbmx123 0:fbed291691a6 157 int i = 0;
renanbmx123 0:fbed291691a6 158 int n = strlen(str);
renanbmx123 0:fbed291691a6 159
renanbmx123 0:fbed291691a6 160 pkt_tx *p = (pkt_tx *) buf_tx; // ponteiro para buffer global
renanbmx123 0:fbed291691a6 161
renanbmx123 0:fbed291691a6 162 uint8_t count = 0;
renanbmx123 0:fbed291691a6 163
renanbmx123 0:fbed291691a6 164 if(n > 92) {
renanbmx123 0:fbed291691a6 165 // Error: data nao pode exceder 92 bytes
renanbmx123 0:fbed291691a6 166 return -1;
renanbmx123 0:fbed291691a6 167 }
renanbmx123 0:fbed291691a6 168
renanbmx123 0:fbed291691a6 169 count_tx = 0;
renanbmx123 0:fbed291691a6 170 memset(&buf_tx,0,sizeof(buf_tx));
renanbmx123 0:fbed291691a6 171
renanbmx123 0:fbed291691a6 172 p->start_delimiter = 0x7E;
renanbmx123 0:fbed291691a6 173 p->length = 0x0E + n; // pacote vazio + dados
renanbmx123 0:fbed291691a6 174 p->frame_type = 0x10; // transmit request
renanbmx123 0:fbed291691a6 175 p->frame_id = 1;
renanbmx123 0:fbed291691a6 176
renanbmx123 0:fbed291691a6 177 if(dest == XBEE_COORD) {
renanbmx123 0:fbed291691a6 178 p->dest_addr64[6] = 0x00; //SL_H
renanbmx123 0:fbed291691a6 179 p->dest_addr64[7] = 0x00; //SL_L
renanbmx123 0:fbed291691a6 180 } else if(dest == XBEE_BROAD) {
renanbmx123 0:fbed291691a6 181 p->dest_addr64[6] = 0xFF; //SL_H
renanbmx123 0:fbed291691a6 182 p->dest_addr64[7] = 0xFF; //SL_L
renanbmx123 0:fbed291691a6 183 } else {
renanbmx123 0:fbed291691a6 184 p->dest_addr64[0] = 0x00;
renanbmx123 0:fbed291691a6 185 p->dest_addr64[1] = 0x13;
renanbmx123 0:fbed291691a6 186 p->dest_addr64[2] = 0xA2;
renanbmx123 0:fbed291691a6 187 p->dest_addr64[3] = 0x00;
renanbmx123 0:fbed291691a6 188
renanbmx123 0:fbed291691a6 189 p->dest_addr64[4] = (dest >> 24);
renanbmx123 0:fbed291691a6 190 p->dest_addr64[5] = (dest & 0x00FF0000) >> 16;
renanbmx123 0:fbed291691a6 191 p->dest_addr64[6] = (dest & 0x0000FF00) >> 8;
renanbmx123 0:fbed291691a6 192 p->dest_addr64[7] = (dest & 0x000000FF);
renanbmx123 0:fbed291691a6 193 }
renanbmx123 0:fbed291691a6 194 p->dest_addr16[0] = 0xFF; //MY_H
renanbmx123 0:fbed291691a6 195 p->dest_addr16[1] = 0xFF; //MY_L
renanbmx123 0:fbed291691a6 196
renanbmx123 0:fbed291691a6 197 memcpy(&p->rf_data, str, n);
renanbmx123 0:fbed291691a6 198
renanbmx123 0:fbed291691a6 199 // Calcula Checksum
renanbmx123 0:fbed291691a6 200
renanbmx123 0:fbed291691a6 201 // comeca 3 pra frente, tenq passar 3 adiante no final
renanbmx123 0:fbed291691a6 202 // para ler o mesmo tamanho de pacote
renanbmx123 0:fbed291691a6 203 for(i = 3; i < p->length + 3; i++) {
renanbmx123 0:fbed291691a6 204 count += buf_tx[i];
renanbmx123 0:fbed291691a6 205 //printf("\n%d\n", count);
renanbmx123 0:fbed291691a6 206 }
renanbmx123 0:fbed291691a6 207 count = 0xFF - count;
renanbmx123 0:fbed291691a6 208
renanbmx123 0:fbed291691a6 209 p->rf_data[n] = count;
renanbmx123 0:fbed291691a6 210
renanbmx123 0:fbed291691a6 211 //p->length tem o tamanho soh do frame,
renanbmx123 0:fbed291691a6 212 //pacote total eh o starter + length alto + length baixo + checksum
renanbmx123 0:fbed291691a6 213 count_tx = p->length + 4;
renanbmx123 0:fbed291691a6 214 return count_tx;
renanbmx123 0:fbed291691a6 215 }
renanbmx123 0:fbed291691a6 216
renanbmx123 0:fbed291691a6 217 /* Cria pacote de comando */
renanbmx123 0:fbed291691a6 218 int XBEE::create_CMD(char * cmd, int val)
renanbmx123 0:fbed291691a6 219 {
renanbmx123 0:fbed291691a6 220 pkt_cmd *p = (pkt_cmd *) buf_tx; // ponteiro para buffer global
renanbmx123 0:fbed291691a6 221 char str[4]; // string do val
renanbmx123 0:fbed291691a6 222 int size_cmd = strlen(cmd);
renanbmx123 0:fbed291691a6 223 //int value = dec2hex(val);
renanbmx123 0:fbed291691a6 224 int value = val;
renanbmx123 0:fbed291691a6 225 int n = 0; // tamanho em bytes do parametro do comando
renanbmx123 0:fbed291691a6 226 int i;
renanbmx123 0:fbed291691a6 227 uint8_t count = 0;
renanbmx123 0:fbed291691a6 228
renanbmx123 0:fbed291691a6 229 if(size_cmd != 2) {
renanbmx123 0:fbed291691a6 230 // Error: comando deve conter 2 chars
renanbmx123 0:fbed291691a6 231 return -1;
renanbmx123 0:fbed291691a6 232 }
renanbmx123 0:fbed291691a6 233
renanbmx123 0:fbed291691a6 234 if(val != 0) {
renanbmx123 0:fbed291691a6 235 if( (value >> 24) & 0xFF ) {
renanbmx123 0:fbed291691a6 236 str[0] = (value >> 24) & 0xFF;
renanbmx123 0:fbed291691a6 237 str[1] = (value >> 16) & 0xFF;
renanbmx123 0:fbed291691a6 238 str[2] = (value >> 8) & 0xFF;
renanbmx123 0:fbed291691a6 239 str[3] = value & 0xFF;
renanbmx123 0:fbed291691a6 240 n = 4;
renanbmx123 0:fbed291691a6 241 } else if( (value >> 16) & 0xFF ) {
renanbmx123 0:fbed291691a6 242 str[0] = (value >> 16) & 0xFF;
renanbmx123 0:fbed291691a6 243 str[1] = (value >> 8) & 0xFF;
renanbmx123 0:fbed291691a6 244 str[2] = value & 0xFF;
renanbmx123 0:fbed291691a6 245 n = 3;
renanbmx123 0:fbed291691a6 246 } else if( (value >> 8) & 0xFF ) {
renanbmx123 0:fbed291691a6 247 str[0] = (value >> 8) & 0xFF;
renanbmx123 0:fbed291691a6 248 str[1] = value & 0xFF;
renanbmx123 0:fbed291691a6 249 n = 2;
renanbmx123 0:fbed291691a6 250 } else {
renanbmx123 0:fbed291691a6 251 str[0] = value & 0xFF;
renanbmx123 0:fbed291691a6 252 n = 1;
renanbmx123 0:fbed291691a6 253 }
renanbmx123 0:fbed291691a6 254 }
renanbmx123 0:fbed291691a6 255
renanbmx123 0:fbed291691a6 256 count_tx = 0;
renanbmx123 0:fbed291691a6 257 memset(&buf_tx,0,sizeof(buf_tx));
renanbmx123 0:fbed291691a6 258
renanbmx123 0:fbed291691a6 259 p->start_delimiter = 0x7E;
renanbmx123 0:fbed291691a6 260 p->length = 0x04 + n; // pacote vazio + dados
renanbmx123 0:fbed291691a6 261 p->frame_type = 0x09; // AT Command Queue
renanbmx123 0:fbed291691a6 262 p->frame_id = 1;
renanbmx123 0:fbed291691a6 263
renanbmx123 0:fbed291691a6 264 p->command[0] = cmd[0];
renanbmx123 0:fbed291691a6 265 p->command[1] = cmd[1];
renanbmx123 0:fbed291691a6 266
renanbmx123 0:fbed291691a6 267 if(val != 0) {
renanbmx123 0:fbed291691a6 268 memcpy(&p->rf_data, str, n);
renanbmx123 0:fbed291691a6 269 }
renanbmx123 0:fbed291691a6 270
renanbmx123 0:fbed291691a6 271 // Calcula Checksum
renanbmx123 0:fbed291691a6 272
renanbmx123 0:fbed291691a6 273 // comeca 3 pra frente, tenq passar 3 adiante no final
renanbmx123 0:fbed291691a6 274 // para ler o mesmo tamanho de pacote
renanbmx123 0:fbed291691a6 275 for(i = 3; i < p->length + 3; i++) {
renanbmx123 0:fbed291691a6 276 count += buf_tx[i];
renanbmx123 0:fbed291691a6 277 //printf("\n%d\n", count);
renanbmx123 0:fbed291691a6 278 }
renanbmx123 0:fbed291691a6 279 count = 0xFF - count;
renanbmx123 0:fbed291691a6 280
renanbmx123 0:fbed291691a6 281 p->rf_data[n] = count;
renanbmx123 0:fbed291691a6 282
renanbmx123 0:fbed291691a6 283 //p->length tem o tamanho soh do frame,
renanbmx123 0:fbed291691a6 284 //pacote total eh o starter + length alto + length baixo + checksum
renanbmx123 0:fbed291691a6 285 count_tx = p->length + 4;
renanbmx123 0:fbed291691a6 286 return count_tx;
renanbmx123 0:fbed291691a6 287 }
renanbmx123 0:fbed291691a6 288
renanbmx123 0:fbed291691a6 289 /* Envia pacote do buffer_tx */
renanbmx123 0:fbed291691a6 290 void XBEE::sendBuffer(void)
renanbmx123 0:fbed291691a6 291 {
renanbmx123 0:fbed291691a6 292 if(xbee->writeable()) {
renanbmx123 0:fbed291691a6 293 for(int i = 0; i < count_tx; i++) {
renanbmx123 0:fbed291691a6 294 xbee->putc(buf_tx[i]);
renanbmx123 0:fbed291691a6 295 }
renanbmx123 0:fbed291691a6 296 //pode zerar pacote aqui
renanbmx123 0:fbed291691a6 297 }
renanbmx123 0:fbed291691a6 298 }
renanbmx123 0:fbed291691a6 299
renanbmx123 0:fbed291691a6 300 /* Printa todo o buffer de Receive, e limpa */
renanbmx123 0:fbed291691a6 301 /*
renanbmx123 0:fbed291691a6 302 void XBEE::printBuffer(void)
renanbmx123 0:fbed291691a6 303 {
renanbmx123 0:fbed291691a6 304 char flag_msg = 0;
renanbmx123 0:fbed291691a6 305 int size = sizeof(buf_rx);
renanbmx123 0:fbed291691a6 306 if(count_rx < size) {
renanbmx123 0:fbed291691a6 307 size = count_rx;
renanbmx123 0:fbed291691a6 308 }
renanbmx123 0:fbed291691a6 309 for(int i = 0; i < size; i++) {
renanbmx123 0:fbed291691a6 310 printf("%c", buf_rx[i]);
renanbmx123 0:fbed291691a6 311 flag_msg++;
renanbmx123 0:fbed291691a6 312 }
renanbmx123 0:fbed291691a6 313 if (flag_msg) {
renanbmx123 0:fbed291691a6 314 printf("\n");
renanbmx123 0:fbed291691a6 315 }
renanbmx123 0:fbed291691a6 316
renanbmx123 0:fbed291691a6 317 //Limpa buffer
renanbmx123 0:fbed291691a6 318 count_rx = 0;
renanbmx123 0:fbed291691a6 319 memset(&buf_rx,0,sizeof(buf_rx));
renanbmx123 0:fbed291691a6 320 }
renanbmx123 0:fbed291691a6 321 */
renanbmx123 0:fbed291691a6 322
renanbmx123 0:fbed291691a6 323 /* Receive and update NI variable */
renanbmx123 0:fbed291691a6 324 void XBEE::recv_NI(void)
renanbmx123 0:fbed291691a6 325 {
renanbmx123 0:fbed291691a6 326 pkt_cmd *p;
renanbmx123 0:fbed291691a6 327 int i;
renanbmx123 0:fbed291691a6 328 for(i = 0; i < count_rx; i++) {
renanbmx123 0:fbed291691a6 329 if(buf_rx[i] == 0x7E) {
renanbmx123 0:fbed291691a6 330 p = (pkt_cmd *) &buf_rx[i];
renanbmx123 0:fbed291691a6 331 }
renanbmx123 0:fbed291691a6 332 }
renanbmx123 0:fbed291691a6 333 if(p->frame_type == 0x88) {
renanbmx123 0:fbed291691a6 334 memcpy(NI, ((char *)(&p->rf_data))+2, 16);
renanbmx123 0:fbed291691a6 335 // remove o checksum do nome
renanbmx123 0:fbed291691a6 336 for(i = 15; i >= 0; i--) {
renanbmx123 0:fbed291691a6 337 if(NI[i] != 0) {
renanbmx123 0:fbed291691a6 338 NI[i] = '\0';
renanbmx123 0:fbed291691a6 339 break;
renanbmx123 0:fbed291691a6 340 }
renanbmx123 0:fbed291691a6 341 }
renanbmx123 0:fbed291691a6 342 }
renanbmx123 0:fbed291691a6 343 }
renanbmx123 0:fbed291691a6 344
renanbmx123 0:fbed291691a6 345 /* Receive and update CMD variable */
renanbmx123 0:fbed291691a6 346 void XBEE::recv_CMD(int &cmd)
renanbmx123 0:fbed291691a6 347 {
renanbmx123 0:fbed291691a6 348 char data[16];
renanbmx123 0:fbed291691a6 349 pkt_cmd *p;
renanbmx123 0:fbed291691a6 350 int i;
renanbmx123 0:fbed291691a6 351 int j = -1;
renanbmx123 0:fbed291691a6 352
renanbmx123 0:fbed291691a6 353 for(i = 0; i < count_rx; i++) {
renanbmx123 0:fbed291691a6 354 if(buf_rx[i] == 0x7E) {
renanbmx123 0:fbed291691a6 355 p = (pkt_cmd *) &buf_rx[i];
renanbmx123 0:fbed291691a6 356 }
renanbmx123 0:fbed291691a6 357 }
renanbmx123 0:fbed291691a6 358 if(p->frame_type == 0x88) {
renanbmx123 0:fbed291691a6 359 memcpy(data, &p->rf_data, 16);
renanbmx123 0:fbed291691a6 360 for(i = 15; i > -1; i--) {
renanbmx123 0:fbed291691a6 361 if(data[i] != 0 || j != -1) {
renanbmx123 0:fbed291691a6 362 // pular o checksum
renanbmx123 0:fbed291691a6 363 if(j==-1) {
renanbmx123 0:fbed291691a6 364 j++;
renanbmx123 0:fbed291691a6 365 } else {
renanbmx123 0:fbed291691a6 366 //ID = (int)(dec2hex((data[i] << 8)) + dec2hex(data[i+1]));
renanbmx123 0:fbed291691a6 367 cmd += data[i] << 8*j;
renanbmx123 0:fbed291691a6 368 j++;
renanbmx123 0:fbed291691a6 369 }
renanbmx123 0:fbed291691a6 370 }
renanbmx123 0:fbed291691a6 371 }
renanbmx123 0:fbed291691a6 372 }
renanbmx123 0:fbed291691a6 373 }
renanbmx123 0:fbed291691a6 374
renanbmx123 0:fbed291691a6 375 /* Verify Packet Checksum return 0 if msg OK, just work with Transmit Package*/
renanbmx123 0:fbed291691a6 376 /*
renanbmx123 0:fbed291691a6 377 char XBEE::validPackage(uint8_t * buf, int tam)
renanbmx123 0:fbed291691a6 378 {
renanbmx123 0:fbed291691a6 379 int i = 0;
renanbmx123 0:fbed291691a6 380 uint8_t count = 0;
renanbmx123 0:fbed291691a6 381
renanbmx123 0:fbed291691a6 382 if(buf[0] != 0x7E) return 1;
renanbmx123 0:fbed291691a6 383 if(buf[1] != 0) return 2;
renanbmx123 0:fbed291691a6 384 if(buf[2] != tam-4) return 3;
renanbmx123 0:fbed291691a6 385
renanbmx123 0:fbed291691a6 386 for(i = 3; i < tam; i++) {
renanbmx123 0:fbed291691a6 387 count += buf[i];
renanbmx123 0:fbed291691a6 388 }
renanbmx123 0:fbed291691a6 389 if(count != 0xFF) return 4;
renanbmx123 0:fbed291691a6 390
renanbmx123 0:fbed291691a6 391 return 0; // OK
renanbmx123 0:fbed291691a6 392 }
renanbmx123 0:fbed291691a6 393 */
renanbmx123 0:fbed291691a6 394
renanbmx123 0:fbed291691a6 395 /* Convert Dec to Hex, OBS: just for Hex number without Letter */
renanbmx123 0:fbed291691a6 396 int XBEE::dec2hex(int nbr)
renanbmx123 0:fbed291691a6 397 {
renanbmx123 0:fbed291691a6 398 char hexa[8];
renanbmx123 0:fbed291691a6 399 int temp;
renanbmx123 0:fbed291691a6 400 int result = 0;
renanbmx123 0:fbed291691a6 401 int i = 0;
renanbmx123 0:fbed291691a6 402 char hasLetter = 0;
renanbmx123 0:fbed291691a6 403
renanbmx123 0:fbed291691a6 404 while(nbr != 0)
renanbmx123 0:fbed291691a6 405 {
renanbmx123 0:fbed291691a6 406 temp = nbr % 16;
renanbmx123 0:fbed291691a6 407 hexa[i] = temp;
renanbmx123 0:fbed291691a6 408 nbr = nbr / 16;
renanbmx123 0:fbed291691a6 409 i++;
renanbmx123 0:fbed291691a6 410 if(temp > 9) {
renanbmx123 0:fbed291691a6 411 hasLetter++;
renanbmx123 0:fbed291691a6 412 }
renanbmx123 0:fbed291691a6 413 }
renanbmx123 0:fbed291691a6 414 // concat number
renanbmx123 0:fbed291691a6 415 for(i=i-1; i > -1; i--) {
renanbmx123 0:fbed291691a6 416 result += hexa[i] * pow(10.0,(double)i);
renanbmx123 0:fbed291691a6 417 }
renanbmx123 0:fbed291691a6 418
renanbmx123 0:fbed291691a6 419 return result;
renanbmx123 0:fbed291691a6 420 }
renanbmx123 0:fbed291691a6 421
renanbmx123 0:fbed291691a6 422 /* Convert Hex to Dec */
renanbmx123 0:fbed291691a6 423 int XBEE::hex2dec(int nbr)
renanbmx123 0:fbed291691a6 424 {
renanbmx123 0:fbed291691a6 425 char deci[8];
renanbmx123 0:fbed291691a6 426 int result = 0;
renanbmx123 0:fbed291691a6 427 int i = 0;
renanbmx123 0:fbed291691a6 428 int temp;
renanbmx123 0:fbed291691a6 429 char hasLetter = 0;
renanbmx123 0:fbed291691a6 430
renanbmx123 0:fbed291691a6 431 while(nbr != 0) {
renanbmx123 0:fbed291691a6 432 temp = nbr % 10;
renanbmx123 0:fbed291691a6 433 deci[i] = temp;
renanbmx123 0:fbed291691a6 434 nbr = nbr / 10;
renanbmx123 0:fbed291691a6 435 i++;
renanbmx123 0:fbed291691a6 436 if(temp > 9) {
renanbmx123 0:fbed291691a6 437 hasLetter++;
renanbmx123 0:fbed291691a6 438 }
renanbmx123 0:fbed291691a6 439 }
renanbmx123 0:fbed291691a6 440 // concat number
renanbmx123 0:fbed291691a6 441 for(i=i-1; i > -1; i--) {
renanbmx123 0:fbed291691a6 442 result += (deci[i] * pow(16.0,(double)i) );
renanbmx123 0:fbed291691a6 443 }
renanbmx123 0:fbed291691a6 444 return result;
renanbmx123 0:fbed291691a6 445 }
renanbmx123 0:fbed291691a6 446 void XBEE::int_mng(int value){
renanbmx123 0:fbed291691a6 447 int_ctrl = value;
renanbmx123 0:fbed291691a6 448 }