Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
Initial urdf parser plugin that parses sdformat (#1)
* Initial urdf parser plugin that parses sdformat Lots of TODOs Signed-off-by: Shane Loretz<sloretz@openrobotics.org> Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Visual and Collision with Box geometry Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Sphere geometry Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Cylinder geometry Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Mesh support Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * remove TODO comment about resolving poses Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Let downstream worry about resolving mesh URIs Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Reword assumption about kinematic root link Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Make fall through comments easier to see Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Create urdf_mesh variable Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Handle inertia Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Mesh scale Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Visibility control header Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Remove resource_retriever dependency Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Support joint axis expressed in other frames Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Include ignition/math/Pose3.hh Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Use final on plugin class Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Use TinyXML2 to filter non-sdf XML documents Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Apache 2.0 License Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Satisfy uncrustify Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Satisfy cpplint Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add linter tests Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add test for pose_link case Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Actually add test files Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add SDF link pose to URDF link members Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Pose link test actually checks pose Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add SDF visual pose test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add SDF collision pose test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add SDF inertial pose test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add test for model with pose, plus refactor test tools Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Replace todo with explanation Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add pose_link_all test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Assert model name is correct Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add pose_link_in_frame test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add pose_collision_in_frame test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add pose_visual_in_frame test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add skipped pose_inertial_in_frame test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Depend on sdformat Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Fix link poses of child links Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add test for model with joint pose Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Remove unused variable Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add test for model with joint pose in frame Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Rename variables for consistent ordering Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Fix fame names in calculating joint pose Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * URDF link frames are coincident with joint frames And the root link pose has no effect on the URDF output except that it changes the relative locations of other links with the root link. The SDF link pose cannot be expressed in URDF C++ structures without adding dummy links, but this does not do that. Signed-off-by: Shane Loretz<sloretz@openrobotics.org> Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add pose_chain test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Clearer description of pose_collision expectations Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Clearer description of pose_collision_in_frame expectations Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Clearer pose_inertial* expectations Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Remove unnecessary ASSERT Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Initializer lists Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Remove unnecessary ASSERT Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Initializer lists Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Fix pose_link* test expectations Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Clearer pose_visual* test expecations Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Shorter file name Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Shorter file name Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add graph_loop test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add graph_four_bar test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Alphabetize Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Refactor tree traversal code Fixes bug were tree's with non-canonical roots were not caught during conversion Shrink list of joints to check after checking them Use visited_links only to catch multiple roots and algorithm errors Get rid of trailing_ Signed-off-by: Shane Loretz<sloretz@openrobotics.org> Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add graph_tree_non_canonical_root test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Transfrom -> transform Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Different error when XML file has no model Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * urdf child link keeps weak reference to parent link Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add graph_tree test and EXPECT_NAMES util Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add graph_chain test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add graph_chain_non_canonical_root test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add geometry_plane test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add geometry_box test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add geometry_cylinder test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add geometry_sphere test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add geometry_heightmap test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add geometry_collada test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add geometry_obj test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add geometry_stl test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add geometry_mesh_scaled test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add tests for zero and two models Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_ball test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Get rid of num_axes variable Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add damping and friction info to joints Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_continuous test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_fixed test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint limits info Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_prismatic test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add axis expectations Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_revolute test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_revolute2 test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_screw test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_universal test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add link_inertia test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_revolute_axis test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Warn on non-default values of unsupported <joint> tags Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add link_multiple_collisions test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add link_multiple_visuals test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_revolute_axis_in_frame test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_revolute_default_limits test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Detect kinematic loops involving redundant joints Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_revolute_two_joints_two_links test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Warn if <sensor> or <light> are used on <link> Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add link_sensor_imu test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add link_light_point test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Sensors -> lights Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Move package into folder in repo Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add sdformat_test_files package to repo Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * lilnk -> link Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Whitespace Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Save a line Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Move PlaneShape check lower Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Remove impossible condition after make_shared Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Make names shorter Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Remove accidentally comitted file Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add material_blinn_phong test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Warn if unsupported <material><lighting> feature is used Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add skipped material_dynamic_lights test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Remove unfinished material models and add TODO for them Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Expect no Algorithm errors Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add joint_gearbox model and test Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Update descriptions of all models Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add sdformat_test_files README Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add README for sdformat_urdf Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Misc tiny edits Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Eliminate elements Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add repo level readme Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Remove . Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Trick to use sdformat9 from source Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Remove condition hack Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Add colcon.pkg for building sdformat from source Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * check errors instead of valid pointer Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Make urdf a <depend> Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Remove std::cout dbg print Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * the the -> the Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Compare WorldCount against 0u Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Concatenate link and visual names to make material name Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Compatibility with CMake earlier than 3.14 Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Use target_link_libraries() Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * One install rule per target Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * voilated -> violated Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Use axis2 for second axis Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Universal joint perpendicular axis Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Use Pose3d::operator* Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * structures -> DOM objects Signed-off-by: Shane Loretz <sloretz@osrfoundation.org> * Document EXPECT_NAMES() Signed-off-by: Shane Loretz <sloretz@openrobotics.org> * Compare normalized joint axes Signed-off-by: Shane Loretz <sloretz@openrobotics.org> * Check casted pointer before using them Signed-off-by: Shane Loretz <sloretz@openrobotics.org> * Check geometry pointer isn't null before using it Signed-off-by: Shane Loretz <sloretz@openrobotics.org> * Assert joint isn't null before using it Signed-off-by: Shane Loretz <sloretz@openrobotics.org> * Assert link isn't null before using it Signed-off-by: Shane Loretz <sloretz@openrobotics.org> * Assert link isn't null before using it Signed-off-by: Shane Loretz <sloretz@openrobotics.org> * Color = 0.4 * ambient + 0.8 * diffuse Signed-off-by: Shane Loretz <sloretz@openrobotics.org> * Fix application of link pose on inertial/visual/collision Signed-off-by: Shane Loretz <sloretz@openrobotics.org> * Add pose_joint_all test Signed-off-by: Shane Loretz <sloretz@openrobotics.org>
- Loading branch information