isaac_ros_pose_estimation
isaac_ros_pose_estimation copied to clipboard
Add reset request subscription to selector node
Currently when using the FoundationPose selector node, pose estimation can only be reset periodically by a wall timer. I found the need to reset pose estimation programmatically when the tracking fails to track the actual object.
I attempted publishing the required messages directly on the pose_estimation topics but that didn't work consistently. Due to a race condition, occasionally pose estimation would run but the tracking would be fed back the last (incorrect) pose that it produced.
To enable consistent programmatic resetting, this PR adds a subscription to Empty messages on a reset topic that triggers the pose estimation reset when a message is received.