Fix positionrobot and findtarget, make them subclass commandbase