toeConstraint now solves for hip angles over a range of states