pitch and yaw to robot coordinates