Code for a arduino robot