recover debug info
This commit is contained in:
parent
c23d947661
commit
ad7cabe238
|
@ -245,14 +245,14 @@ void GimableCallback(double &frame_ang_r, double &frame_ang_p, double &frame_ang
|
|||
static int count = 0;
|
||||
if (count == 25)
|
||||
{
|
||||
// std::cout << "GIMBAL_CMD_RCV_POS" << std::endl;
|
||||
// std::cout << "=============================================" << std::endl;
|
||||
// std::cout << "HALL_yaw:" << frame_ang_y << " " << std::endl;
|
||||
// std::cout << "HALL_roll:" << frame_ang_r << " " << std::endl;
|
||||
// std::cout << "HALL_pitch:" << frame_ang_p << " " << std::endl;
|
||||
// std::cout << "GYRO_yaw:" << imu_ang_y << " " << std::endl;
|
||||
// std::cout << "GYRO_roll:" << imu_ang_r << " " << std::endl;
|
||||
// std::cout << "GYRO_pitch:" << imu_ang_p << " " << std::endl;
|
||||
std::cout << "GIMBAL_CMD_RCV_POS" << std::endl;
|
||||
std::cout << "=============================================" << std::endl;
|
||||
std::cout << "HALL_yaw:" << frame_ang_y << " " << std::endl;
|
||||
std::cout << "HALL_roll:" << frame_ang_r << " " << std::endl;
|
||||
std::cout << "HALL_pitch:" << frame_ang_p << " " << std::endl;
|
||||
std::cout << "GYRO_yaw:" << imu_ang_y << " " << std::endl;
|
||||
std::cout << "GYRO_roll:" << imu_ang_r << " " << std::endl;
|
||||
std::cout << "GYRO_pitch:" << imu_ang_p << " " << std::endl;
|
||||
count = 0;
|
||||
}
|
||||
count++;
|
||||
|
|
Loading…
Reference in New Issue