mirror of
https://github.com/thunderbug1/Spherebot-Host-GUI.git
synced 2026-03-03 00:23:59 +01:00
aec078c865
outsourced the receiving to a seperate thread. This allows us to use much lower baudrates but still have a responsive UI. Set Baudrate to 57600 baud
98 lines
2.2 KiB
C++
98 lines
2.2 KiB
C++
#include "spherebot.h"
|
|
|
|
spherebot::spherebot(QObject *parent) :
|
|
QObject(parent)
|
|
{
|
|
port = new QSerialPort();
|
|
port_connected = false;
|
|
lastSentLine = "";
|
|
}
|
|
|
|
bool spherebot::connectWithBot()
|
|
{
|
|
port->open(QIODevice::ReadWrite); //we open the port
|
|
if(!port->isOpen())
|
|
{
|
|
//QMessageBox::warning(this, "port error", "Impossible to open the port!");
|
|
return 0;
|
|
}
|
|
|
|
//we set the port properties
|
|
//port->setBaudRate(9600);
|
|
port->setBaudRate(57600);
|
|
//port->setBaudRate(115200);//modify the port settings on your own
|
|
//port->setBaudRate(256000);
|
|
port->setFlowControl(QSerialPort::NoFlowControl);
|
|
port->setParity(QSerialPort::NoParity);
|
|
port->setDataBits(QSerialPort::Data8);
|
|
port->setStopBits(QSerialPort::OneStop);
|
|
port_connected = true;
|
|
return 1;
|
|
}
|
|
|
|
bool spherebot::connectWithBot(QString portName)
|
|
{
|
|
port->setPortName(portName);
|
|
return connectWithBot();
|
|
}
|
|
|
|
bool spherebot::disconnectWithBot()
|
|
{
|
|
qDebug("port closed");
|
|
port->close();
|
|
port_connected = false;
|
|
return 1;
|
|
}
|
|
|
|
QString spherebot::generateChecksumString(QString msg)
|
|
{
|
|
QString result = "*"; //"*" is the startcharacter of the checksum
|
|
std::string msgString= msg.toStdString();
|
|
int cs = 0;
|
|
for(int i=0;i<msg.size();i++)
|
|
{
|
|
cs = cs ^ (int)msgString[i];
|
|
cs &= 0xff; // Defensive programming...
|
|
}
|
|
result += QString::number(cs);
|
|
qDebug()<<"checksum is: "<< cs <<endl;
|
|
return result;
|
|
}
|
|
|
|
bool spherebot::send(QString cmd)
|
|
{
|
|
if(port->isOpen())
|
|
{
|
|
port->flush();
|
|
lastSentLine.clear();
|
|
lastSentLine.append(cmd);
|
|
if(cmd.size() != 0)
|
|
{
|
|
if(cmd[cmd.size()-1] == '\n') cmd.chop(1);
|
|
}
|
|
cmd.append(" ");
|
|
cmd.append(generateChecksumString(cmd));
|
|
qDebug()<<"Sending: " + cmd;
|
|
cmd.append("\n");
|
|
port->write((const char*)cmd.toUtf8(),cmd.length());
|
|
}
|
|
else
|
|
{
|
|
qDebug()<<port->errorString()<<" port is not open";
|
|
return false;
|
|
}
|
|
cmd.chop(1);
|
|
emit dataSent(cmd);
|
|
return true;
|
|
}
|
|
|
|
bool spherebot::repeatLastLine()
|
|
{
|
|
return send(lastSentLine);
|
|
}
|
|
|
|
bool spherebot::isConnected()
|
|
{
|
|
return port_connected;
|
|
}
|