adding filter to ground distance by OF sonar

adding filter to ground distance by OF sonar