General code clean up

[Vavat]

• Create a consistent coding style. Current style is error-prone and needs to be addressed.

• Implement automatic code style parser for all contributors.

• Function names, variables and constants require addressing according to coding style.

• Functions require documentation headers.

• Code requires UML execution diagram for easier understanding of how it works.