Lots of documentation for USART and servo lib
Refactorized includes for USART and servo lib
Less black magic macros for servos