发明名称 一种迷宫搜索的方法
摘要 本发明涉及一种迷宫搜索的方法,该方法包括步骤如下:1)生成无方向概率距离图;2)生成有方向概率距离图;3)概率距离图的应用:建立步骤2)所述有方向概率距离图之后,机器人从起点迷宫格出发搜索迷宫,行进中遇到路口,根据机器人当前方向,利用概率距离图,判断哪个方向迷宫格的概率距离值最小,以此来决定行进路线,直到机器人抵达目标区域G。本发明将概率学中的概率与运动学中的距离有机的结合起来,提出了“概率距离”这一参数,以此参数为基准,使得迷宫搜索有理可据、有章可循。本发明实现了基于“概率距离”的迷宫搜索方法。
申请公布号 CN103116356B 申请公布日期 2015.07.22
申请号 CN201310071191.6 申请日期 2013.03.06
申请人 山东大学 发明人 王洪君;王磊;王惠;郝计军;唐瑞东;赵化森
分类号 G05D1/02(2006.01)I 主分类号 G05D1/02(2006.01)I
代理机构 济南金迪知识产权代理有限公司 37219 代理人 吕利敏
主权项 一种迷宫搜索的方法,其特征在于,该方法包括步骤如下:1)生成无方向概率距离图:迷宫中目标区域G为迷宫中心的四个相通的迷宫格,此目标区域G同外界相邻的是八个迷宫格,目标区域G必须与外界相通,虚线表示可能存在的墙壁,虚线围成的方格为迷宫格;假设初始时其他墙壁均不存在,迷宫格之间距离记为1,每一个90度转弯所耗时间也等效为距离,记为a,每一个180度转弯所耗时间等效为距离b,测试中所使用的机器人a≈1,b≈10;机器人所处的位置为迷宫格A,则迷宫格A和目标区域G的距离的计算方法为:距离迷宫格A最近的墙壁不存在的概率为p<sub>1</sub>=2<sup>7</sup>/(2<sup>8</sup>‑1),此时迷宫格A到目标区域G的最短距离为s<sub>1</sub>,即迷宫格A到目标区域G有p<sub>1</sub>的可能距离为s<sub>1</sub>;在所述最近的墙壁存在的情况下,距离迷宫格A第二近的墙壁不存在的概率p<sub>2</sub>=(1‑p<sub>1</sub>)·2<sup>6</sup>/(2<sup>7</sup>‑1),此时迷宫格A到目标区域G的最短距离为s<sub>2</sub>,即迷宫格A到目标区域G有p<sub>2</sub>的可能最短距离为s<sub>2</sub>;依此类推,p<sub>n</sub>、s<sub>n</sub>;最终可得到迷宫格A到目标区域G的距离如(1)式:S<sub>A</sub>=p<sub>1</sub>s<sub>1</sub>+p<sub>2</sub>s<sub>2</sub>+p<sub>3</sub>s<sub>3</sub>+p<sub>4</sub>s<sub>4</sub>+p<sub>5</sub>s<sub>5</sub>+p<sub>6</sub>s<sub>6</sub>+p<sub>7</sub>s<sub>7</sub>+p<sub>8</sub>s<sub>8</sub>  (1)由于上述结果是一个概率与距离的乘积,表示概率意义上的距离,式(1)中的S<sub>A</sub>为概率距离;2)生成有方向概率距离图:如机器人初始前进方向向上,则迷宫格B到目标区域G有p<sub>1</sub>的可能最短距离为s<sub>1dir</sub>;有p<sub>2</sub>的可能最短距离为s<sub>2dir</sub>;依次类推可以得到p<sub>n</sub>、s<sub>ndir</sub>;可得到迷宫格B到目标区域G的有向概率距离,如式(2)所示:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open='' close=''><mtable><mtr><mtd><msub><mi>S</mi><mi>Bdir</mi></msub><mo>=</mo><msub><mi>p</mi><mn>1</mn></msub><msub><mi>s</mi><mrow><mn>1</mn><mi>dir</mi></mrow></msub><mo>+</mo><msub><mi>p</mi><mn>2</mn></msub><msub><mi>s</mi><mrow><mn>2</mn><mi>dir</mi></mrow></msub><mo>+</mo><msub><mi>p</mi><mn>3</mn></msub><msub><mi>s</mi><mrow><mn>3</mn><mi>dir</mi></mrow></msub><mo>+</mo><msub><mi>p</mi><mn>4</mn></msub><msub><mi>s</mi><mrow><mi>s</mi><mn>4</mn><mi>dir</mi></mrow></msub><mo>+</mo><msub><mi>p</mi><mn>5</mn></msub><msub><mi>s</mi><mrow><mn>5</mn><mi>dir</mi></mrow></msub><mo>+</mo><msub><mi>p</mi><mn>6</mn></msub><msub><mi>s</mi><mrow><mn>6</mn><mi>dir</mi></mrow></msub><mo>+</mo><msub><mi>p</mi><mn>7</mn></msub><msub><mi>s</mi><mrow><mn>7</mn><mi>dir</mi></mrow></msub><mo>+</mo><msub><mi>p</mi><mn>8</mn></msub><msub><mi>s</mi><mrow><mn>8</mn><mi>dir</mi></mrow></msub></mtd></mtr><mtr><mtd><mo>=</mo><mn>2</mn><mfrac><mn>209</mn><mn>255</mn></mfrac><mo>+</mo><mn>2</mn><mfrac><mn>134</mn><mn>255</mn></mfrac><mi>a</mi></mtd></mtr><mtr><mtd><mo>&ap;</mo><mn>5</mn><mfrac><mn>88</mn><mn>255</mn></mfrac></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000690734460000021.GIF" wi="1557" he="342" /></maths>根据迷宫单元格的坐标进行编号,并按照上述算法进行计算,得出迷宫中每个单元格到目标区域的概率距离:当机器人初始方向为上时,按照上述计算和统计方式统计得“向上方向”的迷宫的概率距离图;同理,机器人初始方向为右时,将“向上方向”的迷宫的概率距离图顺时针旋转90°,保持坐标不变,仅数值变动;机器人初始方向为下时,将“向上方向”的迷宫的概率距离图顺时针旋转180°相同,保持坐标不变,仅数值变动;机器人方向为左时,将“向上方向”的迷宫的概率距离图逆时针旋转90°相同,保持坐标不变,仅数值变动;3)概率距离图的应用建立步骤2)所述有方向概率距离图之后,机器人从起点迷宫格出发搜索迷宫,行进中遇到路口,根据机器人当前方向,利用概率距离图,判断哪个方向迷宫格的概率距离值最小,以此来决定行进路线,直到机器人抵达目标区域G。
地址 250100 山东省济南市历城区山大南路27号