print 'Spin Left', speed elif keyp == '.' or keyp == '>': speed = min(100, speed+10) print 'Speed+', speed elif keyp == ',' or keyp == '<': speed = max (0, speed-10) print 'Speed-', speed elif keyp == 'h': pi2go.stopServos() print 'Servos stopped' elif keyp == 't': degree = degree-15 pi2go.setServo(0, degree) print 'Servo 0', degree elif keyp == 'y': degree = degree+15 pi2go.setServo(0, degree) print 'Servo 0', degree elif keyp == 'u': degree = degree-15 pi2go.setServo(0, degree) print 'Servo 1', degree elif keyp == 'j': degree = degree-15 pi2go.setServo(0, degree) print 'Servo 1', degree
import tty import termios from socket import * pi2go.init() HOST = '' PORT = 21567 BUFSIZE = 1024 ADDR = (HOST, PORT) tcpSerSock = socket(AF_INET, SOCK_STREAM) tcpSerSock.bind(ADDR) tcpSerSock.listen(5) while True: print 'Waiting for connection' tcpCliSock, addr = tcpSerSock.accept() print '...connected from :', addr try: while True: data = '' data = tcpCliSock.recv(BUFSIZE) if not data: break pi2go.setServo(int(data)) print 'Servo Position', '=', int(data) except KeyboardInterrupt: pi2go.stopServo() pi2go.cleanup() tcpSerSock.close()
def doServos(): pi2go.setServo(pan, pVal) pi2go.setServo(tilt, tVal)
print 'Spin Left', speed elif keyp == '.' or keyp == '>': speed = min(100, speed + 10) print 'Speed+', speed elif keyp == ',' or keyp == '<': speed = max(0, speed - 10) print 'Speed-', speed elif keyp == ' ': pi2go.stop() print 'Stop Motors' if keyp == 'i': position = 50 pi2go.setServo(position) print 'Servo set to Middle Position' elif keyp == 'o': position = 0 pi2go.setServo(position) print 'Servo set to Left Position' elif keyp == 'p': position = 100 pi2go.setServo(position) print 'Servo set to Right Position' elif keyp == 'y': if position < 100: position += step pi2go.setServo(position) print 'Servo Position +', step, '=', position