aaron/rover-ros2
1
0
Fork 0
mirror of https://github.com/SHC-ASTRA/rover-ros2.git synced 2026-02-11 09:20:40 +00:00
Code Issues Packages Projects Releases Wiki Activity

add trying multiple controllers to headless

Browse Source
This commit is contained in:
SHC-ASTRA
2026-01-14 04:56:55 -06:00
parent 14141651bf
commit 0e775c65c6
1 changed files with 22 additions and 15 deletions
Download Patch File Download Diff File Expand all files Collapse all files

15
src/headless_pkg/src/headless_node.py
View File

@@ -74,11 +74,17 @@ class Headless(Node):
print("No gamepad found. Waiting...")
# Initialize the gamepad
self.gamepad = pygame.joystick.Joystick(0)
id = 0
while True:
if id >= pygame.joystick.get_count():
self.get_logger().fatal("Ran out of controllers to try")
sys.exit(1)
self.gamepad = pygame.joystick.Joystick(id)
self.gamepad.init()
print(f"Gamepad Found: {self.gamepad.get_name()}")
if self.gamepad.get_numhats() == 0:
if self.gamepad.get_numhats() == 0 or self.gamepad.get_numaxes() < 5:
self.get_logger().error("Controller not correctly initialized.")
if not is_user_in_group("input"):
self.get_logger().warning(
@@ -88,8 +94,9 @@ class Headless(Node):
self.get_logger().warning(
"If using NixOS, you may need to remove yourself from the 'plugdev' group."
)
time.sleep(1)
sys.exit(1)
else:
break
id += 1
self.create_timer(0.15, self.send_controls)