Small fixes
Added robot simulator, modified functionalities structure, bug fixes.