Move "add FootStep" to Pedestrian internals
Dependency: solve #272 (closed) first
Currently, the FootSteps have to be added by the UpdateScheme. However, it may be better that this is handled internally (e.g. when calling updateNextPosition
is called).