mirror of
https://github.com/thunderbug1/Spherebot-Host-GUI.git
synced 2026-02-27 14:51:18 +01:00
67 lines
1.4 KiB
C++
67 lines
1.4 KiB
C++
#include "spherebot.h"
|
|
|
|
spherebot::spherebot(QObject *parent) :
|
|
QObject(parent)
|
|
{
|
|
port = NULL;
|
|
port_connected = false;
|
|
}
|
|
|
|
bool spherebot::connectWithBot(QString portName)
|
|
{
|
|
port = new QextSerialPort(portName , QextSerialPort::Polling); //we create the port
|
|
|
|
|
|
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(BAUD115200);//modify the port settings on your own
|
|
port->setFlowControl(FLOW_OFF);
|
|
port->setParity(PAR_NONE);
|
|
port->setDataBits(DATA_8);
|
|
port->setStopBits(STOP_1);
|
|
port->setRts( true );
|
|
port->setDtr( true );
|
|
//port->setQueryMode( QextSerialPort::EventDriven );
|
|
port_connected = true;
|
|
return 1;
|
|
}
|
|
|
|
bool spherebot::disconnectWithBot()
|
|
{
|
|
qDebug("port closed");
|
|
port->close();
|
|
port_connected = false;
|
|
return 1;
|
|
}
|
|
|
|
bool spherebot::send(QString cmd)
|
|
{
|
|
if(port->isOpen())
|
|
{
|
|
port->flush();
|
|
if(cmd[cmd.size()-1] != '\n') cmd.append("\n");
|
|
qDebug()<<"Sending: " + cmd;
|
|
port->write((const char*)cmd.toUtf8(),cmd.length());
|
|
|
|
}
|
|
else
|
|
{
|
|
qDebug()<<port->errorString();
|
|
return false;
|
|
}
|
|
cmd.chop(1);
|
|
emit dataSent(cmd);
|
|
return true;
|
|
}
|
|
|
|
bool spherebot::isConnected()
|
|
{
|
|
return port_connected;
|
|
}
|