Added better ultrasonic data filtering

Also added some outputs from single scans