Backport of PR:2594 for humble#3695

MShields1986 wants to merge 1 commit intomoveit:humblemoveit/moveit2:humblefrom

MShields1986:pr-servo-command-queue-humble-backportMShields1986/moveit2:pr-servo-command-queue-humble-backportCopy head branch name to clipboard