Shifting code from PICAXE to Arduino