Added comments
Added latency graph and reduced waiting time for tracking queue
Merge branch 'pController' of https://github.com/KITrokopter/Control-Application into pController