Finished implementing speed control and turning. Also did some refactoring.