private ROS2UnityComponent ros2Unity;
private ROS2Node ros2Node;
private ISubscription<JointState> jointStateSub;

void Start()
{
    // Find the ROS2UnityComponent in the scene
    ros2Unity = GetComponent<ROS2UnityComponent>();
}

void Update()
{
     if (ros2Node == null && ros2Unity.Ok())
    {
        // Create a node
        ros2Node = ros2Unity.CreateNode("joint_state_listener_node");

        // Subscribe to the /joint_states topic
        jointStateSub = ros2Node.CreateSubscription<JointState>(
            "/joint_states",
            msg =>
            {
                for (int i = 0; i < msg.Position.Length; i++)
                {
                    Debug.Log($"Joint {i}: Position {msg.Position[i]}");
                }
            });
    }
}