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(); }