Refactor to prepare for velocity-preserving navmesh collisions
First try to have movement on-rails