Add smooth moving
Refactor to use references instead of pointers