Enhancement/use hpp for headers based on PR https://github.com/moveit/moveit2/pull/3113

Enhancement/use hpp for headers based on PR https://github.com/moveit/moveit2/pull/3113 #135