code for raspberry ultra sound and motors controlling