Fix double initialization problem in python api (#56)

Co-authored-by: lukeschmitt-tr <[email protected]>

interbotix_xs_toolbox/interbotix_xs_modules/interbotix_xs_modules/xs_robot/core.py

@@ -52,6 +52,7 @@
 from rclpy.logging import LoggingSeverity, set_logger_level
 from rclpy.node import Node
 from rclpy.task import Future
+from rclpy.utilities import ok
 from sensor_msgs.msg import JointState
 from trajectory_msgs.msg import JointTrajectory, JointTrajectoryPoint
 
@@ -93,7 +94,9 @@ def __init__(
         else:
             self.ns = f'/{self.robot_name}'
 
-        rclpy.init(args=args)
+        if not ok():
+            rclpy.init(args=args)
+
         super().__init__(node_name=self.node_name, namespace=robot_name)
         set_logger_level(self.node_name, logging_level)
         self.get_logger().debug((