pose_controller: improves pose approach