Uncrustify

Cleans and fix costmetic and other (not so important) issues