Abstract
In this paper, we propose a controller gain based on model based design and implement the two-wheel inverted pendulum type robot using NXT Lego and RobotC language. Two-wheel inverted pendulum robot consists of NXT mindstorm, servo DC motor with encoder, gyro sensor, and accelerometer sensor. We measurement wheel angle using bulit-in encoder and calculate wheel angle speed using moving average method. Gyro measures body angular velocity and accelerometer measures body pitch angle. We calculate body angle with complementary filter using gyro and accelerometer sensor. The control gain is a weighted value for wheel angle, wheel angular velocity, body pitch angle, and body pich angular velocity, respectively. We experiment and observe the effect of two-wheel inverted pendulum with respect to change of control gains.
이 논문에서는 모델 기반 설계에 근거한 이륜 도립진자 로봇의 제어이득을 설계하고 NXT 마인드스톰과 RobotC 언어를 이용하여 수업에 활용 가능한 로봇을 제작 및 실험한다. 이륜 도립진자 로봇은 NXT 마인드스톰, 서보 직류전동기, 자이로 센서, 가속도 센서로 구성된다. 직류전동기에 내장된 엔코더를 이용하여 바퀴의 회전각을 검출하며 이동평균을 이용하여 바퀴의 회전각속도를 계산한다. 자이로 센서는 몸체의 피치 각속도를 측정하며 가속도 센서는 몸체의 피치 각도를 측정한다. 자이로와 가속도의 센서 융합을 통해 몸체 각도를 계산한다. 제어기 이득 요소는 휠 각도, 휠 각속도, 몸체 피치 각도, 몸체 피치 각속도에 대한 가중치이다. 이들 제어이득의 변화에 따른 도립진자 로봇의 변화를 실험하며 유용성을 확인한다.
