nucho
/
RTno_MotorControl
RTno/SendPacket.cpp
- Committer:
- nucho
- Date:
- 2011-07-29
- Revision:
- 0:3c49891bc39d
File content as of revision 0:3c49891bc39d:
/******************************************* * SendPacket.cpp * @author Yuki Suga * @copyright Yuki Suga (ysuga.net) Nov, 10th, 2010. * @license LGPLv3 *****************************************/ /******************************************** It changed a little for mbed. The serial buffer is not used. 2011/7/27 @nucho ********************************************/ #include "Packet.h" //#include <HardwareSerial.h> //#include <WConstants.h> #include "Serial.h" int SendPacket(const char interface, const char data_length, const char* packet_data) { unsigned char sum = 0; pc.putc(interface); sum += interface; pc.putc(data_length); sum += data_length; for(int i = 0;i < data_length;i++) { sum += packet_data[i]; pc.putc(packet_data[i]); } // if(data_length != 0) { //n Serial.write((const uint8_t*)packet_data, data_length); // } //sum = 32; pc.putc(sum); return PACKET_HEADER_SIZE + data_length + 1; }