Code Cleanup
Fixed code formating for convention of UHH-SE2
Removed unused Code and variables