Add convertFootstepPlan

Usage

>> sol = testQuadrupedNonGaited();
>> [foosteps, stance_times] = convertFootstepPlan(sol);