[H_CTL] Added a Pitch rate loop and a Yaw rate loop
Added flight plans