created update_robot_pose method (calculate mean position)