(GaitGenerator.*) : Fix bug of swing foot calculation and add reset orbit
Merge pull request #246 from snozawa/fix_swing_foot_calculation

Fix bug of swing foot calculation and add reset orbit