azaion/autopilot
1
0
Fork 0
mirror of https://github.com/azaion/autopilot.git synced 2026-04-22 14:26:34 +00:00
Code Issues Packages Projects Releases Wiki Activity

Refactored a8 codes and added remote testing app a8_remote.

Browse Source
This commit is contained in:
Nffj84
2024-07-02 11:31:12 +03:00
parent c03d477c45
commit b39e58dbc1
499 changed files with 1209 additions and 463 deletions
Download Patch File Download Diff File Expand all files Collapse all files
misc/camera/a8/serialPort.cpp
+49 -22
View File
@@ -1,60 +1,87 @@
#include "serialPort.h"
#include "serialPort.hpp"
#include <QCoreApplication>
#include <QDebug>
#include "defines.h"
#include "defines.hpp"
#include "utilsCRC16.hpp"
SerialPort::SerialPort(const QString &portName)
: mSerialPort(portName)
SerialPort::SerialPort()
: QObject(nullptr)
{
mSerialPort.setPortName(portName);
mSerialPort.setBaudRate(QSerialPort::Baud115200);
mSerialPort.setDataBits(QSerialPort::Data8);
mSerialPort.setStopBits(QSerialPort::OneStop);
mSerialPort.setFlowControl(QSerialPort::NoFlowControl);
mSerialPort = new QSerialPort();
mSerialPort->setPortName(SERIAL_PORT);
mSerialPort->setBaudRate(QSerialPort::Baud115200);
mSerialPort->setDataBits(QSerialPort::Data8);
mSerialPort->setStopBits(QSerialPort::OneStop);
mSerialPort->setFlowControl(QSerialPort::NoFlowControl);
// Open the serial port
if (openPort() == false) {
qCritical() << "SerialPort(): Unable to open port";
return;
}
}
SerialPort::~SerialPort()
{
closePort(); // Close port if open on destruction
closePort();
delete mSerialPort;
}
bool SerialPort::openPort()
{
if (mSerialPort.isOpen()) {
qDebug() << "Port already open";
if (mSerialPort->isOpen()) {
qDebug().noquote().nospace() << "Port already open";
return true;
}
return mSerialPort.open(QIODevice::ReadWrite);
return mSerialPort->open(QIODevice::ReadWrite);
}
void SerialPort::closePort()
{
if (mSerialPort.isOpen()) {
mSerialPort.close();
if (mSerialPort->isOpen()) {
mSerialPort->close();
}
}
void SerialPort::sendCommand(const QByteArray &command)
{
if (!mSerialPort.isOpen()) {
qDebug() << "Error: Port not open";
QByteArray toSend = command;
int8_t crcBytes[2];
UtilsCRC16::getCRCBytes(toSend, crcBytes);
toSend.resize(toSend.size() + 2); // Increase array size to accommodate CRC bytes
toSend[toSend.size() - 2] = crcBytes[0]; // Set LSB
toSend[toSend.size() - 1] = crcBytes[1]; // Set MSB
QString commandStr;
for (int i = 0; i < toSend.size(); i++) {
if (i > 0) {
commandStr += ",";
}
commandStr += QString("0x%1").arg(toSend.at(i), 2, 16, QChar('0')).toUpper();
commandStr.replace("0X", "0x");
}
qDebug().noquote().nospace() << "Command: " << commandStr;
if (!mSerialPort->isOpen()) {
qCritical().noquote().nospace() << "Error: Port not open (sendCommand)";
return;
}
mSerialPort.write(command);
mSerialPort->write(toSend);
}
QByteArray SerialPort::readResponse()
{
if (!mSerialPort.isOpen()) {
qDebug() << "Error: Port not open";
if (!mSerialPort->isOpen()) {
qDebug().noquote().nospace() << "Error: Port not open (readResponse)";
return QByteArray();
}
// Read data from serial port until timeout or specific criteria met
QByteArray response;
while (mSerialPort.waitForReadyRead(SERIAL_RESPONSE_WAIT_TIME)) { // Adjust timeout as needed
response.append(mSerialPort.readAll());
while (mSerialPort->waitForReadyRead(SERIAL_RESPONSE_WAIT_TIME)) { // Adjust timeout as needed
response.append(mSerialPort->readAll());
}
return response;