Reorganized the code - init and support functions for each module (apart from USART) moved to separate files. Some additional functions to make code easier to read.
TODO - change comments to English.