顶升机器人的料架姿态协同控制方法及系统、存储介质与流程

摘要: 本发明涉及智能物流与移动机器人控制,尤其涉及一种顶升机器人的料架姿态协同控制方法、系统及计算机可读存储介质。背景技术:1、在智能仓储与物流自动化领域,顶升式自主...
顶升机器人的料架姿态协同控制方法及系统、存储介质与流程

本发明涉及智能物流与移动机器人控制,尤其涉及一种顶升机器人的料架姿态协同控制方法、系统及计算机可读存储介质。

背景技术:

1、在智能仓储与物流自动化领域,顶升式自主移动机器人(amr/agv)已广泛应用于料架搬运、工位对接及出入库作业。现有自动化仓储系统普遍采用分层控制架构:上层仓储控制系统(wcs)与多机器人调度系统负责生成搬运任务与动作序列,机器人本体控制器负责执行行走、转向、顶升及旋转等底层动作。在该架构下,机器人车体姿态、顶升盘姿态与料架姿态共同决定通道通行安全性、工位对接精度与系统作业效率,尤其在窄通道通行、曲线路径行驶、终点定向放货等场景下,对料架姿态的协同控制能力提出了更高要求。

2、针对料架姿态控制,现有技术已从多个维度开展改进:如部分方案聚焦旋转顶升机构的机械结构优化,提升本体执行精度;部分方案针对取放货前后的姿态偏差设计校正逻辑,改善对位精度;还有部分方案从搬运流程编排与系统集成角度完善整体作业逻辑。上述技术在单一机器人、简单路径场景下可满足基本使用需求,但在多机器人规模化调度、复杂仓储布局的实际应用中,仍存在诸多局限。

3、在朝向决策层面,现有技术普遍将料架朝向调整交由机器人本体自主完成,调度系统仅承担路径规划职能,不介入朝向决策。当路径段保持朝向、终点定向放货、通道窄边通行等多类业务约束并存时,缺乏统一的角度换算规则与优先级决策机制,不仅需要人工逐点配置换向点,实施工作量大、配置成本高,还易出现规则冲突、动作不连续的问题,难以保障多机器人并发场景下姿态行为的一致性。

4、在路径适配层面,机器人沿曲线或斜线路径行驶时,车体方向随路径切线持续变化,若顶升盘未进行主动补偿,料架相对世界坐标系的角度会随车体偏转,在狭窄曲线通道中极易引发碰撞。同时,现有方案仅规定了姿态保持的触发条件,未明确禁止保持的边界条件,易触发机器人不受调度管控的自主保持行为,造成姿态控制失序,限制了系统对复杂仓储布局的适配能力。

5、因此,对于本领域技术人员来说,如何解决多约束场景下料架朝向的统一决策问题,以及复杂路径下料架姿态保持的闭环管控问题,是形成本领域技术突破的关键。

技术实现思路

1、为此,本发明的主要目的在于提供一种顶升机器人的料架姿态协同控制方法及系统、存储介质,以解决现有技术中,顶升机器人载货行走过程中,料架朝向缺乏统一决策与受控管理,导致多种朝向需求并存时易产生规则冲突、行走过程中料架相对世界坐标系的角度易发生非预期变化的技术问题。

2、为了实现上述目的,根据本发明的第一个方面,提供了一种顶升机器人的料架姿态协同控制方法,所述方法步骤包括:

3、在路径规划阶段进行料架朝向决策,按照优先级从高到低依次为路径级保持角度约束、终点朝向沿路径反向回推约束、默认窄边朝前约束的顺序确定目标料架朝向,且高优先级规则命中后不再执行低优先级规则;

4、根据路径的切线增量推算路径终点的料架世界坐标角;若所述路径终点的料架世界坐标角与路径起点的料架世界坐标角一致,则在下发的导航指令中附带料架世界坐标角参数,以驱动顶升机器人的顶升盘在行走过程中补偿车体旋转量,使料架相对世界坐标系的角度保持恒定;若不一致,则在下发的导航指令中附带屏蔽值,以禁止所述顶升机器人自主保持料架角度。

5、在一种可能的实现方式中,所述终点朝向沿路径反向回推约束包括:当搬运终点配置有料架放货角度时,自所述搬运终点起沿规划路径逐段反向推算,将每段路径对应的料架角度减去该段路径的切线增量,得到该段路径起点处料架应满足的朝向,以在换向点提前完成料架朝向调整。

6、在一种可能的实现方式中,所述默认窄边朝前约束包括:根据所述路径起点的切线方向与预设的窄边方向偏移,确定两个相差180°的候选角度,以使所述料架的窄边与所述路径的行进方向一致。

