【scene_manager】与 MoveIt 机器人的规划场景进行交互

scene_manager

Scene Manager包是由 Robotnik 创建的 ROS 包，旨在帮助构建和与 MoveIt 机器人的规划场景进行交互。

将 scene_manager 和 scene_manager_msgs 包添加到 catkin 工作空间。
在将使用 Scene Manager 的 ROS 包中，在 CMakeLists.txt 和 package.xml 文件中添加对上述包的依赖。
将 Scene Manager 库添加到您正在开发的 CPP 节点中：
cpp 复制代码
```
#include <corosect_manipulation/scene_manager.h>
```

创建 SceneManager 类的对象：

cpp 复制代码

ros::NodeHandle nh;
// 初始化 Scene Manager
bool wait = true;
std::unique_ptr<SceneManager> scene_manager_ = std::make_unique<SceneManager>(nh, wait);

允许用户轻松将碰撞对象添加到规划场景中，每个对象需要添加以下属性：

spawn: 默认情况下，对象在 Scene Manager 初始化场景时被添加到规划场景中。
static: 静态对象无法被操作，也无法改变其在空间中的位置。
frame_id: 对象在场景中的位置相对于此坐标轴定义。
geometry: 几何形状（盒子）或网格文件的路径（package://ros_package_name/route_to_file_folder/mesh_file_name.stl）。
pose: 相对于 frame_id 坐标轴的 xyz 位移或 rpy 方向。
layout: 可用于添加当前对象的矩阵（例如：带有箱子的托盘）。

Scene Manager 类提供以下方法：

SceneManager::initScene(): 将 YAML 文件中定义的对象添加到规划场景中。
SceneManager::addObjects(vector object_ids): 将特定对象添加到规划场景中。
SceneManager::removeObjects(vector object_ids): 从规划场景中移除特定对象。
SceneManager::attachObjects(vector object_ids): 将碰撞对象附加到末端执行器。
SceneManager::detachObjects(vector object_ids): 从末端执行器分离碰撞对象。
SceneManager::moveRelativeTo(string object_id, rel_pose) : 以相对于给定对象的 frame_id 的相对姿态移动末端执行器。
SceneManager::allowCollision(string link_id, vector objects_id): 允许机器人链接或碰撞对象与其他碰撞对象之间发生碰撞。
SceneManager::restoreCollision(string link_id, vector objects_id): 恢复机器人链接或碰撞对象与其他碰撞对象之间的碰撞避免。

Scene Manager 提供 ROS 服务以调用所有 Scene Manager 功能，外部用户可以轻松与机械臂和场景进行交互。