비행체 시간지연을 고려한 정밀경로추종 PID 제어기법

Abstract

무인항공기가 복잡한 지형이나 위험 지역에서 안전한 비행을 하기 위해서는 요구되는 경로를 정밀하게 추종할 수 있는 제어기법이 필요하다. 경로추종을 위해 사용되는 PID 제어기에서는 경로의 곡률을 앞먹임하여 추종성능을 개선할 수 있다. 한편 경로를 정밀 추종하기 위해서는 제어기의 이득을 크게 하는 것이 필요하나 비행체의 응답속도가 느린 경우 큰 경로 추종 이득을 사용할 경우 성능 저하 또는 불안정성이 발생할 수 있다. 여기서는 응답지연을 고려하여 앞먹임을 갖는 PID제어기의 설계방법을 고려하였다. 앞먹임에 필요한 경로정보를 간단히 얻기 위해 주어진 경로를 3차 스플라인 방법을 적용하여 3차 다항식으로 나타내었다. 설계한 제어기의 추종성능을 평가하기 위해 높은 고도에서 운용되는 느린 횡방향 동특성을 갖는 무인항공기에 대해 비선형 시뮬레이션을 수행하였다. 제어기에서는 횡방향 동특성을 1차 모델로 가정하여 반영하였다. 시뮬레이션을 통하여 동특성을 고려한 경우는 비행체가 주어진 경로를 매우 정밀하게 추종함을 확인하였다. In order to complete missions in a complicated terrain or highly dangerous area, an unmanned aerial vehicle(UAV) needs a fine controller to precisely follow the desired path. A PID controller used for the path following feeds forward path curvature information to the control input to improve the path following performance. High gain for PID controller is necessary to follow path tightly. However the high gain could cause instability or performance degradation when the vehicle has slow dynamics. We present PID controller design method which considers response delay of vehicle as well as path curvature. In order to obtain path curvature the desired path is described as a 3rd order polynomial by applying cubic spline interpolation. We apply the proposed controller to the path following of a UAV which is operated in high altitude and has very slow lateral dynamics. The lateral dynamics are modelled as a first order delayed system in the controller design. Nonlinear simulation shows the UAV with proposed controller follows an arbitrary path very tightly.