diff --git a/src/examples/darwin_imu_test.cpp b/src/examples/darwin_imu_test.cpp index 6d2185be6c7315faeb7d4f06511cb24e97f7ee68..c516a488cc44042f1a55114c2de4ddf468a851ad 100644 --- a/src/examples/darwin_imu_test.cpp +++ b/src/examples/darwin_imu_test.cpp @@ -11,6 +11,7 @@ int main(int argc, char *argv[]) { int i=0; double gyro_x,gyro_y,gyro_z; + double accel_x,accel_y,accel_z; try{ CDarwinRobot darwin("Darwin",robot_device,1000000,0x01,true); @@ -20,7 +21,8 @@ int main(int argc, char *argv[]) for(i=0;i<50;i++) { darwin.imu_get_gyro_data(&gyro_x,&gyro_y,&gyro_z); - std::cout << "Gyro: x:" << gyro_x << ", y: " << gyro_y << ", z: " << gyro_z << std::endl; + darwin.imu_get_accel_data(&accel_x,&accel_y,&accel_z); + std::cout << "Gyro: x:" << gyro_x << ", y: " << gyro_y << ", z: " << gyro_z << " Accel: x: " << accel_x << ", y: " << accel_y << " , z: " << accel_z << std::endl; usleep(100000); } darwin.imu_stop();