我正在使用2个应通过操纵杆控制的轮式机器人,但实际上我有3个操纵杆和2个机器人。跟随控制一个机器人的代码(我还没有完成),我有一个问题。我知道如何对每个机器人分配控制权,我可以从第一个操纵杆控制一个,而从另一个操纵杆控制两个。我无法为每个操纵杆创建特殊条件。
import socket
import pygame
import time
import pygame.joystick
pygame.init()
pygame.display.set_mode((640, 480))
rc_socket = socket.socket()
rc_socket_2 = socket.socket()
try:
rc_socket.connect(('192.168.1.102', 1234)) # connect to robot
rc_socket_2.connect(("192.168.1.101",1234))
except socket.error:
print("could not connect to socket")
joystick_count = pygame.joystick.get_count()
for index in range(joystick_count):
joystick = pygame.joystick.Joystick(index)
joystick.init()
print('{0}, {1}'.format(index, joystick.get_name()))
while True:
events = pygame.event.get()
for event in events:
if event.type == pygame.JOYAXISMOTION:
joy = event.joy
axis = event.axis
value = event.value
if axis == 1:
if abs(value) >= 0.2:
u1 = value
u2 = value
rc_socket.send('({},{})\n'.format(u1, u2).encode())
# print('({},{})\n'.format(u1, u2))
print(value)
else:
u1 = u2 = 0
rc_socket.send('({},{})\n'.format(u1, u2).encode())
# print('({},{})\n'.format(u1, u2))
print("{} -> sending (0,0)".format(value))
if event.type == pygame.KEYDOWN:
if event.key == pygame.K_LEFT:
u1 = -1.0
u2 = 1.0
print("turn left: ({},{})".format(u1, u2))
elif event.key == pygame.K_RIGHT:
u1 = 1.0
u2 = -1.0
print("turn right: ({},{})".format(u1, u2))
elif event.key == pygame.K_UP:
u1 = 1.0
u2 = 1.0
print("forward: ({},{})".format(u1, u2))
elif event.key == pygame.K_DOWN:
u1 = -1.0
u2 = -1.0
print("forward: ({},{})".format(u1, u2))
rc_socket_2.send('({},{})\n'.format(u1, u2).encode())
elif event.type == pygame.KEYUP:
u1 = 0
u2 = 0
print("key released, resetting: ({},{})".format(u1, u2))
rc_socket_2.send('({},{})\n'.format(u1, u2).encode())