- abs(self.__translate(self.controlData['leftRight']))
right_speed = abs(self.__translate(self.controlData['forBack']))
if left_speed < 0:
left_speed = 0
if right_speed < 0:
right_speed = 0
message.set_left_speed(int(left_speed))
message.set_right_speed(int(right_speed))
return message
message_in_queue = Queue.LifoQueue()
messenger_thread = MessageManager(message_in_queue, '/dev/ttyACM1', 115200)
if __name__ == "__main__":
messenger_thread.start()
robots = [
#RobotControl(1, 66),
RobotControl(0, 65)
]
while True:
ev = pygame.event.wait()
for r in robots:
if r.update_control():
message_in_queue.put(r.generate_message())
