Refactored FFARobot.java to more OOP style