05.11.2012 Views

Navigation Functionalities for an Autonomous UAV Helicopter

Navigation Functionalities for an Autonomous UAV Helicopter

Navigation Functionalities for an Autonomous UAV Helicopter

SHOW MORE
SHOW LESS

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:

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!