贝叶斯公式全概率公式定位问题机器人寻路

最新推荐文章于 2024-03-27 10:45:34 发布

原创

最新推荐文章于 2024-03-27 10:45:34 发布 · 1.6k 阅读

3 ·

CC 4.0 BY-SA版权

文章标签：

#定位 #贝叶斯

本文深入探讨了机器人寻路过程中如何利用贝叶斯公式和全概率公式进行精确定位。通过实例分析，阐述了这两个数学工具在解决实际问题中的应用，为机器人导航提供了理论基础。

p=[0.2, 0.2, 0.2, 0.2, 0.2]
#the lable of real world
world=['green', 'red', 'red', 'green', 'green']
#sense value before move
measurements = ['red', 'red']
#number of steps after measurements
motions = [1,1]
"""
process:
1. check measurements[0], find init position(probability), assume the probability we'r in each grid
2. move setp of each grid, also the last position is important(product one by one)
loop
"""
#sense may be error or correct
pHit = 0.6
pMiss = 0.
#move can be overshoot or not
pExact =