[Don't Merge] Add geometry2#345

gleichdick wants to merge 2 commits into

moveit:mainmoveit/moveit2:mainfrom

gleichdick:geometry2_testgleichdick/moveit2:geometry2_testCopy head branch name to clipboard