Put #ifdef around servo pins in pins.h. This allows the pins to be used for M42.