Control of Inertially Stabilized Platform Using Disturbance Torque Estimation and Compensation

* Dept. of Mechatronics Engineering, Chungnam Nat’l Univ. (Received November 21, 2014 ; Revised November 6, 2015 ; Accepted November 18, 2015)Key Words: Inertially Stabilized Plotform(관성안정화플랫폼), Disturbance Torque Estimation(외란토크추정), Disturbance Torque Compensation Control(외란토크보상제어), Stabilization(안정화), 6 DOF Simulator(6자유도시뮬레이터), Control Simulation Test Bed(제어시뮬레이션환경구축)초록: 본 논문에서는 기존의 관성안정화 플랫폼에서 보편적으로 사용됐던 PID 제어에 외란관측기를 적용하는 알고리즘 제안한다. 외란관측기 알고리즘을 적용하기 위하여 직접구동 모터로 구동되는 안정화 플랫폼 축의 관성모멘트와 축 마찰 특성을 실험적으로 구하고, 시뮬레이션과 실험결과를 비교하여 정확도를 검증하였다. 또한 차수와 상대차수가 다른 여러 가지 Q-filter 적용실험을 통하여 필터 특성에 따른 시스템의 안정성을 확인하였다. 본 논문에서 제안한 알고리즘은 6 자유도 시뮬레이터를 이용하여 차량 모션 인가실험을 통해 이중 PID 제어 루프의 결과와 비교/검증하였다.Abstract: In this study, we propose a control algorithm for Inertially Stabilized Platforms (ISP), which combines Disturbance Observer (DOB) with conventional proportional integral derivative (PID) control algorithm. A single axis ISP system was constructed using a direct drive motor. The joint friction was modeled as a nonlinear function of joint speed while the accuracy of the model was verified through experiments and simulation. In addition, various Q-filters, which have different orders and relative degrees of freedom (DOF), were implemented. The stability and performance of the ISP were compared through experimental study. The performance of the proposed PID-plus-DOB algorithm was compared with the experimental results of the conventional double loop PID control under artificial vehicle motion provided motion simulator with six DOF.