Add basic driving and ultrasonic

I really just needed to upload this somewhere.