一种多农业机器人的转弯协调控制方法及装置与流程

文档序号:12662280阅读:来源:国知局

技术特征:

1.一种多农业机器人的转弯协调控制方法,其特征在于,包括:

步骤S1,接收多个农业机器人各自对应的数据信息,所述数据信息至少包括多个所述农业机器人各自对应的编号、位置、速度和方向;

步骤S2,根据多个所述农业机器人各自对应的编号、位置和方向,为每个所述农业机器人分配一个优先权限;

其中,每个所述农业机器人运用U-turn转弯理论进行地头转弯,并预先设定所述农业机器人运用U-turn转弯理论进行地头转弯过程中各阶段的转弯标志;

步骤S3,根据每两个所述农业机器人各自对应的所述数据信息、所述优先权限和转弯过程中的转弯标志,协调每两个所述农业机器人进行地头转弯,从而控制所述多个农业机器人进行地头转弯。

2.根据权利要求1所述多农业机器人的转弯协调控制方法,其特征在于,所述优先权限的分配遵循以下准则:

准则1,在多个所述农业机器人行进方向上,前方农业机器人的优先权限高于后方农业机器人的优先权限;

准则2,基于准则1,在多个所述农业机器人的转弯方向上,内侧农业机器人的优先权限高于外侧农业机器人的优先权限。

3.根据权利要求1所述多农业机器人的转弯协调控制方法,其特征在于,所述步骤S2预先设定所述农业机器人运用U-turn转弯理论进行地头转弯过程中各阶段的转弯标志包括:

对于任意一个所述农业机器人,运用U-turn转弯理论进行地头转弯,所述U-turn转弯理论分为9个阶段,并且用RTi.T_F来记录各阶段转弯标志,步骤包括:

步骤S21,当农业机器人沿当前路径直线作业时,记为RTi.T_F=0;

步骤S22,当所述农业机器人直线作业结束后,升起作业机,并从地头起始处沿当前路径直线行驶,记为RTi.T_F=1;当农业机器人以最大转角转弯90°时,记为RTi.T_F=2;

步骤S23,计算当前路径与下一条路径间的距离,记为w,计算所述农业机器人的转弯半径r,如果w-2r<0,则所述农业机器人后退|w-2r|,记为RTi.T_F=3;如果w-2r>0,则所述农业机器人向前行驶|w-2r|,记为RTi.T_F=4;

步骤S24,当所述农业机器人以最大转角转向下一条路径时,记为RTi.T_F=5,当所述农业机器人沿此路径直线行驶时,记为RTi.T_F=6;

步骤S25,当所述农业机器人后退至转弯完成处时,记为RTi.T_F=7;

步骤S26,当所述农业机器人行驶至地头起始处时,记为RTi.T_F=8,当所述农业机器人在地头起始处结束地头转弯时,记为RTi.T_F=9。

4.根据权利要求1所述多农业机器人的转弯协调控制方法,其特征在于,所述步骤S3包括:

对于任意两台编号为RTj和RTi的农业机器人,其中所述RTj的优先权限比所述RTi的优先权限高;

若此时所述RTj正在转弯,所述RTi正在直线作业,且RTj.T_F∈【0,1,2,4】,则所述RTi继续直线作业并在地头停下等待。

5.根据权利要求1所述多农业机器人的转弯协调控制方法,其特征在于,所述步骤S3包括:

对于任意两台编号为RTj和RTi的农业机器人,其中所述RTj的优先权限比所述RTi的优先权限高;

若此时所述RTj正在转弯,所述RTi正在转弯,如果RTj和RTi之间的距离小于预设距离,则RTi停车等待;如果RTj和RTi之间距离小于预设距离并且RTi已经停车,且RTj.T_F=7,那么RTj停止当前后退动作并且向前行驶,此时RTi.T_F=8。

6.根据权利要求1所述多农业机器人的转弯协调控制方法,其特征在于,所述步骤S3包括:

对于任意两台编号为RTj和RTi的农业机器人,其中所述RTj的优先权限比所述RTi的优先权限高;

若此时所述RTj正在直线作业,所述RTi正在转弯,那么说明所述RTj已经完成转弯而所述RTi正在转弯,那么所述RTj会在结束转弯处停车等待。

7.根据权利要求1所述多农业机器人的转弯协调控制方法,其特征在于,所述步骤S3包括:

对于任意两台编号为RTj和RTi的农业机器人,其中所述RTj的优先权限比所述RTi的优先权限高;

若此时所述RTj正在直线作业,所述RTi正在直线作业,但是他们处于相反的方向,那么说明RTj已经完成转弯而RTi尚未开始转弯。RTj会在结束转弯处停车等待。

8.根据权利要求1所述多农业机器人的转弯协调控制方法,其特征在于,所述步骤S3包括:

对于任意两台编号为RTj和RTi的农业机器人,其中所述RTj的优先权限比所述RTi的优先权限高;

若此时所述RTj正在直线作业,所述RTi正在直线作业,并且它们作业方向相同,那么说明RTj和RTi的转弯协调结束,RTj和RTi放下作业机进行直线作业。

9.一种多农业机器人的转弯协调控制装置,其特征在于,包括:

接收模块,用于接收多个农业机器人各自对应的数据信息,所述数据信息至少包括所述多个农业机器人各自对应的编号、位置、速度和方向;

转弯控制模块,用于根据多个所述农业机器人各自对应的编号、位置和方向,为每个所述农业机器人分配一个优先权限;

其中,每个所述农业机器人运用U-turn转弯理论进行地头转弯,并预先设定所述农业机器人运用U-turn转弯理论进行地头转弯过程中各阶段的转弯标志;

协调控制模块,用于根据每两个所述农业机器人各自对应的所述数据信息、所述优先权限和转弯过程中的转弯标志,协调每两个所述农业机器人进行地头转弯,从而控制所述多个农业机器人进行地头转弯。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1