Fix start movement in walking

[timonegk]

Summary

Fixes the start movement in walking. Before, there was a jump in the trajectory for both feet's y axis when starting the first step.

Before:

After:

• [x] tested in visualization
• [ ] tested on robot

[timonegk]

This behavior is not nice but it makes the walking more stable... closing.