1.基于线性时序逻辑理论的仓储机器人路径规划方法,包括以下步骤:
步骤1:将机器人的运动的仓储环境建模成一个可扩展加权切换系统模型,加权切换系统模型是一种图表,它以环境中的关键位置为节点,如果机器人能从一个位置行驶至另一个位置,则这两个节点间有边相连,每条边都标有相应的权值,表示机器人从一个节点行驶至另一个节点,当有派单任务节点时,将其扩展到模型当中,而不需重新构建环境模型,在此用元组E=(Q,q0,R,∏,ζ,ω)来表示可扩展加权切换系统,其中,Q为一个有限状态集,其每一个状态表示仓储环境中的一个节点;q0∈Q是初始状态,即机器人在仓储环境中所处的初始位置; 代表切换关系,即仓储环境中节点间的连通状态;∏为一个原子命题集合;ζ:Q→2∏是状态的命题函数;ω代表切换权重且ω>0,表示机器人在仓储环境中从一个节点切换到另一节点所需的成本;
步骤2:利用线性时序逻辑公式φ描述仓储机器人需要完成的复杂任务,LTL是一种接近自然语言的高级语言,将时序逻辑算子始终G、最终F、接下来X、直到U和布尔算子非 与∧、或∨组合起来可以便捷地描述仓储机器人在仓库环境中从起点出发到若干个货架取货后回到指定点,并在途中规避特定区域复杂任务,而非仅仅一个货架取货任务,φ=Fp1∧Fp3∧Fp4∧Fp5∧Fp6∧Fp7∧GFp2,其中,p1、p2、p3、p4、p5、p6和p7代表环境中的节点,则φ表示机器人从p1节点出发,到p3、p4、p5、p6和p7五个节点取货,最终回到p2节点将取回的货物打包出仓; 表示机器人从p1节点出发,到p3、p4和p5三个节点取货,但要避开p6和p7节点最终回到p2节点将取回的货物打包出仓;
步骤3:利用步骤2得到的满足机器人任务的线性时序逻辑公式φ,采用LTL2BA工具将仓储移动机器人任务公式φ转换成相应的Büchi自动机可行性图表,在此用元组B=(S,s0,∑B,δB,F)表示Büchi自动机,其中S是有限状态集合, 是初始状态集合,∑B是输入字母表,δB是转换函数, F是最终状态集合,步骤4:将可扩展加权切换系统E和Büchi自动机B作笛卡尔乘积得到任务可行网络拓扑,在此用元组T=(ST,ST0,δT,FT)表示任务可行网络拓扑,即T=E×B其中,E=(Q,q0,R,∏,ζ,ω),B=(S,s0,∑B,δB,F),ST=Q×S为有限状态集合,ST0=q0×s0是初始状态集合,为转换函数,FT=Q×F为最终状态集合;当切换系统E中的状态集Q=(q0,q1,q2,q3),其中q0,q1,q2和q3是仓储环境节点,Büchi自动机B中有限状态集合S=(s0,s1,s2),其中s0,s1和s2是Büchi自动机的切换状态,那么笛卡尔积后得到的任务可行性网络拓扑T的状态集ST=(q0s0,q0s1,q0s2,q1s0,q1s1,q1s2,q2s0,q2s1,q2s2,q3s0,q3s1,q3s2),这十二个状态的切换关系又由E和B共同决定; 该任务可行性网络拓扑将环境模型和任务结合在了一起,在此拓扑上运用SPFA算法搜索最优路径,可以确保路径的最优性,并且保证最优路径与派单节点选择顺序无关;
步骤5:通过步骤4得到任务可行网络拓扑后,采用SPFA算法在该拓扑上搜索出既满足环境信息又保证完成规定任务的最优路径,然后将搜索到的最优路径映射回可扩展加权切换系统,得到仓储机器人在仓储环境中的最优路径;如果在任务可行性网络拓扑搜索出来的一条路径是RT=q0s0→q2s1→......→qi-1sj-1→qisj,其中i,j为非负整数,那么映射回可扩展加权切换系统的实际路径RE=q0→q2→......→qi-1→qi。
2.根据权利要求1所述的基于线性时序逻辑理论的仓储机器人路径规划方法,其特征在于所述步骤1中对仓储环境建模的可扩展加权切换系统,该可扩展加权切换系统以仓储环境中的关键位置为节点,而不是将所有仓储货架位置也设为节点,仅当仓储货架有任务需求时,才将对应节点扩展到所构建加权切换系统中。
3.根据权利要求1所述的基于线性时序逻辑理论的仓储机器人路径规划方法,其特征在于所述步骤4中创建任务可行网络拓扑,构建的任务可行网络拓扑将仓储环境信息与派单取货任务需求融合在一起,在任务可行网络拓扑上采用SPFA算法确保了寻优所得路径既符合仓储环境信息又满足派单取货任务,并且不受任务节点顺序和数目的影响。