HAHA
Dependencies: WebSocketClient mbed
trame.cpp@6:f1e9dc6b24c7, 2014-04-07 (annotated)
- Committer:
- RufflesAllD
- Date:
- Mon Apr 07 15:43:16 2014 +0000
- Revision:
- 6:f1e9dc6b24c7
- Parent:
- 5:daf08fff7abb
mn
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
joGenie | 2:7515831bb5f5 | 1 | #include "trame.hpp" |
joGenie | 2:7515831bb5f5 | 2 | |
joGenie | 2:7515831bb5f5 | 3 | Trame::Trame(PinName _tx, PinName _rx) : |
joGenie | 2:7515831bb5f5 | 4 | tx(_tx), |
joGenie | 2:7515831bb5f5 | 5 | rx(_rx) |
joGenie | 2:7515831bb5f5 | 6 | { |
joGenie | 2:7515831bb5f5 | 7 | } |
joGenie | 2:7515831bb5f5 | 8 | |
joGenie | 3:350f07072089 | 9 | void Trame::sendATCommand(const char* command, const char* data, int length) |
joGenie | 2:7515831bb5f5 | 10 | { |
RufflesAllD | 5:daf08fff7abb | 11 | int tmp = length + 4; // length (grandeur du data à envoyer) 4 (API(1), FrameID(1), AT Command(2)) |
RufflesAllD | 5:daf08fff7abb | 12 | char* trm = new char[tmp + 4]; // 4 (Delimiter(1), Length(2), Checksum(1)) |
joGenie | 3:350f07072089 | 13 | |
joGenie | 3:350f07072089 | 14 | trm[0] = 0x7E; // Delimiter |
joGenie | 3:350f07072089 | 15 | trm[1] = static_cast<char>((tmp >> 8) & 0xFF); // MSB de length |
joGenie | 3:350f07072089 | 16 | trm[2] = static_cast<char>(tmp & 0xFF); // LSB length |
RufflesAllD | 5:daf08fff7abb | 17 | trm[3] = 0x09; // Type |
joGenie | 3:350f07072089 | 18 | trm[4] = 0x01; // API |
joGenie | 3:350f07072089 | 19 | trm[5] = command[0]; |
joGenie | 3:350f07072089 | 20 | trm[6] = command[1]; |
joGenie | 3:350f07072089 | 21 | for (int i = 0; i < length; i++) |
joGenie | 3:350f07072089 | 22 | trm[7+i] = data[i]; //Data |
joGenie | 4:56b1ca37a175 | 23 | trm[7+length] = crc8(trm, tmp + 3); |
joGenie | 3:350f07072089 | 24 | |
joGenie | 2:7515831bb5f5 | 25 | Serial xbee(tx, rx); |
joGenie | 4:56b1ca37a175 | 26 | for (int i = 0; i < tmp + 4; i++) |
joGenie | 4:56b1ca37a175 | 27 | xbee.putc(trm[i]); //Transmition des donnees |
joGenie | 3:350f07072089 | 28 | |
joGenie | 3:350f07072089 | 29 | wait(0.01); |
joGenie | 3:350f07072089 | 30 | delete trm; |
joGenie | 3:350f07072089 | 31 | } |
joGenie | 3:350f07072089 | 32 | |
joGenie | 3:350f07072089 | 33 | void Trame::sendTransmitRequest(const char* destination, const char* data, int length) |
joGenie | 3:350f07072089 | 34 | { |
RufflesAllD | 5:daf08fff7abb | 35 | int tmp = length + 14; // length (grandeur du data à envoyer) 14 (API(1), FrameID(1), MAC(8), 16bit(2), Radius(1), Options(1)) |
RufflesAllD | 5:daf08fff7abb | 36 | char* trm = new char[tmp + 4]; // 4 (Delimiter(1), Length(2), Checksum(1)) |
joGenie | 3:350f07072089 | 37 | |
joGenie | 3:350f07072089 | 38 | trm[0] = 0x7E; // Delimiter |
joGenie | 3:350f07072089 | 39 | trm[1] = static_cast<char>((tmp >> 8) & 0xFF); // MSB de length |
joGenie | 3:350f07072089 | 40 | trm[2] = static_cast<char>(tmp & 0xFF); // LSB length |
joGenie | 3:350f07072089 | 41 | trm[3] = 0x10; // Type |
joGenie | 3:350f07072089 | 42 | trm[4] = 0x01; // API |
joGenie | 3:350f07072089 | 43 | for (int i = 0; i < 8; i++) |
joGenie | 3:350f07072089 | 44 | trm[5 + i] = destination[i]; //Destination |
joGenie | 4:56b1ca37a175 | 45 | trm[13] = 0xFF; // 16 bits address |
joGenie | 4:56b1ca37a175 | 46 | trm[14] = 0xFE; // 16 bits address |
joGenie | 3:350f07072089 | 47 | trm[15] = 0x00; // Radius |
joGenie | 3:350f07072089 | 48 | trm[16] = 0x00; // Options |
joGenie | 3:350f07072089 | 49 | |
joGenie | 3:350f07072089 | 50 | for (int i = 0; i < length; i++) |
joGenie | 3:350f07072089 | 51 | trm[17 + i] = data[i]; // Data |
joGenie | 3:350f07072089 | 52 | |
joGenie | 4:56b1ca37a175 | 53 | trm[17 + length] = crc8(trm, tmp + 3); |
joGenie | 3:350f07072089 | 54 | |
joGenie | 3:350f07072089 | 55 | Serial xbee(tx, rx); |
joGenie | 4:56b1ca37a175 | 56 | for (int i = 0; i < tmp + 4; i++) |
joGenie | 3:350f07072089 | 57 | xbee.putc(trm[i]); |
joGenie | 3:350f07072089 | 58 | |
joGenie | 3:350f07072089 | 59 | wait(0.01); |
joGenie | 3:350f07072089 | 60 | delete trm; |
joGenie | 3:350f07072089 | 61 | } |
joGenie | 3:350f07072089 | 62 | |
joGenie | 3:350f07072089 | 63 | unsigned char Trame::crc8(const char* data, int length) |
joGenie | 3:350f07072089 | 64 | { |
joGenie | 3:350f07072089 | 65 | unsigned char crc = 0; |
joGenie | 4:56b1ca37a175 | 66 | for (int i = 3; i < length; i++) |
joGenie | 3:350f07072089 | 67 | crc += data[i]; |
joGenie | 3:350f07072089 | 68 | |
joGenie | 3:350f07072089 | 69 | return (0xFF - crc); |
RufflesAllD | 5:daf08fff7abb | 70 | } |
RufflesAllD | 5:daf08fff7abb | 71 | |
RufflesAllD | 5:daf08fff7abb | 72 | void Trame::checkTrame(char *data, char check, int length) |
RufflesAllD | 5:daf08fff7abb | 73 | { |
RufflesAllD | 5:daf08fff7abb | 74 | Serial pc(USBTX, USBRX); |
RufflesAllD | 5:daf08fff7abb | 75 | |
RufflesAllD | 5:daf08fff7abb | 76 | pc.printf("%d : data : ", length); |
RufflesAllD | 5:daf08fff7abb | 77 | |
RufflesAllD | 5:daf08fff7abb | 78 | for (int a = 0; a < length; a++) |
RufflesAllD | 5:daf08fff7abb | 79 | { |
RufflesAllD | 5:daf08fff7abb | 80 | pc.printf("%x ", data[a]); |
RufflesAllD | 5:daf08fff7abb | 81 | } |
RufflesAllD | 5:daf08fff7abb | 82 | pc.printf(": check : %x\n\r", check); |
RufflesAllD | 5:daf08fff7abb | 83 | } |