Moved setting neutral gear pin mode into init
Created delay macros for ignition cut and servo.

Instead of explicitly calling the _delay_ms function on each software
delay we wrap them in a macro