improve walking

Jonathan Ehretrequested to merge
fix/walking-improvement into dev/5.3

improve walking by storing last collision free position and restoring it in case that is needed, also move out of dynamic collisions

Merge request reports