blob: 93adf280ec68af55ac28865c37009f1bfa7e2569 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
|
#include "serial.h"
#include "../shared/serial_parse.h"
#include <iostream>
#include <QDebug>
#include <QSerialPort>
#include <QSerialPortInfo>
CDSerialConnector::CDSerialConnector() {
this->_serial = new QSerialPort;
if (!_serial->setBaudRate(QSerialPort::Baud9600)) qDebug() << _serial->errorString();
if (!_serial->setDataBits(QSerialPort::Data8)) // data is 8 bits
qDebug() << _serial->errorString();
if (!_serial->setParity(QSerialPort::NoParity)) qDebug() << _serial->errorString();
if (!_serial->setFlowControl(QSerialPort::NoFlowControl)) // default: QSerialPort::NoFlowControl
qDebug() << _serial->errorString();
if (!_serial->setStopBits(QSerialPort::OneStop)) // default
qDebug() << _serial->errorString();
}
CDSerialConnector::~CDSerialConnector() { delete this->_serial; }
void CDSerialConnector::action() {
// this is called when readyRead();
int bytes = _serial->bytesAvailable();
if (bytes > 0) {
qDebug() << "new Data arived" << _serial->bytesAvailable();
_msg = _serial->readAll();
qDebug() << _msg;
}
// string std_string = _msg.toStdString();
// size_t size = std_string.size();
// const char* data = std_string.c_str();
// for (size_t i = 0; i < size; i++)
// cd_serial_parse(data[i]);
}
void CDSerialConnector::write(QByteArray msg) {
_serial->write(msg);
qDebug() << _serial->errorString();
}
void CDSerialConnector::connect(string port) {
_serial->setPortName(QString::fromStdString(port));
// QIODevice::ReadOnly
if (!_serial->open(QIODevice::ReadWrite)) qDebug() << _serial->errorString();
QObject::connect(_serial, &QSerialPort::readyRead, [&] {
// this is called when readyRead();
action();
});
}
void CDSerialConnector::disconnect() {
if (_serial->isOpen() == false) return;
_serial->disconnect();
}
QByteArray CDSerialConnector::get_data() { return _msg; }
vector<string> CDSerialConnector::get_ports() {
vector<string> ports;
for (QSerialPortInfo port : QSerialPortInfo::availablePorts())
ports.push_back(port.portName().toStdString());
return ports;
}
string CDSerialConnector::get_port() {
return _serial->portName().toStdString();
}
extern "C" {
void cd_cmd_response(cd_s_bin* data) {
(void) data;
std::cout << "received!" << std::endl;
return;
}
}
|