KDL轨迹规划总结:(1)

这篇博客详细介绍了如何在orocos_kdl库的trajectory_example.cpp中插入中间路径点。首先通过Add函数判断起点、中间点和指定点,然后利用简化后的欧几里得距离计算路径间距离。接下来,评估角度以决定是否需要使用圆弧过渡。最后,根据条件选择直线或圆弧过渡,并将中间点加入Path_Line结构体。此内容深入解析了ROS中机器人运动规划的路径插值算法。
摘要由CSDN通过智能技术生成

1.在orocos_kinematics_dynamics-master\orocos_kdl\examples\trajectory_example.cpp插入中间路径点总结:

首先调用了Add,内部的流程是首先调用判断是否是(1)起始点(2)中间点(3)指定点(传入的参数)

 

开始算距离,这里调用Norm简化了欧几里得距离,其实就是根据向量中的最大值进行了化简

 接着进行两条线之间的的角度判断,判断是否需要圆弧的过度

 接着就是进入直线或者圆弧过度的选择,将中间点放入结构体Path_Line中

 

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值