W niniejszym artykule przedstawiono założenia projektowe oraz budowę systemu sterowania ruchem dla robota humanoidalnego Futaba RBT-1. Zaprezentowano wykonany sterownik oparty o mikrokontroler z rdzeniem ARM7, wyposażony w interfejs komunikacji do sterowania serwonapędami cyfrowymi, moduły radiowej wymiany danych oraz zestaw czujników inercyjnych. Ponadto zwrócono uwagę na interesującą metodę wyznaczania wychylenia poruszającego się obiektu względem Ziemi.
EN
This paper presents a part of the control system of the humanoid robot Futaba RBT-1. The hardware consists of a microprocessor based controller equipped with a communication interface for digital servos in robot legs. The main parts of the controller are: an ARM microcontroller, a wireless communication module TLX2401 and a Bluetooth. There was chosen an advanced sensor ADIS16362 iSensorŽ which is a complete inertial system that includes a triaxis gyroscope, a triaxis accelerometer and a programmable digital low-pass filter. The robot control system is shown in Fig. 1. In Section 4 the Inertial Navigation System (INS) is described. It uses the data obtained from the accelerometer and gyroscope to calculate the inclination of the robot body in respect to the gravity direction. It is based on "Efficient Orientation Filter" (developed by Dr. Sebastian Madgwick [1]) which despite being computationally efficient gives very good results. Small computational demands allow it to run on a microcontroller with the ARM7 core in real-time which would be difficult with e.g. Extended Kalman Filter. The main control application (described in the second part of this paper) runs on a PC computer. The robot controller radio-communicates with the PC through ISM 2.4GHz radio modules. Furthermore, the controller has a Bluetooth module which enables it to send measurement data for convinient visualisation in the Matlab/Simulink enviroment.
JavaScript jest wyłączony w Twojej przeglądarce internetowej. Włącz go, a następnie odśwież stronę, aby móc w pełni z niej korzystać.