finish unit test of robot-simulator. WIP solution