Update drv_hcsr04.c

Change trig and echo to pins 5 and 6 to be compatible for cleanflight tutorial