Untested code. Finished reimplementation of old steering code.