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)
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