forked from floratest1/SpireCV
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;
|
static int count = 0;
|
||||||
if (count == 25)
|
if (count == 25)
|
||||||
{
|
{
|
||||||
// std::cout << "GIMBAL_CMD_RCV_POS" << std::endl;
|
std::cout << "GIMBAL_CMD_RCV_POS" << std::endl;
|
||||||
// std::cout << "=============================================" << std::endl;
|
std::cout << "=============================================" << std::endl;
|
||||||
// std::cout << "HALL_yaw:" << frame_ang_y << " " << std::endl;
|
std::cout << "HALL_yaw:" << frame_ang_y << " " << std::endl;
|
||||||
// std::cout << "HALL_roll:" << frame_ang_r << " " << std::endl;
|
std::cout << "HALL_roll:" << frame_ang_r << " " << std::endl;
|
||||||
// std::cout << "HALL_pitch:" << frame_ang_p << " " << std::endl;
|
std::cout << "HALL_pitch:" << frame_ang_p << " " << std::endl;
|
||||||
// std::cout << "GYRO_yaw:" << imu_ang_y << " " << std::endl;
|
std::cout << "GYRO_yaw:" << imu_ang_y << " " << std::endl;
|
||||||
// std::cout << "GYRO_roll:" << imu_ang_r << " " << std::endl;
|
std::cout << "GYRO_roll:" << imu_ang_r << " " << std::endl;
|
||||||
// std::cout << "GYRO_pitch:" << imu_ang_p << " " << std::endl;
|
std::cout << "GYRO_pitch:" << imu_ang_p << " " << std::endl;
|
||||||
count = 0;
|
count = 0;
|
||||||
}
|
}
|
||||||
count++;
|
count++;
|
||||||
|
|
Loading…
Reference in New Issue