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

feat: nodes should die entirely if no MCU found

Browse Source 
This should allow anchor to restart automatically if it's being run as a service
This commit is contained in:
Tristan McGinnis
2025-04-15 20:35:49 -05:00
committed by David
parent f12daff861
commit 8c4f75f75e
4 changed files with 17 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
src/anchor_pkg/anchor_pkg/anchor_node.py
View File

@@ -7,6 +7,7 @@ import time
import atexit
import serial
import os
import sys
import threading
import glob
@@ -61,8 +62,9 @@ class SerialRelay(Node):
if self.port is None:
self.get_logger().info("Unable to find MCU...")
time.sleep(1)
sys.exit(1)
#kill the node/process entirely
os.kill(os.getpid(), signal.SIGKILL)
sys.exit(0)
self.ser = serial.Serial(self.port, 115200)
atexit.register(self.cleanup)

7
src/arm_pkg/arm_pkg/arm_node.py
View File

@@ -95,9 +95,10 @@ class SerialRelay(Node):
break
if self.port is None:
self.get_logger().info("Unable to find MCU... please make sure it is connected.")
time.sleep(1)
sys.exit(1)
self.get_logger().info("Unable to find MCU...")
#kill the node/process entirely
os.kill(os.getpid(), signal.SIGKILL)
sys.exit(0)
self.ser = serial.Serial(self.port, 115200)
atexit.register(self.cleanup)

8
src/bio_pkg/bio_pkg/bio_node.py
View File

@@ -3,6 +3,7 @@ from rclpy.node import Node
import serial
import sys
import threading
import os
import glob
import time
import atexit
@@ -65,9 +66,10 @@ class SerialRelay(Node):
pass
if self.port is None:
self.get_logger().info("Unable to find MCU... please make sure it is connected.")
time.sleep(1)
sys.exit(1)
self.get_logger().info("Unable to find MCU...")
#kill the node/process entirely
os.kill(os.getpid(), signal.SIGKILL)
sys.exit(0)
self.ser = serial.Serial(self.port, 115200)
atexit.register(self.cleanup)

6
src/core_pkg/core_pkg/core_node.py
View File

@@ -7,6 +7,7 @@ import time
import atexit
import serial
import os
import sys
import threading
import glob
@@ -74,8 +75,9 @@ class SerialRelay(Node):
if self.port is None:
self.get_logger().info("Unable to find MCU...")
time.sleep(1)
sys.exit(1)
#kill the node/process entirely
os.kill(os.getpid(), signal.SIGKILL)
sys.exit(0)
self.ser = serial.Serial(self.port, 115200)
atexit.register(self.cleanup)