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
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
|
#include <QObject>
#include <QDebug>
#include <QCanBusFrame>
#include <QSettings>
#include <QStringBuilder>
#include <QtNetwork>
#include "utility.h"
#include "canlogserver.h"
CanLogServer::CanLogServer(QString serverAddressString) :
CANConnection(serverAddressString, "CanLogserver", CANCon::CANLOGSERVER, 0, 0, false, 0, 1, 4000, true),
m_ptcpSocket(new QTcpSocket(this))
{
qDebug() << "Canlogserver: " << "Constructing new Connection...";
CANBus bus_info;
bus_info.setActive(true);
bus_info.setListenOnly(true);
bus_info.setSpeed(500000);
setBusConfig(0, bus_info);
// Connect data ready signal
connect(m_ptcpSocket, SIGNAL(readyRead()), this, SLOT(readNetworkData()));
// Connect network connected signal
connect(m_ptcpSocket, SIGNAL(connected()),this, SLOT(networkConnected()));
// Connect network disconnected signal
connect(m_ptcpSocket, SIGNAL(disconnected()),this, SLOT(networkDisconnected()));
// Save address
this->m_qsAddress = serverAddressString;
}
CanLogServer::~CanLogServer()
{
qDebug() << "Canlogserver: " << "Deconstructing Connection...";
stop();
m_ptcpSocket->close();
delete m_ptcpSocket;
m_ptcpSocket = NULL;
}
void CanLogServer::readNetworkData()
{
// If capture is suspended bail out after reading the bytes from the network. No need to parse them
if(isCapSuspended())
return;
while (m_ptcpSocket->canReadLine()) {
// Get a complete line and remove whitespace at the start and at the end of the string
QString data = QString(m_ptcpSocket->readLine()).trimmed();
// Split to space (obtain "<(time)> <canID> <msgId#data>")
QStringList lstData = data.split(" ");
// Expect 3 item in list
if(lstData.size() == 3){
// Obtain the timestamp. Remove '(', ')' and '.' (logserver send as "(time.fraction)").
QString qstrTs = lstData[0].remove(QChar('(')).remove(QChar('.')).remove(QChar(')'));
// One bus only. TODO: Use another parameter in connection conf for spcify can bus id to capture.
QString qstrCanId = "0";
// Split frame
QStringList lstMsg = lstData[2].split("#");
// Expect 2 item (<id>#<payload>)
if(lstMsg.size() == 2){
// Extract id
QString qstrId = lstMsg[0];
// Extract payload
QString qstrPayload = lstMsg[1];
// Support only normal can message. Extended CAN not supported.
if(qstrId.size() <= 4){
// Prepare the frame
CANFrame* frame_p = getQueue().get();
// Check for frame existence
if(frame_p){
// Set frame ID
frame_p->setFrameId(qstrId.toInt(nullptr, 16));
// Extended frame NOT SUPPORTED
frame_p->setExtendedFrameFormat(0);
// Set bus id
frame_p->bus = qstrCanId.toInt();
// Set frame type
frame_p->setFrameType(QCanBusFrame::DataFrame);
// Frame is recived
frame_p->isReceived = true;
// Set timestamp
frame_p->setTimeStamp(QCanBusFrame::TimeStamp(0, qstrTs.toULongLong()));
// Set payload
frame_p->setPayload(QByteArray::fromHex(qstrPayload.toUtf8()));
// Elaborate frame
checkTargettedFrame(*frame_p);
/* enqueue frame */
getQueue().queue();
}
qDebug() << data << "---" << qstrTs << " - " << qstrId << " + " << qstrPayload;
}
}
}
}
}
void CanLogServer::networkConnected()
{
CANConStatus stats;
qDebug() << "networkConnected";
setStatus(CANCon::CONNECTED);
stats.conStatus = getStatus();
stats.numHardwareBuses = 1;
emit status(stats);
}
void CanLogServer::networkDisconnected()
{
qDebug() << "networkDisconnected";
}
void CanLogServer::piStarted()
{
this->connectToDevice();
}
void CanLogServer::piSuspend(bool pSuspend)
{
/* update capSuspended */
setCapSuspended(pSuspend);
/* flush queue if we are suspended */
if(isCapSuspended())
getQueue().flush();
}
void CanLogServer::piStop()
{
this->disconnectFromDevice();
}
bool CanLogServer::piGetBusSettings(int pBusIdx, CANBus& pBus)
{
return getBusConfig(pBusIdx, pBus);
}
void CanLogServer::piSetBusSettings(int pBusIdx, CANBus bus)
{
/* sanity checks */
if( (pBusIdx < 0) || pBusIdx >= getNumBuses())
return;
/* copy bus config */
setBusConfig(pBusIdx, bus);
}
bool CanLogServer::piSendFrame(const CANFrame& )
{
//We don't support sending frames right now
return true;
}
void CanLogServer::connectToDevice()
{
qDebug() << "Canlogserver: " << "Establishing connection to a Canlogserver device...";
QUrl url("http://" + m_qsAddress);
qDebug() << "address:" << m_qsAddress;
qDebug() << "Host:" << url.host();
qDebug() << "Port:" << url.port();
// Set status at not connected
setStatus(CANCon::NOT_CONNECTED);
// No proxy for connection
m_ptcpSocket->setProxy(QNetworkProxy::NoProxy);
// Connect to log server
m_ptcpSocket->connectToHost(url.host(), url.port());
}
void CanLogServer::disconnectFromDevice()
{
qDebug() << "Canlogserver: " << "Disconnecting...";
// Close socket
m_ptcpSocket->close();
}
|
