Development of Middle-Sized Mobile Robot FUKURO

45 downloads 0 Views 764KB Size Report
Yogya arta, Indonesia rudy.tri.h@mail.ugm.ac.id. Abstract—Nowadays, robotic soccer is a popular research platform for developing an autonomous intelligent ...
������������������������������������������������������������������������������������������������������������������������������������������

����������������������������������������� ������������������������������������ ������������������������������������������������������������������������������������������������������������������� �������������������������������������������������������������������������andi, Denanda Hendra, Ma’ruf ��������������������������������������������������������������������������������������������������������������� ���������������� �������������������������������������� �������������������������� ���������������������� ��������������������������� � � ��������—���������� �������� ������� ��� �� �������� ��������� ��������� ���� ����������� ��� ����������� ������������ ������� ����� ������ ���������� ���� ���������������� ������� ������ ��������� ���������� ��� �������� ������� ����� ������� ��� ����������� ��� ������� ������ ����������� ������� ������ ������ ����� ������� ���������������������������������������������������������������� �������������������������������������������������������������������� ����������� ������������ ������� ������� ��� ��������� ���� ��������� �������� ��� ����������� ������� ������������ �� �������� ��� ����������������������������������������������������� �

���� ������������������ ��������������������������������������������������������� ������� ��� ���� ������ ���������������� ��� ���������� ���� ������� ��� ���� ������ ������� ������ ��� ���� ������ ����� ������ ����� ������� ������ ���� ���������� ��� ���� ���������� ����� ������ ����� ������� ��� ��� ������� ����� ��� ���� ����� ���� ������ ��� �� ��������� ���� ������� �������� ������ ���� ��������� ������� ���������� ��� ���������� ���� ����� ������������ ������ ���� ����� ��������� ��� ����� ���������������� ������ ��� �� ������ ��� ������� ���� ���� ������� ������� ������� ��� ������������ �� ����������� ������� �������� ���� ������� ��� ������ ��� ����� ���� ����� ����� ����� ������ ����� �� ������� ��� �� ��������� ���������� �������������������������������������������������������� ���������������������������������������������������������� �hat the robot has 360˚ vision [4��� ���� ����������� ������� ��� ������� ������ ��� ����� ��� ��������� ����� ������ ��� ������� ������������������������������������

��������—� ���������� ������� ������� ���������� ������� ������ ����������������������������� �

��� �������������� �������������� ��� ��� �������������� ������������ ��� �������� ��������� ��� ������������ ������������� ������ ������ �������� ���� ������������������������������������������������������������ ���������������������������������������������������������� ��������������������������������������������������������� �������� ����� ������������������������������������������������� ������������������������������������������������������������ ����������������������������������������������

� �� � � � �

������������� ��� ���� ������������� ������� ����� ��� ���� ������������������������������������������������������������� ��������������������������������������������������������������� ������������ ��� ���� ����������� ��� ���� �������� ����� ���� ��������������������������

� � � ����������������������������������

����������� ������ ���������� ���� �������� ������������ ��� ���� ���������������������������������������������������������� ��� �������� �������� ��� ��������� ���� ����������� ������� ��� ���� ������� ��������������������������������������������������������� ���� �������� ��� ��������� ���� �������� ��������� �������������� �����������������������������������������

����������





� �

���� ��������������������������������� �

��������������������

���������������

�����������

������������

�����

������������������������������������������������������������������������������������������������������������������������������������������ ��� ���������������� ������������������������������������������������������������� �������������������������������������������������������������� ��� ��������������������������������������������������������� ���������� ������� ��� ����� ���� ������ ������������� ��� ������������������������������������������������������������������ ������������������������������������������������������������� ����� ������ ������ ������ ���� ���������� ���� ���������� ��� ������������� ���� ������ ����� ������ ��� ���� ����� ������ ��� ���� ������ ��� ���� ������� ��� ���� ����� ���� ����� ��� ������ ����� ��������������������������������������������������������������� ��������� ��� ���� ������ ������� ������� ������������� ���� ������ ������ ��� ���� ����� ������ ���� ����� ����� ���� ������� �������� ��� ���� ������ ��� ���� ������ ��������� ��� ���� ����������� ��������� ������������������������������������������������������

� � � � � � � � � � � � � � � � � � � � � � � �����������������������������������������������������������������������������

� ��� �������������������� ���������� ���������� ���������� ����� ��� ����� ��� ��� ���� �������� �������������������������������������������������������������������� ������������������������������������������������������������ ��� ���� ���� ������� ������� ��� ������ ��� ���� ������ ����� ���� ��������������������������������������������������������������� �������������������� �������� ��� ������ ������������ ���� �������������� ��� ����� ��� �������� ���������� ��� ��������� ���� ������ �������� ������ ���� ����� ���������� ����� ����������� ���� ��� ��������� ��� ������� �� ������ ��������� ��� ���� �������� ����� ������ �������� �������� ���� ��������� ������� ���� ����� ��� ����� ���� ��������� ��������� ��� ����� ���������������������������������� ��� ������ ��� ��� ����� ��� �������� ������ ������� ����� ���������� ����� ������� ���������� ��� �� ���� ��������� ����� ������������������������������������������������������������ ��������������������������������������������������������������� ��������������������������������������������������������������� ��������������������������������������������������������������� ���������������������������������������������������������������� ���������������������������������������������������������������� ������������������������������������������������������������� ������������� � � � � � � �

� �����������

��������������������������������������



��� ������������������ ������������ �������� ��� �� ������� ����� ��� ��� ������ ��� ����� ��� ��������� ������ ���� ���� ��� ��������� ���������� ������ ����� ����� ������ ������� ������ �������� ������� ������ ����� ���� ���� ����� ��������� ��� ������ ������ ��� ����� ��� ���������� ���� ����� ��� ���� ���������� ��� ������ ����� ��� ���� ������ �������� ���� ������ ��� �������������������������������������� � ������� ����� �� ����������� ����� �������� ���� ������� ���� �� ������� ��� ��������� �������� ������ ��� ���� ��������� ����� ������������������������������������������������������������� ������� ������ ��� ���� ������ ����� ������ ����������� �������� ��� ��������� ���� ��������� ��������� ����� ������������� ����� ������ ����� ��� �� ��� ������ ������� ������� ����� ������ ��� ��������� �������� ����� ������ ��������� ���� ������ ����� �� ����� ������ �������������������������������������������������������������� ����� ��� ��� ��� ����� ����� ������ ��� ���������� ��� ���������� ����� ����� �������� ��� �� �������� ���������� ����� ���������� ���� ������� ����� ������� ���������� �������� �������� ��� ��������� ��� ������ ��������������������������������������������������������������� �� ������� ������ ���� ������� ��� ��������� ��� �� ������ ����� ����� ��� �������� � �

���� ��������������������������������� �

������������������������������������������������������������������������������������������������������������������������������������������ � � � � � � � � � � � � � � �

����������������������������������������������������������������� ���������������������������������������������� ���������������� ��������������������������������������������������������� � ���� ���������������������� ���� ��������� ������� ����� ��� ����� ��� ��� ������������ ������ �������� �������������� ������� ������� �������������� ����� ��� ���������� ��� ���� ������� ������ ������ �������������� ����� ��� ������������������������������������������������������������� ���������������������������������������������������������������� ����� ������� ���� �������� �������� ������ ������������� ��������� ���� ������ ������� ���� ������ �������� �������� ��� ���� ����������������������������������������������������������������� ���������������������������������������������������������� ������������������������������������







����� ������������������ � ���� ����������� ������� ��� ������� ��������� ��� ����� ����������� ������� �������� ������� ������ ��������� ������ ������������ ������ ���� ������ ������ ��� ��������� ��� ������� ���� ������� ��� �� �������� ���� ��� ���� ���� ���������� ������� ���� �����������������������������������������������



��� ���������������������� ���������� ����������������� ��� ����� ��� ����� ���������������� ��� ���� ������� ����� ���������������� ��������� ���� ������ �������� ��������� �������� ���� �������� �������� ��� ����� ���������� ���� ����������� ����������������� ��������������������� ����������� ������������� ����� ������� ��� ����� ����������� ������ ������� ��������������� �



� � � ������������� ������������������������������������������



� � �

��� �������������� ������������������������������������������������������������������ ��� �������� ����� ������ ����� ���� ����� �������� ����� ����������� ������ ���� �������� ����� ��� ���� ������������ ���� ������ ����� ������������������������������������������������������������� ������������������������������������������������� �



��� �������������� ������������������������������������������������������������������ ����������������������������������������������������������� ��������������������������������������������������������������� ����������������������������������������������������������������� ����� ��� ������ ���� ������ ������� ������� ���� ����� ����� ���� ����������� ���� ���������� ���� ��� ���� ������ ������� ����� ��� ���������������������������������������������������������������� ��� ������� ���� ������ ��� ���� ����� ������� ������� �������� ������������������������� �



� � � � � � � � � ���������������������������������������������

��� �������������� ���� ������� ������� ��� ������ ��� �� ������������ ����� ������������ �������� ���� ����������������� ������� ��������� ��� ��������� ����� ���� ������� ������� ������� ����� �����������

��� ����������������� ���������� ��� �� ��������� ������ ����������� ������� ��� ����� ��� ������������������������������������������������������������

���� ��������������������������������� �

������������������������������������������������������������������������������������������������������������������������������������������ ������� ��� �������� ������� ������� ���� ������ ����� ����� ����� ��������������� ��� ������ ������� ����� ��� ������ ����������� ���� ������� ��������� ������ ����� ���� ����������� ��� ��� ����� ����� ���������� ��� ��������� ��� ����������� ������ ������������� ������ ������ ������� ������� ���� ������� ������ ��� �������� ��� ���� ������ ����������������ction’s result is then published as ROS Topic to ��� ����� ��� ���� ������ ������ ���� ������� ������� ��� ��� ������ ��� ����� ��� ��� ���� �������� ����� ���������� ��� ������ ����� ������� ������������ ���� ���� ������� ������ ������� ��� ��������� ������ ��� ���������������������������������������������������������������� ���������������������������������������������������������������� ������������

��� ��������������� ���������� ������ ��� ������ ��� ���������� ���������� ������ ������ ����������� ��� ���� ����������� �������� ��������������� ��� ���� ������ ������� �������� ��� ���������� ��� ����� ����� ��������� ���� ������� �������� ��� ��������� ��� �������� ������������� ���� ������ ���� ����� ������� ���� ������ ������ ������������ ��� ���������� ��� ���� ��� ����������� ����� ������ �������� ������������ ��� �������� ������ ��������� ������� ����� ���� �� ���� ����������������������������������������������������������������� ��������� ��� ������������ �� ���� ������ ���������� ��� �������� �����������������������������



������������������������������������������������

� ��� ��������� ���������� ��������� ������������ ���� ������������ ��� ������� ���� ��������� ��� ���� ������� ���� ������� ��������� ����� ��������� ������������ ����� ���� ������� ������������ ���� �������� ������ ��������� �������� ����� ������� ����� ��������� ������ ����� ����� ������� ���� ��������� ������������ ����� ��� ����������� ���� ��������� ���� ���������� ��� ���� ������ ���� �������� ������ ������� State Machine approach. Current implementation of robot’s ������ ��������� ���� ���������� ������������ �������������� ������������������������� ���� ������ ��������� ������� ��� ����������� ������ ��� ��������� ��������� ��������� ���� ���� ��� ����������� ���� �������� ��� ���� robot’s current behavior. For example, ���������������������� gives ball’s current position as setpoint to the controller. The ��������� ������������ ��� ���������� ��� ��������� ����� ������� ��������� ���� �������� ��������� ��� ���� ������ ���� ������������� ����� ��������� ��� �������� ��� ������ ������������� ���� ��������� ��� ����������������������������������������������������������������� ��������������������������������������������������������������� ����������� ����� ������ ��������� ��� ������ ������� ����� ���� ������ ��������������������������������������������������������� ����� ��� ����������� ���� ������������ ��� ��� ���� ���� ���� ����������� ���� ���������������������

�������������������������������

��� �������������������� ���������������������������������������������������������������� ��� ��� �������� ��� ���� ������� ���� �������� ������� ���� ����� ���������������������������������������������������������������� ��������������������������������������������������������������� ��������������������������������������������������������������� �������� �������� ���� ���������� ��������� ������������� ����������������������������������������������������������������� ������� ��� ��������� ���������� ��������� ������������ ��� ���������� ��� ���� ��� ����������� ������ ���� ��� ����������� ����� ��������� ������� �������� ��������� ����� ������ ������� ���� ����� ������� �������������� ����� �������������� ��������� ��������� ������ ����� ����������� ��� ��� ������ ��� ������������ ������ ��������� ������������ ����� ������� �������� ����� ����� ���� ������ ��������� �� ����������� ������ �������� ������������ ������ ����� ����������������� ������������������������������������������� ������������������������������������������������������������ ����������������������������



���� ��������������������������������� �

=

������

����

( )�

������������������������������������������������������������������������������������������������������������������������������������������ �

=

( )

����������

������ ����������������������������������� ������������������������ ��� �� ������ ������� ��� ������� ��������� ��� ������ ���� � ��� ������ ��� �������

� � � �������������������������������������������

��� ���������������������������� ����������� ������ ���������� ���� ������������ ��� ���� ������ ������� ������ �������� ���� ����� ���� ���������� ����������������� ������ ���������� ����������� ������� ���� �������� ��������� �������������� ������� ������ ������� �������� ������� ������� ���� ��������������� ��� ������������������ ���� ��������� ����������� ��� ���� ������� �������������� ���� ����� ������� ����� ��� ����� ��� ���������� ������ �������� ���� ������� �������� ��� �������� ������� ������������������������� ����������� ���� ��������� ������� ����� ������ ������� ������ ���� ������������ ��������� ������ ���� �������������������������������������������������������������������� ��������������������� ���� ���������� �������� ���� ���� ����� ����� ���� ��� ��� ����� ���������� ���� �������������������������������������������������������� ���� ���������������������������������������������������������������������� ������������������������������� ���� ���� ����������� ��� ���� �������� ��� ���� ������� ����� ��������� ���������� ��� �������� ���� ������ ������ ����������� �� ����������� ������������ ������������������������� ���� ��������������������������������������������������������������������� ����������������������������������������������������������������������� ������ ������� ������ ��������� ��� ����������� ������������� ���� �������������������������������� ���� ������������������������������������������������������������������������ ����������� ��� ��������� ������� ������ ������ ����������������� ������ ����������� ������ ���������� ����� ������� ��� ������������ ������ ������ �

���� ��������������������������������� �

Suggest Documents