nucho
RTno/SendPacket.cpp@1:ab3c75cf5906, 2011-08-01 (annotated)
- Committer:
- nucho
- Date:
- Mon Aug 01 14:45:42 2011 +0000
- Revision:
- 1:ab3c75cf5906
- Parent:
- 0:a70ea71286b6
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| nucho | 0:a70ea71286b6 | 1 | /******************************************* |
| nucho | 0:a70ea71286b6 | 2 | * SendPacket.cpp |
| nucho | 0:a70ea71286b6 | 3 | * @author Yuki Suga |
| nucho | 0:a70ea71286b6 | 4 | * @copyright Yuki Suga (ysuga.net) Nov, 10th, 2010. |
| nucho | 0:a70ea71286b6 | 5 | * @license LGPLv3 |
| nucho | 0:a70ea71286b6 | 6 | *****************************************/ |
| nucho | 0:a70ea71286b6 | 7 | /******************************************** |
| nucho | 0:a70ea71286b6 | 8 | It changed a little for mbed. |
| nucho | 0:a70ea71286b6 | 9 | The serial buffer is not used. |
| nucho | 0:a70ea71286b6 | 10 | 2011/7/27 @nucho |
| nucho | 0:a70ea71286b6 | 11 | ********************************************/ |
| nucho | 0:a70ea71286b6 | 12 | #include "Packet.h" |
| nucho | 0:a70ea71286b6 | 13 | //#include <HardwareSerial.h> |
| nucho | 0:a70ea71286b6 | 14 | //#include <WConstants.h> |
| nucho | 0:a70ea71286b6 | 15 | #include "Serial.h" |
| nucho | 0:a70ea71286b6 | 16 | |
| nucho | 0:a70ea71286b6 | 17 | int SendPacket(const char interface, const char data_length, const char* packet_data) { |
| nucho | 0:a70ea71286b6 | 18 | unsigned char sum = 0; |
| nucho | 0:a70ea71286b6 | 19 | |
| nucho | 0:a70ea71286b6 | 20 | pc.putc(interface); |
| nucho | 0:a70ea71286b6 | 21 | sum += interface; |
| nucho | 0:a70ea71286b6 | 22 | |
| nucho | 0:a70ea71286b6 | 23 | pc.putc(data_length); |
| nucho | 0:a70ea71286b6 | 24 | sum += data_length; |
| nucho | 0:a70ea71286b6 | 25 | for(int i = 0;i < data_length;i++) { |
| nucho | 0:a70ea71286b6 | 26 | sum += packet_data[i]; |
| nucho | 0:a70ea71286b6 | 27 | pc.putc(packet_data[i]); |
| nucho | 0:a70ea71286b6 | 28 | } |
| nucho | 0:a70ea71286b6 | 29 | // if(data_length != 0) { |
| nucho | 0:a70ea71286b6 | 30 | //n Serial.write((const uint8_t*)packet_data, data_length); |
| nucho | 0:a70ea71286b6 | 31 | // } |
| nucho | 0:a70ea71286b6 | 32 | //sum = 32; |
| nucho | 0:a70ea71286b6 | 33 | pc.putc(sum); |
| nucho | 0:a70ea71286b6 | 34 | return PACKET_HEADER_SIZE + data_length + 1; |
| nucho | 0:a70ea71286b6 | 35 | } |