initial watchdog node commit

rb_ws/src/buggy/buggy/watchdog/watchdog_node.py

@@ -0,0 +1,44 @@
+import rclpy
+from rclpy.node import Node
+
+from std_msgs.msg import Bool
+
+class Watchdog(Node):
+
+    def __init__(self):
+        """
+        Constructor for Watchdog class.
+
+        Creates a ROS node with a publisher that periodically sends a message
+        indicating whether the node is still alive.
+        
+        """
+        super().__init__('watchdog')
+        self.heartbeat_publisher = self.create_publisher(Bool, 'self/debug/heartbeat', 1)
+        timer_period = 0.01  # seconds (10 Hz)
+        self.timer = self.create_timer(timer_period, self.loop)
+        self.i = 0 # Loop Counter
+
+    def loop(self):
+        # Loop for the code that operates at 0.1 Hz
+        msg = Bool()
+        msg.data = True
+        self.heartbeat_publisher.publish(msg) 
+
+
+def main(args=None):
+    rclpy.init(args=args)
+
+    minimal_publisher = Watchdog()
+
+    rclpy.spin(minimal_publisher)
+
+    # Destroy the node explicitly
+    # (optional - otherwise it will be done automatically
+    # when the garbage collector destroys the node object)
+    minimal_publisher.destroy_node()
+    rclpy.shutdown()
+
+
+if __name__ == '__main__':
+    main()

rb_ws/src/buggy/launch/watchdog.xml

@@ -0,0 +1,4 @@
+<launch>
+    <node pkg="foxglove_bridge" exec="foxglove_bridge" name="foxglove" namespace="SC"/>
+    <node pkg="buggy" exec="watchdog" name="SC_watchdog" namespace="SC"/>
+</launch>

rb_ws/src/buggy/setup.py

@@ -24,7 +24,8 @@
     tests_require=['pytest'],
     entry_points={
         'console_scripts': [
-            'hello_world = buggy.hello_world:main'
+            'hello_world = buggy.hello_world:main',
+            'watchdog = buggy.watchdog.watchdog_node:main'
         ],
     },
 )