Continued work on motion algorithms

And clean up after battle with Unity's rotation