Square wave function programming on Arduino Due