unittest_trajectory_generator_lin.cpp File Reference

#include <memory>
#include <gtest/gtest.h>
#include <pilz_industrial_motion_planner/joint_limits_aggregator.h>
#include <pilz_industrial_motion_planner/trajectory_generator_lin.h>
#include <pilz_industrial_motion_planner_testutils/command_types_typedef.h>
#include <pilz_industrial_motion_planner_testutils/xml_testdata_loader.h>
#include "test_utils.h"
#include <moveit/kinematic_constraints/utils.h>
#include <moveit/robot_model/robot_model.h>
#include <moveit/robot_model_loader/robot_model_loader.h>
#include <moveit/robot_state/conversions.h>
#include <moveit/robot_state/robot_state.h>
#include <rclcpp/rclcpp.hpp>

Include dependency graph for unittest_trajectory_generator_lin.cpp:

Go to the source code of this file.

Classes
class	TrajectoryGeneratorLINTest
	Parameterized unittest of trajectory generator LIN to enable tests against different robot models.The parameter is the name of robot model parameter on the ros parameter server. More...

Functions
const std::string	TEST_DATA_FILE_NAME ("testdata_file_name")
const std::string	PARAM_PLANNING_GROUP_NAME ("planning_group")
const std::string	TARGET_LINK_HCD ("target_link_hand_computed_data")
const std::string	RANDOM_TEST_TRIAL_NUM ("random_trial_number")
const std::string	JOINT_POSITION_TOLERANCE ("joint_position_tolerance")
const std::string	JOINT_VELOCITY_TOLERANCE ("joint_velocity_tolerance")
const std::string	POSE_TRANSFORM_MATRIX_NORM_TOLERANCE ("pose_norm_tolerance")
const std::string	ROTATION_AXIS_NORM_TOLERANCE ("rot_axis_norm_tolerance")
const std::string	VELOCITY_SCALING_FACTOR ("velocity_scaling_factor")
const std::string	OTHER_TOLERANCE ("other_tolerance")
	TEST_F (TrajectoryGeneratorLINTest, TestExceptionErrorCodeMapping)
	Checks that each derived MoveItErrorCodeException contains the correct error code.
	TEST_F (TrajectoryGeneratorLINTest, nonZeroStartVelocity)
	test the lin planner with invalid motion plan request which has non zero start velocity
	TEST_F (TrajectoryGeneratorLINTest, jointSpaceGoal)
	test the lin planner with joint space goal
	TEST_F (TrajectoryGeneratorLINTest, jointSpaceGoalNearZeroStartVelocity)
	test the lin planner with joint space goal with start velocity almost zero
	TEST_F (TrajectoryGeneratorLINTest, cartesianSpaceGoal)
	test the lin planner with Cartesian goal
	TEST_F (TrajectoryGeneratorLINTest, cartesianTrapezoidProfile)
	test the trapezoid shape of the planning trajectory in Cartesian space
	TEST_F (TrajectoryGeneratorLINTest, LinPlannerLimitViolation)
	Check that lin planner returns 'false' if calculated lin trajectory violates velocity/acceleration or deceleration limits.
	TEST_F (TrajectoryGeneratorLINTest, LinPlannerDiscontinuousJointTraj)
	test joint linear movement with discontinuities in joint space
	TEST_F (TrajectoryGeneratorLINTest, LinStartEqualsGoal)
	test joint linear movement with equal goal and start
	TEST_F (TrajectoryGeneratorLINTest, IncorrectJointNumber)
	Checks that generate() function returns 'false' if called with an incorrect number of joints.
	TEST_F (TrajectoryGeneratorLINTest, cartGoalFrameIdBothConstraints)
	Set a frame id in goal constraint with cartesian goal on both position and orientation constraints.
int	main (int argc, char **argv)

Function Documentation

JOINT_POSITION_TOLERANCE()

const std::string JOINT_POSITION_TOLERANCE

(

"joint_position_tolerance"

)

Here is the caller graph for this function:

JOINT_VELOCITY_TOLERANCE()

const std::string JOINT_VELOCITY_TOLERANCE

(

"joint_velocity_tolerance"

)

Here is the caller graph for this function:

main()

int main	(	int	argc,
		char **	argv
	)

Definition at line 434 of file unittest_trajectory_generator_lin.cpp.

OTHER_TOLERANCE()

const std::string OTHER_TOLERANCE

(

"other_tolerance"

)

Here is the caller graph for this function:

PARAM_PLANNING_GROUP_NAME()

