MoveIt2-humble----Planning Around Objects

1 添加Planning Scene Interface头文件
#include <moveit/planning_scene_interface/planning_scene_interface.h>
2 改变目标位姿
// Set a target Pose
auto const target_pose = [] {
  geometry_msgs::msg::Pose msg;
  msg.orientation.w = 1.0;
  msg.position.x = 0.28;
  msg.position.y = 0.4;  // <---- This value was changed
  msg.position.z = 0.5;
  return msg;
}();
move_group_interface.setPoseTarget(target_pose);
3 创建一个碰撞物体

在下一个代码块中,我们创建了一个碰撞物体。

第一个需要注意的是,物体被放置在机器人坐标系下。如果我们有一个感知系统,能够报告场景中障碍物的位置,这就是该系统将要建立的一类信息。在本例子中我们手动来创建它。

另外要注意代码块的结尾处,我们设置该信息的操作为ADD,这样能够允许在后面的操作中将物体添加到碰撞场景。

把此代码块插入到【设置目标位姿】和【创建规划】之间。

// 创建用于避障的碰撞对象
auto const collision_object = [frame_id =
                                 move_group_interface.getPlannin
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值