New locomotion system and debug view - WIP