#include <sbpl_arm_planner_node/sbpl_arm_planner_node.h>#include <iostream>#include <map>#include <ros/ros.h>#include <boost/thread/mutex.hpp>#include <tf/tf.h>#include <tf/transform_listener.h>#include <message_filters/subscriber.h>#include <tf/message_filter.h>#include <tf/transform_datatypes.h>#include <kdl/chain.hpp>#include <kdl/frames.hpp>#include "frames.hpp"#include "jacobian.hpp"#include "jntarray.hpp"#include "chain.hpp"#include <algorithm>#include <cmath>#include <stdio.h>#include <string>#include <fstream>#include <stdlib.h>#include <math.h>#include <actionlib/client/simple_action_client.h>#include <geometry_msgs/PoseStamped.h>#include <geometry_msgs/Vector3.h>#include <move_arm_msgs/MoveArmAction.h>#include <move_arm_msgs/utils.h>#include <pr2_controllers_msgs/JointTrajectoryAction.h>#include <visualization_msgs/MarkerArray.h>#include <visualization_msgs/Marker.h>#include <boost/lexical_cast.hpp>#include <motion_planning_msgs/DisplayTrajectory.h>#include <planning_environment/monitors/joint_state_monitor.h>#include <kinematics_msgs/GetPositionIK.h>#include <kinematics_msgs/GetPositionFK.h>#include <kdl_parser/kdl_parser.hpp>#include <kdl/jntarray.hpp>#include "chainfksolver.hpp"#include "treefksolver.hpp"#include <time.h>#include <sys/types.h>#include <sys/stat.h>#include <unistd.h>#include <vector>#include <list>#include <angles/angles.h>#include <string.h>#include "sbpl_exception.h"#include "config.h"#include "../utils/key.h"#include "../utils/mdpconfig.h"#include "../utils/mdp.h"#include "../utils/utils.h"#include "../planners/planner.h"#include "../discrete_space_information/environment.h"#include "../discrete_space_information/template/environment_XXX.h"#include "../discrete_space_information/nav2d/environment_nav2D.h"#include "../discrete_space_information/navxythetalat/environment_navxythetalat.h"#include "../discrete_space_information/navxythetalat/environment_navxythetamlevlat.h"#include "../discrete_space_information/robarm/environment_robarm.h"#include "../discrete_space_information/nav2d_uu/environment_nav2Duu.h"#include "../utils/list.h"#include "../utils/heap.h"#include "../planners/VI/viplanner.h"#include "../planners/ARAStar/araplanner.h"#include "../planners/ADStar/adplanner.h"#include "../utils/2Dgridsearch.h"#include "../planners/PPCP/ppcpplanner.h"#include "../planners/RStar/rstarplanner.h"#include "../planners/ANA/ANAplanner.h"#include <queue>#include <distance_field/voxel_grid.h>#include <LinearMath/btVector3.h>#include "btVector3.h"#include "btQuadWord.h"#include <LinearMath/btTransform.h>#include <ostream>#include "ros/serialization.h"#include "ros/builtin_message_traits.h"#include "ros/message_operations.h"#include "ros/message.h"#include "ros/time.h"#include "std_msgs/Header.h"#include "geometry_msgs/Point32.h"#include <resource_retriever/retriever.h>#include <sbpl/config.h>#include <kdl/chainfksolverpos_recursive.hpp>#include "framevel.hpp"#include "frameacc.hpp"#include "jntarrayvel.hpp"#include "jntarrayacc.hpp"#include "chainiksolver.hpp"#include "chainjnttojacsolver.hpp"#include <Eigen/Core>#include <kdl/treefksolverpos_recursive.hpp>#include <urdf/model.h>#include "Core"#include <kdl/chainiksolver.hpp>#include <Eigen/Array>#include "src/Core/util/DisableMSVCWarnings.h"#include "src/misc/Solve.h"#include "src/misc/Kernel.h"#include "src/misc/Image.h"#include "src/LU/FullPivLU.h"#include "src/LU/PartialPivLU.h"#include "src/LU/Determinant.h"#include "src/LU/Inverse.h"#include "src/Core/util/EnableMSVCWarnings.h"#include <kdl/tree.hpp>#include "geometry_msgs/Twist.h"#include "geometry_msgs/Pose.h"#include "ros/service_traits.h"#include "kinematics_msgs/PositionIKRequest.h"#include "motion_planning_msgs/AllowedContactSpecification.h"#include "motion_planning_msgs/OrderedCollisionOperations.h"#include "motion_planning_msgs/LinkPadding.h"#include "motion_planning_msgs/Constraints.h"#include "motion_planning_msgs/RobotState.h"#include "motion_planning_msgs/ArmNavigationErrorCodes.h"#include <pr2_arm_kinematics/pr2_arm_kinematics_utils.h>#include <kinematics_msgs/GetKinematicSolverInfo.h>#include <tf_conversions/tf_kdl.h>#include <distance_field/distance_field.h>#include <distance_field/propagation_distance_field.h>#include <geometric_shapes/shapes.h>#include <geometric_shapes/shape_operations.h>#include <mapping_msgs/CollisionObject.h>#include <iterator>#include <sbpl_arm_planner/sbpl_collision_space.h>#include <cstdlib>#include <sbpl_arm_planner/pr2/sbpl_math.h>#include <boost/thread.hpp>#include <mapping_msgs/CollisionMap.h>#include <mapping_msgs/AttachedCollisionObject.h>#include <motion_planning_msgs/GetMotionPlan.h>#include <trajectory_msgs/JointTrajectoryPoint.h>
Go to the source code of this file.
Functions | |
| int | main (int argc, char **argv) |
Variables | |
| clock_t | starttime |
| int main | ( | int | argc, | |
| char ** | argv | |||
| ) |
Definition at line 1128 of file sbpl_arm_planner_node.cpp.
| clock_t starttime |
Definition at line 35 of file sbpl_arm_planner_node.cpp.