Fixes infeasibility when robot starts with toes pointing together
Merge pull request #284 from rdeits/fix-footstep-infeas

Fixes infeasibility when robot starts with toes pointing together