Additional work on UDS - now UDS scan window can get results from UDS

handler instead of trying to do it all itself.
This commit is contained in:
Collin Kidder
2017-05-16 21:50:54 -04:00
parent 1ccb9bac2e
commit 2af1204cdd
8 changed files with 91 additions and 64 deletions
+2 -1
View File
@@ -113,7 +113,8 @@ HEADERS += mainwindow.h \
signalviewerwindow.h \
bus_protocols/isotp_handler.h \
bus_protocols/j1939_handler.h \
bus_protocols/uds_handler.h
bus_protocols/uds_handler.h \
bus_protocols/isotp_message.h
FORMS += ui/candatagrid.ui \
ui/connectionwindow.ui \
+1 -14
View File
@@ -7,20 +7,7 @@
#include "can_structs.h"
#include "mainwindow.h"
#include "canframemodel.h"
//the same as the CANFrame struct but with arbitrary data size.
struct ISOTP_MESSAGE
{
public:
uint32_t ID;
int bus;
bool extended;
bool isReceived;
int len; //# of bytes this message should have (as reported)
int actualSize; //# we actually got
QVector<unsigned char> data;
uint64_t timestamp;
};
#include "isotp_message.h"
class ISOTP_HANDLER : public QObject
{
+18
View File
@@ -0,0 +1,18 @@
#ifndef ISOTP_MESSAGE_H
#define ISOTP_MESSAGE_H
//the same as the CANFrame struct but with arbitrary data size.
class ISOTP_MESSAGE
{
public:
uint32_t ID;
int bus;
bool extended;
bool isReceived;
int len; //# of bytes this message should have (as reported)
int actualSize; //# we actually got
QVector<unsigned char> data;
uint64_t timestamp;
};
#endif // ISOTP_MESSAGE_H
+25
View File
@@ -1,5 +1,6 @@
#include "uds_handler.h"
#include "connections/canconmanager.h"
#include "mainwindow.h"
#include <QDebug>
QVector<CODE_STRUCT> UDS_SERVICE_DESC = {
@@ -143,6 +144,18 @@ UDS_HANDLER::UDS_HANDLER()
void UDS_HANDLER::gotISOTPFrame(ISOTP_MESSAGE &msg)
{
qDebug() << "UDS handler got ISOTP frame";
UDS_MESSAGE udsMsg;
udsMsg.bus = msg.bus;
udsMsg.extended = msg.extended;
udsMsg.ID = msg.ID;
udsMsg.isReceived = msg.isReceived;
udsMsg.timestamp = msg.timestamp;
udsMsg.actualSize = msg.actualSize;
udsMsg.len = msg.len;
udsMsg.service = msg.data.at(0);
udsMsg.subFunc = msg.data.at(1);
udsMsg.data = msg.data.mid(1, -1); //don't copy data[0] which was service number
emit newUDSMessage(udsMsg);
}
void UDS_HANDLER::setReception(bool mode)
@@ -177,6 +190,18 @@ void UDS_HANDLER::sendUDSFrame(int bus, int ID, int service, QVector<unsigned ch
qDebug() << "Sent UDS service: " << getServiceShortDesc(service) << " on bus " << bus;
}
void UDS_HANDLER::sendUDSFrame(const UDS_MESSAGE &msg)
{
QVector<unsigned char> data;
if (msg.bus < 0) return;
if (msg.bus >= CANConManager::getInstance()->getNumBuses()) return;
if (msg.service < 0 || msg.service > 0xFF) return;
data.append(msg.service);
data.append(msg.data);
ISOTP_HANDLER::getInstance()->sendISOTPFrame(msg.bus, msg.ID, data);
qDebug() << "Sent UDS service: " << getServiceShortDesc(msg.service) << " on bus " << msg.bus;
}
QString UDS_HANDLER::getServiceShortDesc(int service)
{
foreach (CODE_STRUCT code, UDS_SERVICE_DESC)
+10 -2
View File
@@ -5,7 +5,7 @@
#include <QObject>
#include <QDebug>
#include "can_structs.h"
#include "isotp_handler.h"
#include "isotp_message.h"
namespace UDS_SERVICES
{
@@ -68,6 +68,13 @@ struct CODE_STRUCT
QString longDesc;
};
class UDS_MESSAGE: public ISOTP_MESSAGE
{
public:
int service;
int subFunc;
};
class UDS_HANDLER : public QObject
{
Q_OBJECT
@@ -78,6 +85,7 @@ public:
static UDS_HANDLER* getInstance();
void setReception(bool mode); //set whether to accept and forward frames or not
void sendUDSFrame(int bus, int ID, int service, QVector<unsigned char> payload);
void sendUDSFrame(const UDS_MESSAGE &msg);
QString getServiceShortDesc(int service);
QString getServiceLongDesc(int service);
QString getNegativeResponseShort(int respCode);
@@ -87,7 +95,7 @@ public slots:
void gotISOTPFrame(ISOTP_MESSAGE &msg);
signals:
void newUDSMessage(ISOTP_MESSAGE &msg);
void newUDSMessage(UDS_MESSAGE &msg);
private:
QList<ISOTP_MESSAGE> messageBuffer;
+1 -1
View File
@@ -1,7 +1,7 @@
#ifndef CONFIG
#define CONFIG
#define VERSION 167
#define VERSION 168
//try to keep this in sync.
//SavvyCAN will complain if you connect a GVRET board with a revision
+30 -35
View File
@@ -17,8 +17,10 @@ UDSScanWindow::UDSScanWindow(const QVector<CANFrame> *frames, QWidget *parent) :
waitTimer = new QTimer;
waitTimer->setInterval(100);
UDS_HANDLER::getInstance()->setReception(true);
connect(MainWindow::getReference(), SIGNAL(framesUpdated(int)), this, SLOT(updatedFrames(int)));
connect(CANConManager::getInstance(), &CANConManager::framesReceived, this, &UDSScanWindow::rapidFrames);
connect(UDS_HANDLER::getInstance(), &UDS_HANDLER::newUDSMessage, this, &UDSScanWindow::gotUDSReply);
connect(ui->btnScan, &QPushButton::clicked, this, &UDSScanWindow::scanUDS);
connect(waitTimer, &QTimer::timeout, this, &UDSScanWindow::timeOut);
connect(ui->btnSaveResults, &QPushButton::clicked, this, &UDSScanWindow::saveResults);
@@ -73,7 +75,7 @@ void UDSScanWindow::saveResults()
}
}
void UDSScanWindow::sendOnBuses(UDS_TESTS test, int buses)
void UDSScanWindow::sendOnBuses(UDS_MESSAGE test, int buses)
{
int busList = buses;
if (busList < ui->cbBuses->count() - 1)
@@ -107,7 +109,7 @@ void UDSScanWindow::scanUDS()
ui->listResults->clear();
sendingFrames.clear();
UDS_TESTS test;
UDS_MESSAGE test;
int typ, id;
int startID, endID;
startID = Utility::ParseStringToNum(ui->txtStartID->text());
@@ -169,49 +171,42 @@ void UDSScanWindow::updatedFrames(int numFrames)
}
}
//Updates here are nearly once per millisecond if there is heavy traffic. That's more like it!
//TODO: I really doubt this works anymore with the new connection system. This breaks the UDS scanner for now! ;(
void UDSScanWindow::rapidFrames(const CANConnection* conn, const QVector<CANFrame>& pFrames)
void UDSScanWindow::gotUDSReply(UDS_MESSAGE &msg)
{
QString result;
uint32_t id;
int offset = ui->spinReplyOffset->value();
UDS_TESTS sentFrame;
UDS_MESSAGE sentFrame;
bool gotReply = false;
if (pFrames.length() <= 0) return;
int numSending = sendingFrames.length();
if (numSending == 0) return;
if (currIdx >= numSending) return;
sentFrame = sendingFrames[currIdx];
foreach(const CANFrame& thisFrame, pFrames)
{
if (currIdx >= numSending) return;
id = thisFrame.ID;
id = msg.ID;
if ((id == (uint32_t)(sentFrame.ID + offset)) || ui->cbAllowAdaptiveOffset->isChecked())
{
//int temp = thisFrame.data[0] >> 4;
//if (temp == 0) //single frame reply (maybe)
//{
if (thisFrame.data[1] == 0x40 + sendingFrames[currIdx].service)
{
result = "Request on bus " + QString::number(sentFrame.bus) + " ID: " + QString::number(sentFrame.ID, 16) + " got response to mode "
+ QString::number(sentFrame.service, 16)
+ " " + QString::number(sentFrame.subFunc, 16) + " with affirmation from ID " + QString::number(id, 16)
+ " on bus " + QString::number(thisFrame.bus) + ".";
gotReply = true;
}
else if ( thisFrame.data[1] == 0x7F)
{
result = "Request on bus " + QString::number(sentFrame.bus) + " ID: " + QString::number(sentFrame.ID, 16) + " got response to mode "
+ QString::number(sentFrame.service, 16)
+ " " + QString::number(sentFrame.subFunc, 16) + " with an error from ID " + QString::number(id, 16)
+ " on bus " + QString::number(thisFrame.bus) + ".";
gotReply = true;
}
if ((id == (uint32_t)(sentFrame.ID + offset)) || ui->cbAllowAdaptiveOffset->isChecked())
{
//int temp = thisFrame.data[0] >> 4;
//if (temp == 0) //single frame reply (maybe)
//{
if (msg.service == 0x40 + sendingFrames[currIdx].service)
{
result = "Request on bus " + QString::number(sentFrame.bus) + " ID: " + QString::number(sentFrame.ID, 16) + " got response to mode "
+ QString::number(sentFrame.service, 16)
+ " " + QString::number(sentFrame.subFunc, 16) + " with affirmation from ID " + QString::number(id, 16)
+ " on bus " + QString::number(msg.bus) + ".";
gotReply = true;
}
else if ( msg.service == 0x7F)
{
result = "Request on bus " + QString::number(sentFrame.bus) + " ID: " + QString::number(sentFrame.ID, 16) + " got response to mode "
+ QString::number(sentFrame.service, 16)
+ " " + QString::number(sentFrame.subFunc, 16) + " with an error from ID " + QString::number(id, 16)
+ " on bus " + QString::number(msg.bus) + ".";
gotReply = true;
}
//}
/*
if (temp == 1) //start of a multiframe reply
@@ -226,7 +221,7 @@ void UDSScanWindow::rapidFrames(const CANConnection* conn, const QVector<CANFram
}
//error replies are never multiframe so the check doesn't have to be done here.
} */
}
}
if (gotReply)
{
+4 -11
View File
@@ -3,6 +3,7 @@
#include "can_structs.h"
#include "connections/canconnection.h"
#include "bus_protocols/uds_handler.h"
#include <QDialog>
@@ -10,14 +11,6 @@ namespace Ui {
class UDSScanWindow;
}
struct UDS_TESTS
{
int ID;
int bus;
int service;
int subFunc;
};
class UDSScanWindow : public QDialog
{
Q_OBJECT
@@ -28,7 +21,7 @@ public:
private slots:
void updatedFrames(int numFrames);
void rapidFrames(const CANConnection* conn, const QVector<CANFrame>& pFrames);
void gotUDSReply(UDS_MESSAGE &msg);
void scanUDS();
void saveResults();
void timeOut();
@@ -37,12 +30,12 @@ private:
Ui::UDSScanWindow *ui;
const QVector<CANFrame> *modelFrames;
QTimer *waitTimer;
QList<UDS_TESTS> sendingFrames;
QList<UDS_MESSAGE> sendingFrames;
int currIdx = 0;
bool currentlyRunning;
void sendNextMsg();
void sendOnBuses(UDS_TESTS frame, int buses);
void sendOnBuses(UDS_MESSAGE frame, int buses);
};
#endif // UDSSCANWINDOW_H