调整万向节的姿态,不需要那那么多语句。如果目的只是需要标准的某个姿态,那么直接控制万向节转到那个姿势即可。
将下面的代码在main.cpp中调用即可
//控制万向节转动
void setGimbalAngle(Vehicle* vehicle,int roll,int pitch,int yaw,int duration,int isAbsolute,bool yaw_cmd_ignore,bool pitch_cmd_ignore,bool roll_cmd_ignore)
{
DJI::OSDK::Gimbal::AngleData gimbalAngle = {};
gimbalAngle.roll = roll;
gimbalAngle.pitch = pitch;
gimbalAngle.yaw = yaw;
gimbalAngle.duration = duration;
gimbalAngle.mode |= 0;
gimbalAngle.mode |= isAbsolute;
gimbalAngle.mode |= yaw_cmd_ignore << 1;
gimbalAngle.mode |= roll_cmd_ignore << 2;
gimbalAngle.mode |= pitch_cmd_ignore << 3;
vehicle->gimbal->setAngle(&gimbalAngle);
// Give time for gimbal to sync
sleep(4);
}