Changed to single sonar sweep and added status led