Add new boot program to test sonar sensors
Remove old distance measurement boot program since it is redundant