void SendQuadcopterData() {
#ifdef ENABLE_SERIAL
packet[0] = 'g';
packet[1] = lift;
packet[2] = pitch;
packet[3] = yaw;
packet[4] = roll;
packet[5] = gyroDiv;
if (resetGyro)
packet[6] = 'r';
else
packet[6] = 's';
packet[7] = '\0';
resetGyro = false;
//printf("%d %d %d %d\n", lift, yaw, pitch, roll);
if (serial.IsOpened()) {
serial.SendData((const char *)packet, length);
}
else {
printf("Serial not opened!!!\n");
}
#endif
}
void Programming::sendResetCmd(CSerial &serial) {
if(!serial.IsOpened()) {
std::cout << "Serial is not connected" << std::endl;
return;
}
char resetChar = '#';
serial.SendData(&resetChar, 1);
}
BOOL readData(string str){
char* lpBuffer = new char[100];
while(true){
if(serial.ReadDataWaiting()){
try{
int bytesRead = serial.ReadData(lpBuffer,30);
controlComms.printChars(lpBuffer);
Sleep(500);
delete []lpBuffer;
} catch(exception ex){
}
}
Sleep(100);
}
if(serial.IsOpened()) serial.Close();
}
