Unit movement service - fixed some bugs, added some tests. Closes #20