7、在一种可能的实现方式中,所述确定目标料架朝向的步骤包括:构建候选角度集合,所述候选角度集合包含基准角度;对于两端功能等价的料架,所述候选角度集合还包括所述基准角度的对顶角;选取与料架当前角度之间旋转量最小的候选角度作为所述目标朝向。

8、在一种可能的实现方式中,所述路径的切线增量为该路径起点的切线方向与终点的切线方向之间的角度差;当所述路径未配置所述路径级保持角度约束时,料架随车体同步旋转,所述路径终点的料架世界坐标角为路径起点的料架世界坐标角与所述切线增量之和。

9、在一种可能的实现方式中,所述方法还包括:在所述顶升机器人的空载移动任务的首条移动指令下发前,获取顶升盘当前角度;分别计算顶升盘当前角度与两个对齐角度之间的角度差,所述两个对齐角度相差180°且均对应顶升盘与车体对齐的姿态;选取角度差较小者对应的对齐角度作为对齐目标,生成并下发顶升盘对齐指令。

10、在一种可能的实现方式中,所述方法还包括:根据所述目标料架朝向,生成携带目标角度且不携带旋转方向参数的料架旋转指令,并下发至所述顶升机器人;所述顶升机器人执行所述料架旋转指令时,读取顶升盘的实时角度,分别计算顺时针、逆时针方向的旋转量,选取旋转量更小的劣弧方向执行旋转。

11、在一种可能的实现方式中,所述方法还包括:批量规划指令序列时,以料架初始角度为基准,对指令序列中各指令依次推算更新料架推算角度;其中,对于料架随车体同步旋转的移动指令,将对应路径段的切线增量累加至所述料架推算角度;对于旋转指令,将对应的旋转量累加至所述料架推算角度;所述料架旋转指令的旋转量,根据所述料架推算角度与所述目标料架朝向确定。

12、第二方面,本发明还提供了一种顶升机器人料架姿态协同控制系统,用于执行如第一方面及其各实现方式所述的方法,所述系统包括:

13、调度服务器和至少一台顶升机器人,所述顶升机器人具有可独立旋转并带动料架同步旋转的顶升盘;所述调度服务器包括:

14、朝向决策模块,用于在路径规划阶段进行料架朝向决策,按照优先级从高到低依次为路径级保持角度约束、终点朝向沿路径反向回推约束、默认窄边朝前约束的顺序确定目标料架朝向,高优先级规则命中后不再执行低优先级规则;

15、指令生成模块,用于根据路径的切线增量推算路径终点的料架世界坐标角,并在所述路径终点的料架世界坐标角与路径起点的料架世界坐标角一致时,在下发的导航指令中附带料架世界坐标角参数,在不一致时附带屏蔽值;还用于生成料架旋转指令并下发;

16、所述顶升机器人包括本体控制器,用于根据所述料架世界坐标角参数驱动顶升盘补偿车体旋转量,使料架相对世界坐标系的角度保持恒定,并根据所述屏蔽值禁止自主保持料架角度;还用于接收料架旋转指令,读取顶升盘实时角度,选取旋转量更小的方向执行旋转。

17、第三方面,本发明还提供了一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现如第一方面及其各实现方式所述的料架姿态协同控制方法。

18、通过本发明提供的该顶升机器人的料架姿态协同控制方法及系统、存储介质,其将料架朝向的决策集中于路径规划阶段统一完成,通过“路径级保持角度、终点朝向反向回推、默认窄边朝前”的优先级决策机制,使多种朝向需求并存时目标料架朝向的确定有章可循、互不冲突,同时通过“起终点料架角度一致则附带保持参数、不一致则附带屏蔽值”的成对机制,将行走过程中料架角度的保持行为纳入闭环管理,不仅明确何时应当保持,也明确何时禁止自主保持,使料架姿态始终处于规划的受控范围内。

19、基于上述设计,本方案能够在路径规划阶段对料架朝向进行统一决策,无需人工逐点配置换向点即可自动适配路径保持、终点定向放货、默认窄边朝前等多种业务场景,降低了配置成本与漏配风险,避免了多约束并存时的规则冲突与动作不连续,实现了载货行走全程料架朝向的自动管控。此外对于料架世界坐标角应保持不变的路径,通过在导航指令中附带料架世界坐标角参数,驱动顶升盘在行走过程中补偿车体旋转量,可使料架在曲线或斜线路径上相对世界坐标系的角度保持恒定,避免了料架随车体被动旋转引发的碰撞,扩展了系统对复杂地图布局的适用场景;对于料架角度沿路径发生变化的路径,通过附带屏蔽值禁止机器人自主保持料架角度,使本体的自主保持行为与规划结果不再相互冲突,保证了多机器人场景下料架朝向行为的一致性与可预期性。