18 lines
508 B
C++
18 lines
508 B
C++
|
#include <IMUReader.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
int main() {
|
||
|
|
// 创建 IMUReader 实例
|
||
|
|
IMUReader imuReader("/dev/ttyUSB0");
|
||
|
|
|
||
|
|
// orb-slam read cam
|
||
|
|
while(1){
|
||
|
|
IMUData data;
|
||
|
|
int status = imuReader.ReadData(data);
|
||
|
|
|
||
|
|
printf("Acc=%f,%f,%f, Gyro=%f,%f,%f\n",data.accelX,data.accelY,data.accelZ,
|
||
|
|
data.gyroX,data.gyroY,data.gyroZ);
|
||
|
|
// 30FPS
|
||
|
|
std::this_thread::sleep_for(std::chrono::milliseconds(33));
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|