SendPacket.cpp

00001 /*******************************************
00002  * SendPacket.cpp
00003  * @author Yuki Suga
00004  * @copyright Yuki Suga (ysuga.net) Nov, 10th, 2010.
00005  * @license LGPLv3
00006  *****************************************/
00007 /********************************************
00008 It changed a little for mbed. 
00009 The serial buffer is not used. 
00010 2011/7/27 @nucho
00011 ********************************************/
00012 #include "Packet.h"
00013 //#include <HardwareSerial.h>
00014 //#include <WConstants.h>
00015 #include "Serial.h"
00016 
00017 int SendPacket(const char interface, const char data_length, const char* packet_data) {
00018   unsigned char sum = 0;
00019 
00020   pc.putc(interface);
00021   sum += interface;
00022 
00023   pc.putc(data_length);
00024   sum += data_length;
00025   for(int i = 0;i < data_length;i++) {
00026     sum += packet_data[i];
00027     pc.putc(packet_data[i]);
00028   }
00029   //  if(data_length != 0) {
00030   //n    Serial.write((const uint8_t*)packet_data, data_length);
00031   //  }
00032   //sum = 32;
00033   pc.putc(sum);
00034   return PACKET_HEADER_SIZE + data_length + 1;
00035 }