From 997b6102d4b4c8f1624a0d9bf79ad3d10d554f4b Mon Sep 17 00:00:00 2001 From: TinyO Date: Fri, 27 Sep 2019 18:27:55 +0800 Subject: [PATCH] feat(imu): adapter data right. --- src/mynteye/device/standard2/channels_adapter_s2.cc | 12 ++++++++---- 1 file changed, 8 insertions(+), 4 deletions(-) diff --git a/src/mynteye/device/standard2/channels_adapter_s2.cc b/src/mynteye/device/standard2/channels_adapter_s2.cc index edf1829..8083b88 100644 --- a/src/mynteye/device/standard2/channels_adapter_s2.cc +++ b/src/mynteye/device/standard2/channels_adapter_s2.cc @@ -87,10 +87,14 @@ struct ImuData2 { // (*(data + 10) << 8) | *(data + 11); timestamp = BYTE_8(data, 4); flag = *(data + 12); - temperature = BYTE_4(data, 13); - // accel_or_gyro[0] = BYTE_4(data, 17); - // accel_or_gyro[1] = BYTE_4(data, 21); - // accel_or_gyro[2] = BYTE_4(data, 25); + temperature = *((float*)(data+ 13)); + LOG(INFO) << "temperature:" << temperature; + accel_or_gyro[0] = *((float*)(data + 17)); + LOG(INFO) << "accel_or_gyro[0]:" << accel_or_gyro[0]; + accel_or_gyro[1] = *((float*)(data + 21)); + LOG(INFO) << "accel_or_gyro[1]:" << accel_or_gyro[1]; + accel_or_gyro[2] = *((float*)(data + 25)); + LOG(INFO) << "accel_or_gyro[2]:" << accel_or_gyro[2]; } };