Edited movement and command bugs.

To do:
- for some reason, the head of the road queue changes
- do an efficient queue heap updater