const std::string PARAM_PLANNING_GROUP_NAME

(

"planning_group"

)

Here is the caller graph for this function:

POSE_TRANSFORM_MATRIX_NORM_TOLERANCE()

const std::string POSE_TRANSFORM_MATRIX_NORM_TOLERANCE

(

"pose_norm_tolerance"

)

Here is the caller graph for this function:

RANDOM_TEST_TRIAL_NUM()

const std::string RANDOM_TEST_TRIAL_NUM

(

"random_trial_number"

)

Here is the caller graph for this function:

ROTATION_AXIS_NORM_TOLERANCE()

const std::string ROTATION_AXIS_NORM_TOLERANCE

(

"rot_axis_norm_tolerance"

)

Here is the caller graph for this function:

TARGET_LINK_HCD()

const std::string TARGET_LINK_HCD

(

"target_link_hand_computed_data"

)

Here is the caller graph for this function:

TEST_DATA_FILE_NAME()

const std::string TEST_DATA_FILE_NAME

(

"testdata_file_name"

)

Here is the caller graph for this function:

TEST_F() [1/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		cartesianSpaceGoal
	)

test the lin planner with Cartesian goal

Definition at line 264 of file unittest_trajectory_generator_lin.cpp.

TEST_F() [2/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		cartesianTrapezoidProfile
	)

test the trapezoid shape of the planning trajectory in Cartesian space

The test checks translational path for a trapezoid velocity profile. Due to the way the acceleration is calculated 1 or 2 intermediate points occur that are neither acceleration, constant or deceleration.

+++++++++++++++++++++++

• plan LIN trajectory + +++++++++++++++++++++++

Definition at line 286 of file unittest_trajectory_generator_lin.cpp.

Here is the call graph for this function:

TEST_F() [3/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		cartGoalFrameIdBothConstraints
	)

Set a frame id in goal constraint with cartesian goal on both position and orientation constraints.

Definition at line 417 of file unittest_trajectory_generator_lin.cpp.

TEST_F() [4/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		IncorrectJointNumber
	)

Checks that generate() function returns 'false' if called with an incorrect number of joints.

Test Sequence:

1. Call functions with incorrect number of joints.

Expected Results:

1. Function returns 'false'.

Definition at line 399 of file unittest_trajectory_generator_lin.cpp.

TEST_F() [5/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		jointSpaceGoal
	)

test the lin planner with joint space goal

Definition at line 227 of file unittest_trajectory_generator_lin.cpp.

TEST_F() [6/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		jointSpaceGoalNearZeroStartVelocity
	)

test the lin planner with joint space goal with start velocity almost zero

Definition at line 244 of file unittest_trajectory_generator_lin.cpp.

TEST_F() [7/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		LinPlannerDiscontinuousJointTraj
	)

test joint linear movement with discontinuities in joint space

This will violate joint velocity/acceleration limits.

Test Sequence:

1. Generate lin trajectory which is discontinuous in joint space.

Expected Results:

1. Function returns 'false'.

Definition at line 342 of file unittest_trajectory_generator_lin.cpp.

Here is the call graph for this function:

TEST_F() [8/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		LinPlannerLimitViolation
	)

Check that lin planner returns 'false' if calculated lin trajectory violates velocity/acceleration or deceleration limits.

Test Sequence:

1. Call function with lin request violating velocity/acceleration or deceleration limits.

Expected Results:

1. Function returns 'false'.

Definition at line 321 of file unittest_trajectory_generator_lin.cpp.

Here is the call graph for this function:

TEST_F() [9/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		LinStartEqualsGoal
	)

test joint linear movement with equal goal and start

Test Sequence:

1. Call function with lin request start = goal

Expected Results:

1. trajectory generation is successful.

Definition at line 367 of file unittest_trajectory_generator_lin.cpp.

Here is the call graph for this function:

TEST_F() [10/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		nonZeroStartVelocity
	)

test the lin planner with invalid motion plan request which has non zero start velocity

Definition at line 211 of file unittest_trajectory_generator_lin.cpp.

TEST_F() [11/11]

TEST_F	(	TrajectoryGeneratorLINTest	,
		TestExceptionErrorCodeMapping
	)

Checks that each derived MoveItErrorCodeException contains the correct error code.

Definition at line 189 of file unittest_trajectory_generator_lin.cpp.

VELOCITY_SCALING_FACTOR()

const std::string VELOCITY_SCALING_FACTOR

(

"velocity_scaling_factor"

)

Here is the caller graph for this function: