working version of robot pose