Added arduino_two, wrote fast sonar reader