Trying to find a good way to determine the right walking direction

At the moment it does not work sufficient. Still searching for the
right approach.
Minor fix for debugging of walk direction