Controller code for tiny tim robot