moveit2
The MoveIt Motion Planning Framework for ROS 2.
ros_bullet_utils.h
Go to the documentation of this file.
1 /*********************************************************************
2  * Software License Agreement (Apache License)
3  *
4  * Copyright (c) 2018, Southwest Research Institute
5  * All rights reserved.
6  *
7  * Licensed under the Apache License, Version 2.0 (the "License");
8  * you may not use this file except in compliance with the License.
9  * You may obtain a copy of the License at
10  * http://www.apache.org/licenses/LICENSE-2.0
11  *
12  * Unless required by applicable law or agreed to in writing, software
13  * distributed under the License is distributed on an "AS IS" BASIS,
14  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
15  * See the License for the specific language governing permissions and
16  * limitations under the License.
17  *********************************************************************/
18 
19 /* Author: Levi Armstrong */
20 
21 #pragma once
22 
23 #include <sstream>
24 
25 #include <octomap_msgs/conversions.h>
26 #include <geometric_shapes/shape_messages.h>
27 #include <geometric_shapes/shapes.h>
28 #include <geometric_shapes/shape_operations.h>
29 #include <rclcpp/logging.hpp>
30 
32 
34 {
40 void getActiveLinkNamesRecursive(std::vector<std::string>& active_links, const urdf::LinkConstSharedPtr& urdf_link,
41  bool active);
42 
43 shapes::ShapePtr constructShape(const urdf::Geometry* geom);
44 
45 Eigen::Isometry3d urdfPose2Eigen(const urdf::Pose& pose);
46 
47 } // namespace collision_detection_bullet
Eigen::Isometry3d urdfPose2Eigen(const urdf::Pose &pose)
void getActiveLinkNamesRecursive(std::vector< std::string > &active_links, const urdf::LinkConstSharedPtr &urdf_link, bool active)
Recursively traverses robot from root to get all active links.
shapes::ShapePtr constructShape(const urdf::Geometry *geom)