big remaniement of robot engine: refactor, easier to use