t.mettler/giesCANne
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Merge pull request #1052 from chrumck/fixLawicellTimestamps

Browse Source 
LAWICEL timestamps fix
This commit is contained in:
Collin Kidder
2026-04-06 21:11:34 -04:00
committed by GitHub
parent 140316a0d4 5fa1bb43ef
commit 7e021edaac
2 changed files with 41 additions and 24 deletions
Download Patch File Download Diff File Expand all files Collapse all files
connections/lawicel_serial.cpp
+38 -22
View File
@@ -17,6 +17,7 @@ LAWICELSerial::LAWICELSerial(QString portName, int serialSpeed, int lawicelSpeed
serial = nullptr;
isAutoRestart = false;
rebuildLocalTimeBasis();
readSettings();
}
@@ -203,6 +204,13 @@ bool LAWICELSerial::piSendFrame(const CANFrame& frame)
/****************************************************************/
void LAWICELSerial::rebuildLocalTimeBasis()
{
timeBasis = 0;
lastHWTimestamp = -1;
wrapAdder = 0;
}
void LAWICELSerial::readSettings()
{
QSettings settings;
@@ -254,6 +262,8 @@ void LAWICELSerial::deviceConnected()
{
sendDebug("Connecting to LAWICEL Device!");
rebuildLocalTimeBasis();
QByteArray output;
output.clear();
@@ -474,8 +484,6 @@ void LAWICELSerial::readSerialData()
QByteArray data;
unsigned char c;
QString debugBuild;
CANFrame buildFrame;
QByteArray buildData;
if (serial) data = serial->readAll();
@@ -491,41 +499,49 @@ void LAWICELSerial::readSerialData()
{
qDebug() << "Got CR!";
if (useSystemTime)
{
buildFrame.setTimeStamp(QCanBusFrame::TimeStamp::fromMicroSeconds(QDateTime::currentMSecsSinceEpoch() * 1000ul));
}
else
CANFrame buildFrame;
QByteArray buildData;
buildFrame.setTimeStamp(QCanBusFrame::TimeStamp(0, QDateTime::currentMSecsSinceEpoch() * 1000ll));
if (!useSystemTime)
{
bool isFD = false;
char offset;
char len_index;
switch(mBuildLine[0].toLatin1()) {
case 't':
case 'b':
case 'd':
isFD = true;
[[fallthrough]];
case 't':
offset = 5;
len_index = 4;
break;
case 'T':
break;
case 'B':
case 'D':
isFD = true;
[[fallthrough]];
case 'T':
offset = 10;
len_index = 9;
break;
break;
default:
offset = 5;
len_index = 4;
break;
break;
}
//If total length is greater than command, header and data, timestamps must be enabled.
if (data.length() > (offset + mBuildLine.mid(len_index, 1).toInt() * 2 + 1))
int dlc = mBuildLine.mid(len_index, 1).toInt();
int byteCount = isFD ? (int)dlc_code_to_bytes(dlc) : dlc;
int frameStringLen = offset + byteCount * 2;
if (mBuildLine.length() > frameStringLen + 1)
{
//Four bytes after the end of the data bytes.
buildTimestamp = mBuildLine.mid(offset + mBuildLine.mid(len_index, 1).toInt() * 2, 4).toInt(nullptr, 16);
buildFrame.setTimeStamp(QCanBusFrame::TimeStamp(0, buildTimestamp));
}
else
{
//Default to system time if timestamps are disabled.
buildFrame.setTimeStamp(QCanBusFrame::TimeStamp::fromMicroSeconds(QDateTime::currentMSecsSinceEpoch() * 1000ul));
qint64 hardwareMs = mBuildLine.mid(frameStringLen, 4).toInt(nullptr, 16);
if (lastHWTimestamp >= 0 && hardwareMs < lastHWTimestamp) { wrapAdder += 60000; }
lastHWTimestamp = hardwareMs;
qint64 unwrappedMs = wrapAdder + hardwareMs;
if (timeBasis == 0) { timeBasis = QDateTime::currentMSecsSinceEpoch() - unwrappedMs; }
buildFrame.setTimeStamp(QCanBusFrame::TimeStamp(0, (timeBasis + unwrappedMs) * 1000ll));
}
}
connections/lawicel_serial.h
+3 -2
View File
@@ -60,8 +60,9 @@ protected:
bool isAutoRestart;
QSerialPort *serial;
int framesRapid;
CANFrame buildFrame;
qint64 buildTimestamp;
qint64 timeBasis;
qint64 lastHWTimestamp;
qint64 wrapAdder;
bool can0Enabled;
bool can0ListenOnly;
bool canFd;