get reachability from biped
make goal cost higher on final steps