Formating
Minifixing
added missing C-sources
more comments
removed redundant code
Display is working again (takes it time at the beginning, but is working
again)