Arduino code to interface with 3 sonar sensors and 2 DC motors