import FNG_motordriver as FNG import ultrasonic_lib as ultrasonic import curses import time import sys stdscr = curses.initscr() curses.noecho() curses.cbreak() robot = FNG.robot() sensor = ultrasonic.sensor() robot.stop() while True: try: cmd = stdscr.getch distance = sensor.get_range() if cmd == ord('w'): robot.forward() elif cmd == ord('s'): robot.backward() elif cmd == ord('d'): robot.left_turn() elif cmd == ord('a'): robot.right_turn()
#!/usr/bin/python import cwiid import time, sys import FNG_motordriver as FNG robot = FNG.robot(18, 23, 24, 25, 12) #stby, dir1, dir2, DIR1, DIR2 button_delay = 0.1 print 'press the button on wiimote' time.sleep(1) try: wii = cwiid.Wiimote() except RuntimeError: print "Error opening wiimote connection" sys.exit() print 'connected! ctrl + c to exit' wii.rpt_mode = cwiid.RPT_BTN while True: try: buttons = wii.state['buttons'] if (buttons & cwiid.BTN_LEFT): robot.left_turn()