fix servo and wiringSetup