changed forward, backward and turning directions in keyboard control script such that it fits the model and the camera image

simple_control
Simon Pirkelmann 2019-06-11 16:28:01 +02:00
parent 480e1f523c
commit 0d14738671
1 changed files with 13 additions and 11 deletions

View File

@ -6,8 +6,10 @@ pygame.display.set_mode((640, 480))
rc_socket = socket.socket()
try:
rc_socket.connect(('192.168.4.1', 1234)) # connect to robot
#rc_socket.connect(('192.168.1.101', 1234)) # connect to robot
#rc_socket.connect(('192.168.4.1', 1234)) # connect to robot
rc_socket.connect(('192.168.1.101', 1234)) # connect to robot
#rc_socket.connect(('192.168.1.102', 1234)) # connect to robot
#rc_socket.connect(('192.168.1.103', 1234)) # connect to robot
except socket.error:
print("could not connect to socket")
@ -20,21 +22,21 @@ while True:
for event in events:
if event.type == pygame.KEYDOWN:
if event.key == pygame.K_LEFT:
u1 = vmax
u2 = -vmax
u1 = -vmax
u2 = vmax
print("turn left: ({},{})".format(u1, u2))
elif event.key == pygame.K_RIGHT:
u1 = -vmax
u2 = vmax
u1 = vmax
u2 = -vmax
print("turn right: ({},{})".format(u1, u2))
elif event.key == pygame.K_UP:
u1 = -vmax
u2 = -vmax
u1 = vmax
u2 = vmax
print("forward: ({},{})".format(u1, u2))
elif event.key == pygame.K_DOWN:
u1 = vmax
u2 = vmax
print("forward: ({},{})".format(u1, u2))
u1 = -vmax
u2 = -vmax
print("backward: ({},{})".format(u1, u2))
rc_socket.send('({},{})\n'.format(u1, u2))
elif event.type == pygame.KEYUP:
print("key released, resetting: ({},{})".format(u1, u2))