Arduino pibot code - Basic