Commit 9

Added main control class Robot
Refactored