Head measures light and distance in two different threads + threads are terminated on program end
Bugfix in measure thread
Testing
Merged master
Sweep should work in parallel (light + distance)