robot code going in a good direction..?