fix(*): add imu pipeline empty error output info.

This commit is contained in:
TinyO 2019-08-08 17:11:58 +08:00
parent af72213f50
commit acbd3eff4c

View File

@ -73,7 +73,12 @@ void unpack_imu_packet(const std::uint8_t *data, ImuPacket *pkg) {
unpack_imu_segment(ImuData(data + data_n * i), &seg); unpack_imu_segment(ImuData(data + data_n * i), &seg);
pkg->segments.push_back(seg); pkg->segments.push_back(seg);
} }
if (pkg->count) pkg->serial_number = pkg->segments.back().frame_id; if (pkg->count) {
pkg->serial_number = pkg->segments.back().frame_id;
} else {
LOG(ERROR) << "The imu data pipeline lost more than 5 samples continuously, "
<< "please check the device and firmware";
}
} }
void unpack_imu_res_packet(const std::uint8_t *data, ImuResPacket *res) { void unpack_imu_res_packet(const std::uint8_t *data, ImuResPacket *res) {