added sonar2_trigger for use with second sonar
added Median Filter for testing