Robot code for my dead reckoning robot