moveit2
The MoveIt Motion Planning Framework for ROS 2.
Namespaces | Functions
robot_trajectory.cpp File Reference
#include <math.h>
#include <moveit/robot_trajectory/robot_trajectory.h>
#include <moveit/robot_state/conversions.h>
#include <rclcpp/duration.hpp>
#include <rclcpp/logger.hpp>
#include <rclcpp/logging.hpp>
#include <rclcpp/time.hpp>
#include <tf2_eigen/tf2_eigen.hpp>
#include <numeric>
#include <optional>
#include <moveit/utils/logger.hpp>
Include dependency graph for robot_trajectory.cpp:

Go to the source code of this file.

Namespaces

 robot_trajectory
 

Functions

std::ostream & robot_trajectory::operator<< (std::ostream &out, const RobotTrajectory &trajectory)
 Operator overload for printing trajectory to a stream. More...
 
double robot_trajectory::pathLength (const RobotTrajectory &trajectory)
 Calculate the path length of a given trajectory based on the accumulated robot state distances. The distance between two robot states is calculated based on the sum of active joint distances between the two states (L1 norm). More...
 
std::optional< double > robot_trajectory::smoothness (const RobotTrajectory &trajectory)
 Calculate the smoothness of a given trajectory. More...
 
std::optional< double > robot_trajectory::waypointDensity (const RobotTrajectory &trajectory)
 Calculate the waypoint density of a trajectory. More...