Navigation Functionalities for an Autonomous UAV Helicopter
Navigation Functionalities for an Autonomous UAV Helicopter
Navigation Functionalities for an Autonomous UAV Helicopter
Create successful ePaper yourself
Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.
4.3. OUTER LOOP CONTROL EQUATIONS 49<br />
Finally, the helicopter velocity profile is given by:<br />
3. Calculation of the heading error δψ.<br />
The heading error is given by:<br />
vtarg = min(vtarg1, vtarg2, vtarg3)<br />
δψ = at<strong>an</strong>2(T n y , T n x ) − ψheli<br />
where ψheli is the helicopter heading given by the INS/GPS system.<br />
4. Calculation of the feed <strong>for</strong>ward control terms rff , φff .<br />
The terms rff <strong>an</strong>d φff are calculated from the first <strong>an</strong>d third equations<br />
in 4.13 where the component of the curvature radius R b y is calculated<br />
as follows:<br />
K b = C n b K n<br />
R b y = 1<br />
K b y<br />
(4.23)<br />
The feed <strong>for</strong>ward terms will be used in the outer control loop to<br />
enh<strong>an</strong>ce the tracking precision.<br />
4.3 Outer loop control equations<br />
The PFCM control equations implemented on the RMAX are the following: