Code as of first robot test drive. Booya!