Test: filtered values as robot crosses lines
Fast US and light localization

Light localization is not really accurate.
Merge branch 'master' of https://github.com/mattgray7/DPMFinal into odo-filter-test