Code review. Empty line cleanings, added lot of todos, minor refactoring.
I hope I didn't break anything... Otherwise sry
Merge branch 'dev' into feature/gps_data