Collapsed stepRightFootDestination and stepLeftFootDestination into one method getNewFootTarget
Improved and commented footPhase.