From 537b95269344fd30d2fdb753644bfc30cedeb3ae Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Phil=C3=A9mon=20Pr=C3=A9vot?= <philemon.prevot@gmail.com>
Date: Tue, 3 Sep 2024 08:42:05 +0200
Subject: [PATCH] Correct sample and imu_data confusion
---
src/filewriter.cpp | 8 ++++----
src/recorder.cpp | 1 +
2 files changed, 5 insertions(+), 4 deletions(-)
diff --git a/src/filewriter.cpp b/src/filewriter.cpp
index 91b4942..cf19123 100644
--- a/src/filewriter.cpp
+++ b/src/filewriter.cpp
@@ -456,15 +456,15 @@ void IMUFileWriter::ProcessDecodedMessage(int msgFunction, int msgPayloadLength,
void IMUFileWriter::write(uint8_t *sample, size_t size, uint8_t *imu_data) {
uint8_t *imu_data_cur(imu_data);
- uint8_t softwareMajorRev=sample[0];
- uint8_t softwareMinorRev=sample[6];
- std::cerr << "sMR" << static_cast<int>(sample[0]) << std::endl;
+ uint8_t softwareMajorRev=imu_data[0];
+ uint8_t softwareMinorRev=imu_data[6];
+ std::cerr << "sMR" << static_cast<int>(imu_data[0]) << std::endl;
std::cerr << "Size : " << size << std::endl;
if(softwareMajorRev > 2) {
for(int i=1; i<size-enteteSize; i++)
{
- DecodeMessage(sample[i]);
+ DecodeMessage(imu_data[i]);
}
}
else {
diff --git a/src/recorder.cpp b/src/recorder.cpp
index 5e149c1..9ee4080 100644
--- a/src/recorder.cpp
+++ b/src/recorder.cpp
@@ -178,6 +178,7 @@ void JasonRecorder::get_samples(std::vector<std::uint8_t> &samples, std::vector<
size_t start = this->additional_data_size + 6;
imu_data.resize(0);
imu_data.reserve(this->additional_data_size);
+ std::cerr << "softMajorRev : " << std::dec << &buffer[4] << std::endl;
imu_data.insert(imu_data.begin(), &buffer[6], &buffer[start]);
size_t num_samples = (received - start);
num_samples = (num_samples / (num_channels * this->depth)) * num_channels * this->depth;
--
GitLab