Replaced all Arduino libraries by specialized code
Removed Timer 0 and UART interrupts to prevent jitter on the servo signals
Code size has been cut in half!