diff --git a/src/filewriter.cpp b/src/filewriter.cpp index 91b49422842032f7ff774da4325a9fdf79160ba6..cf1912346c3cfa1bfa442c31de2b54e280342bf1 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 5e149c1d232670b4ac4c418b3281ef55c9dbfe4b..9ee40804dc697f740b2cf0439049ddda7124a2e9 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;