moveit_task_constructor/core/test/models.cpp
2024-12-22 12:13:33 +01:00

20 lines
783 B
C++

#include "models.h"
#include <moveit/utils/robot_model_test_utils.hpp>
#include <moveit/robot_model_loader/robot_model_loader.hpp>
using namespace moveit::core;
RobotModelPtr getModel() {
// suppress RobotModel errors and warnings
if (rcutils_logging_set_logger_level("moveit_robot_model.robot_model", RCUTILS_LOG_SEVERITY_FATAL) != RCUTILS_RET_OK)
throw std::runtime_error("Failed to set logger level to RCUTILS_LOG_SEVERITY_ERROR");
// create dummy robot model
moveit::core::RobotModelBuilder builder("robot", "base");
builder.addChain("base->link1->link2->tip", "continuous");
builder.addGroupChain("base", "link2", "group");
builder.addGroupChain("link2", "tip", "eef_group");
builder.addEndEffector("eef", "link2", "group", "eef_group");
return builder.build();
}