Reads accelerometer data
converts to angle
Updates the timer channels correctly
Drives both servos.