Added front ultrasonic back ultrasonic and grabber ultrasonic output to test mode.