HCSR04 support

HCSR04 support for rotating servo or other parts
Totaly remaky but inspired by http://www.thingiverse.com/thing:35398