Dependencies:   mbed QEI

RTno/SendPacket.cpp

Committer:
nucho
Date:
2011-08-01
Revision:
1:7f0fc0d1f777
Parent:
0:3c49891bc39d

File content as of revision 1:7f0fc0d1f777:

/*******************************************
 * 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;
}