fix servo, wiringSetup() and undefined reference bug