Add convertFootstepPlan

Usage

>> sol = testQuadrupedNonGaited();
>> [foosteps, stance_times] = convertFootstepPlan(sol);
Merge pull request #1 from avalenzu/master

Add convertFootstepPlan