[发明专利]基于免疫自适应遗传算法的机器人栅格子地图融合方法

权利要求书

1.一种基于免疫自适应遗传算法的机器人栅格子地图融合方法，其特征是，将两个栅格子地图相应的矩阵作为抗原，抗体为第二个栅格子地图所作的平面变换，基于抗体与抗原亲和度，抗体种群在复制、交叉和变异算子操作下产生下一代抗体，根据相似矢量距计算的选择概率保证抗体多样性，在免疫原理基础上，根据抗体的适应度自适应地调节交叉概率和变异概率，减少局部最优的可能性；具体包括以下步骤：

(1)输入两个n×m的栅格子地图相应的矩阵m₁和m₂作为抗原，n和m是两个正整数，初始化抗体种群X_i＝TR_i：(t_xi，t_yi，θ_i)，i＝1，…，N，定义抗体种群中的抗体数N为10～40，初始抗体种群用随机函数随机产生，以保证初始抗体种群中抗体的多样性，利用二进制编码，每个抗体X_i长度为24位，前8位a_i7，…，a_i0表示t_xi∈[-n，n]，中间8位b_i7，…，b_i0表示t_yi∈[-m，m]，后8位c_i7，…，c_i0表示θ_i∈[0，2π]；下标B表示二进制；初始化最大进化代数，定义最大进化代数为50～80；初始化交叉概率和变异概率，交叉概率定义为：P_c＝0.25～0.75，变异概率定义为P_m＝0.01～0.3；

(2)计算抗体种群中所有抗体的优化函数值，即m₂按照抗体X_i＝TR_i：(t_xi，t_yi，θ_i)，i＝1，…，N做相应的平面变换后与m₁相重叠部分的优化函数值Δ(m₁，TR_i(m₂))，i＝1，…，N，优化函数值越小，说明重叠部分的相异程度越低；

针对栅格子地图的融合问题，优化函数定义为两部分：一部分是度量两个栅格子地图重叠区域整体相异程度的相异度函数，一部分是重叠区域中占有或空闲情况不同的栅格数与占有或空闲情况相同的栅格数的差值；

r₁和r₂分别表示矩阵m₂做一平面变换TR_i：(t_xi，t_yi，θ_i)后两个栅格子地图m₁和m₂的重叠区域，r₁≤m₁，r₂≤m₂，m₂做相应的平面变换TR_i：(t_xi，t_yi，θ_i)后，与m₁相重叠部分的相异度函数ψ表示r₁和r₂的相异程度，定义为矩阵表示的两个栅格子地图的图距离：

ψ(m1,TRi(m2))=Σc∈Cd(r1,r2,c)+d(r2,r1,c)]]>

其中，d(r1,r2,c)=Σr1[p1]=cmin{md(p1,p2)|r2[p2]=c}#c(r1)]]>

C表示矩阵m₁和m₂的值域，C＝{-255，255}，-255表示占有，255表示空闲；

r₁[p₁]＝c表示地图r₁中的栅格p₁所对应的矩阵元素的值为c，c∈C；

md(p₁，p₂)＝|x₁-x₂|+|y₁-y₂|表示栅格p₁(x₁，y₁)和p₂(x₂，y₂)之间的Manhattan距离；

#_c(r₁)＝#{p₁|r₁[p₁]＝c}表示地图矩阵r₁中值为c的元素的个数，c∈C；

重叠区域r₁和r₂中占有或空闲情况相同、不同的栅格数目分别表示为：

agr(r₁，r₂)＝#{p＝(x，y)|r₁[p]＝r₂[p]∈C}

dis(r₁，r₂)＝#{p＝(x，y)|r₁[p]≠r₂[p]∈C}

在重叠区域完全一致的理想情况下，dis(r₁，r₂)＝0，agr(r₁，r₂)等于r₁的栅格数，也等于r₂的栅格数；

寻找栅格子地图m₁和m₂最佳重叠区域相应平面变换TR^*：(t_x，t_y，θ)^*的优化函数定义为：

Δ(m₁，TR_i(m₂))＝ψ(r₁，r₂)+c_lock(dis(r₁，r₂)-agr(r₁，r₂))

c_lock≥0，是比例系数，取c_lock＝1；

(3)计算抗体种群中抗体的适应度函数值f(X_i)，i＝1，…，N，计算最大适应度及平均适应度f_max，f_avg，标注出最优抗体；

针对栅格子地图融合问题是目标函数最小问题，适应度函数使用线性排序和选择压差为2进行估算：

f(Xi)=2-sp+2×(sp-1)×pos-1N-1]]>

其中，sp表示压差，选择sp＝2；pos为抗体按照目标函数进行排序后的位置，1≤pos≤N，N为抗体种群中的抗体总数；

(4)选择操作：基于抗体相似度和矢量距计算选择概率，选择一些个体直接进入下一代种群；

抗体相似度定义为抗体编码的归一化距离，抗体x_i：(a_i7，…，a_i0，b_i7，…，b_i0，c_i7，…，c_i0)_B和抗体x_j：(a_j7，…，a_j0，b_j7，…，b_j0，c_j7，…，c_j0)_B的归一化距离为：

dij=(|ai-aj|D2n+|bi-bj|D2m+|ci-cj|D2π)/3]]>

其中，B表示二进制，D表示十进制，显然，d_ij越大，两个抗体x_i和x_j的相似程度越低；抗体x_i的浓度定义为：与抗体x_i相似度小于λ的抗体在总抗体种群中的比例，λ为一确定的阈值，取λ＝0.2；

基于相似度和矢量距的选择概率为：

Ps(xi)=αρ(xi)Σi=1Nρ(xi)+(1-α)1Ne-ciβ]]>

其中，为抗体X_i的矢量距，N为抗体种群的抗体总数，α和β是调节因子，0≤α≤1，0≤β≤1；

选择概率既与抗体的适应度有关，又与抗体的相似度有关，在抗体浓度一定的条件下，抗体矢量距越大选择概率越大；在抗体矢量距一定的条件下，抗体浓度越小选择概率越大；

(5)交叉和变异操作：基于抗体的适应度，自适应地调节交叉和变异概率P_c，P_m，按照以下公式计算得到的P_c，P_m，进行交叉和变异操作，得到下一代种群：

Pc=Pc1-(Pc1-Pc2)(f′-favg)fmax-favgf′≥favgPc1f′<favg]]>

Pm=Pm1-(Pm1-Pm2)(fmax-f)fmax-favgf′≥favgPm1f′<favg]]>

其中，f_max，f_avg分别是种群的最大和平均适应度；f′是进行交叉操作的两个抗体中较大适应度；f是进行变异操作的抗体适应度；P_c1，P_m1是设定的最大交叉和最大变异概率，P_c2，P_m2是设定的相对于最大适应度抗体的交叉和变异概率的下限值：P_c1＝0.9，P_c2＝0.6，P_m1＝0.1，P_m2＝0.001；

(6)由于优化函数的最优值未知，因此根据进化是否到达初始设定的最大进化代数，判断是否需要继续进化，如果没有进化到最大进化代数，则返回到步骤(2)继续进化；

(7)如进化到最大代数，选择最佳适应度相应的平面变换，计算匹配因子c_match，

cmath(r1,r2)=agr(r1,r2)agr(r1,r2)+dis(r1,r2)]]>

如果c_match＝1，则两个栅格子地图的重叠区域完全匹配；c_macth越小，则意味着重叠区域的匹配程度越低。