Parameterized diagnostic tests
Merge branch 'master' into distance-sensor