Added Robot Configuration functions

/ updated RobotGUI for Robot Configuration / implemented speed
visualization in RobotGUI