def main(): #vehicle = connect('udp:192.168.1.177:14554', baud=57600, wait_ready=True) #vehicle = connect('udp:10.42.0.1:14555', baud=57600, wait_ready=True) #vehicle = connect('udp:127.0.0.1:14553', baud=57600, wait_ready=True) arduino = PyMata("/dev/ttyUSB0") arduino.sonar_config(3, 4) arduino.sonar_config(5, 6) arduino.sonar_config(7, 8) def signal_handler(signal, frame): if arduino != None: arduino.reset() sys.exit(0) signal.signal(signal.SIGINT, signal_handler) while True: arduino.digital_write(13, 1) data = arduino.get_sonar_data() sonarS = data[3][1] sonarL = data[5][1] sonarR = data[7][1] print sonarS, sonarR, sonarL time.sleep(.05) #vehicle.mode = VehicleMode("LAND") #vehicle.close() arduino.close()
import signal from PyMata.pymata import PyMata # create a PyMata instance board = PyMata("/dev/ttyACM0", verbose=True) # you may need to press ctrl c twice def signal_handler(sig, frame): print('You pressed Ctrl+C') if board is not None: board.reset() board.close() sys.exit(0) signal.signal(signal.SIGINT, signal_handler) # Configure the trigger and echo pins board.sonar_config(12, 12) time.sleep(1) # Create a forever loop that will print out the sonar data for the PING device while 1: data = board.get_sonar_data() print(str(data[12][1]) + ' centimeters') time.sleep(.2)
from PyMata.pymata import PyMata # create a PyMata instance board = PyMata("/dev/ttyACM0", verbose=True) # you may need to press ctrl c twice def signal_handler(sig, frame): print('You pressed Ctrl+C') if board is not None: board.reset() board.close() sys.exit(0) signal.signal(signal.SIGINT, signal_handler) # Configure the trigger and echo pins board.sonar_config(12, 12) time.sleep(1) # Create a forever loop that will print out the sonar data for the PING device while 1: data = board.get_sonar_data() print(str(data[2]) + ' centimeters') time.sleep(.2)
firmata.set_pin_mode(49, firmata.OUTPUT, firmata.DIGITAL) firmata.set_pin_mode(50, firmata.OUTPUT, firmata.DIGITAL) firmata.set_pin_mode(51, firmata.OUTPUT, firmata.DIGITAL) firmata.set_pin_mode(52, firmata.OUTPUT, firmata.DIGITAL) firmata.set_pin_mode(53, firmata.OUTPUT, firmata.DIGITAL) # configure 4 pins for 4 SONAR modules firmata.sonar_config(6, 6) time.sleep(.1) firmata.sonar_config(7, 7) time.sleep(.1) firmata.sonar_config(37, 37) time.sleep(.1) firmata.sonar_config(39, 39) time.sleep(1) # create a forever loop that will sequentially turn on all LEDS, # then print out the sonar data for the 4 PING devices # then sequentially turns off all LEDS and print PING data again print firmata.get_digital_response_table() while 1: for i in range(46, 54): time.sleep(.1) firmata.digital_write(i, 1) print firmata.get_sonar_data() for i in range(46, 54): time.sleep(.1) firmata.digital_write(i, 0) print firmata.get_sonar_data()
firmata.set_pin_mode(52,firmata.OUTPUT,firmata.DIGITAL) firmata.set_pin_mode(53,firmata.OUTPUT,firmata.DIGITAL) # configure 4 pins for 4 SONAR modules firmata.sonar_config(6,6) time.sleep(.1) firmata.sonar_config(7,7) time.sleep(.1) firmata.sonar_config(37,37) time.sleep(.1) firmata.sonar_config(39,39) time.sleep(1) # create a forever loop that will sequentially turn on all LEDS, # then print out the sonar data for the 4 PING devices # then sequentially turns off all LEDS and print PING data again print firmata.get_digital_response_table() while 1: for i in range(46,54): time.sleep(.1) firmata.digital_write(i, 1) print firmata.get_sonar_data() for i in range(46,54): time.sleep(.1) firmata.digital_write(i, 0) print firmata.get_sonar_data()