칼만예측기의 ZMP 상태추정을 통한 이족로봇의 균형제어기법

Abstract

본 논문은 칼만필터를 이용한 ZMP의 다음 상태 예측을 통한 새로운 이족로봇의 균형제어기법을 제안한다. 일반적으로 이족로봇의 동역학 모델은 3D-LIPM(3D-Linear Inverted Pendulum Mode)에 의해 수학적으로 근사화되지만, 이는 로봇의 동역학적 특성을 완벽하게 표현할 수 없다. 이족로봇의 안정성은 ZMP(Zero Moment Point) 위치가 안정영역에 존재하는 경우에 안정성이 보장된다. 그리고 로봇 구조와 그 모델 사이의 내재된 오차는 로봇의 안정성에 영향을 끼칠 수 있다. 그러므로 본 논문에서 제안하는 균형제어기법은 내부 오차를 줄일 수 있으며, 적절한 로봇의 제어가 가능하다. 제안된 균형제어기법의 실험은 다양한 상황을 포함한 가상의 공간상에서 모의실험 되었다. This paper proposes a novel balance control scheme of a biped robot to predict the next position of ZMP using Kalman Filter. The mathematical model of the biped robot is generally approximated by 3D-LIPM(3D-Linear Inverted Pendulum Mode), but it cannot completely express the robot's dynamics. The stability of the biped robot depends on whether the ZMP(Zero Moment Point) position is in the stability region or out of. And the internal error between the robot mechanism and its model could affect the stability of a robot. Therefore, the proposed balance control not reduces the internal error, but also timely generates the proper control. The experiment of the proposed balance control is simulated on the virtual workspace where the biped robot may encounter with various difficulties.