基于绳驱并联机器人的避障方法、系统、设备及存储介质

文档序号:26055405发布日期:2021-07-27 15:33阅读:来源:国知局

技术特征:

1.一种基于绳驱并联机器人的避障方法,其特征在于,包括:

获取若干动锚点初始位置信息、若干绳索初始长度和末端动平台期望位置信息;

将所述若干动锚点初始位置信息和所述若干绳索初始长度代入正运动学算法以得到末端动平台初始位置信息;

根据所述末端动平台初始位置信息和所述若干动锚点初始位置信息确定若干绳索初始方向矢量;

根据所述若干绳索初始方向矢量、所述若干动锚点初始位置信息、所述末端动平台期望位置信息、预设导轨关系式确定若干动锚点移动位置信息;

获取障碍物位置信息和包络半径信息,并根据所述障碍物位置信息、所述包络半径信息、所述动锚点移动位置信息和所述末端动平台期望位置信息确定旋转角度。

2.根据权利要求1所述的基于绳驱并联机器人的避障方法,其特征在于,所述将所述若干动锚点初始位置信息和所述若干绳索初始长度代入正运动学算法以得到末端动平台初始位置信息,包括:

根据所述若干动锚点初始位置信息和所述若干绳索初始长度确定若干圆方程式;

根据所述若干圆方程式确定任意两个所述圆方程式的交点以得到若干圆交点;

获取任意两个圆交点的距离之和最小的所述圆交点的位置信息以得到所述末端动平台初始位置信息。

3.根据权利要求2所述的基于绳驱并联机器人的避障方法,其特征在于,所述获取任意两个圆交点的距离之和最小的所述圆交点的位置信息以得到所述末端动平台初始位置信息,包括:

获取任意两个圆交点的距离之和最小的所述圆交点的若干交点坐标信息;

计算所述若干交点坐标信息的平均值以得到所述末端动平台初始位置信息。

4.根据权利要求1至3任一项所述的基于绳驱并联机器人的避障方法,其特征在于,所述根据所述若干绳索初始方向矢量、所述若干动锚点初始位置信息、所述末端动平台期望位置信息、预设导轨关系式确定若干动锚点移动位置信息,包括:

根据所述若干动锚点初始位置信息、所述若干绳索初始方向矢量、所述末端动平台期望位置信息确定若干动锚点关系式;

根据所述若干动锚点关系式和所述预设导轨关系式确定所述若干动锚点移动位置信息。

5.根据权利要求1至3任一项所述的基于绳驱并联机器人的避障方法,其特征在于,所述获取障碍物位置信息和包络半径信息,并根据所述障碍物位置信息、所述包络半径信息、所述动锚点移动位置信息和所述末端动平台期望位置信息确定旋转角度,包括:

获取所述障碍物位置信息和所述包络半径信息;

根据所述障碍物位置信息和所述末端动平台期望位置信息确定障碍物矢量;

根据所述障碍物矢量和所述包络半径信息确定安全角度;

根据所述动锚点移动位置信息和所述末端动平台期望位置信息确定若干绳索的移动角度;

根据所述安全角度和所述移动角度确定所述旋转角度。

6.根据权利要求5所述的基于绳驱并联机器人的避障方法,其特征在于,所述根据所述安全角度和所述移动角度确定所述旋转角度,包括:

若所述移动角度小于所述安全角度,根据所述安全角度和所有绳索的所述移动角度的差值确定所述旋转角度;

若所述移动角度大于所述安全角度,所述旋转角度为0°。

7.一种基于绳驱并联机器人的避障系统,其特征在于,包括:

获取模块,用于获取若干动锚点初始位置信息、若干绳索初始长度和末端动平台期望位置信息;

初始位置计算模块,用于根将所述若干动锚点初始位置信息和所述若干绳索初始长度代入正运动学算法以得到末端动平台初始位置信息;

矢量计算模块,用于根据所述末端动平台初始位置信息和所述若干动锚点初始位置信息确定若干绳索初始方向矢量;

移动位置计算模块,用于根据所述若干绳索初始方向矢量、所述若干动锚点初始位置信息、所述末端动平台期望位置信息、预设导轨关系式确定若干动锚点移动位置信息;

旋转角度计算模块,用于获取障碍物位置信息和包络半径信息,并根据所述障碍物位置信息、所述包络半径信息、所述动锚点移动位置信息和所述末端动平台期望位置信息确定旋转角度。

8.根据权利要求7所述的基于绳驱并联机器人的避障系统,其特征在于,所述初始位置计算模块包括:

圆方程式计算单元,用于根据所述若干动锚点位置信息和所述若干绳索初始长度确定若干圆方程式;

交点获取单元,用于根据所述若干圆方程式确定任意两个所述圆方程式的交点以得到若干圆交点;

位置信息获取单元,用于获取任意两个圆交点的距离之和最小的所述圆交点的位置信息以得到所述末端动平台初始位置信息。

9.一种电子控制设备,其特征在于,包括:

至少一个处理器,以及,

与所述至少一个处理器通信连接的存储器;其中,

所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行如权利要求1至6任一项所述的基于绳驱并联机器人的避障方法。

10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机可执行指令,所述计算机可执行指令用于使计算机执行如权利要求1至6任一项所述的基于绳驱并联机器人的避障方法。


技术总结
本发明公开了一种基于绳驱并联机器人的避障方法、系统、设备及存储介质,基于绳驱并联机器人的避障方法包括:获取若干动锚点初始位置信息、若干绳索初始长度和末端动平台期望位置信息;将若干动锚点初始位置信息和若干绳索初始长度代入正运动学算法以得到末端动平台初始位置信息;根据末端动平台初始位置信息和若干动锚点初始位置信息确定若干绳索初始方向矢量;根据若干绳索初始方向矢量、若干动锚点初始位置信息、末端动平台期望位置信息、预设导轨关系式确定若干动锚点移动位置信息;获取障碍物位置信息和包络半径信息并与动锚点移动位置信息和末端动平台期望位置信息确定旋转角度。本发明通过旋转角度绕开障碍物以提高工作效率。

技术研发人员:袁晗;于大江;徐文福
受保护的技术使用者:哈尔滨工业大学(深圳)
技术研发日:2021.04.28
技术公布日:2021.07.27
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1