fixed start pose
setting goal within reach directly