C code for Atmega32 controlling PCA9685 servo driver