机器人的定位问题

信任度表示
机器人必须有一个在地图上有关它位置信任度的方法。机器人是否辨识一个单独的特定位置作为它的当前位置,或它是否根据一组可能的位置描述它的位置?如果以单个信任度完全表达多个可能位置,那如何将这多个位置排序?这就是信任度表示方法的设计问题

信任度
一般来说机器人并不能直接测量它的真实状态,只能根据传感器数据,最佳估计它的状态。所以机器人拥有的关于它状态的知识只能由数据推测。有关机器人状态的最好猜测,叫信任度

单假设信任度和多假设信任度
单假设信任度
单假设信任度表示是移动机器人位置最直接可能的假设。给定某个环境地图,机器人关于位置的信任度表示为地图上单个独特的点。主要优点来自以下事实,给定唯一的信任度,位置没有任意性。这个表示方法的非任意性本质加速了机器人在认知水平上(例如,路径规划)的决策。机器人可以简单地假定,它的信任度是正确的,然后可以根据它唯一的位置,选择其未来的动作。

机器人的位置更新一般分为两步
1、在预测(或动作)更新期间,机器人利用本体感受式传感器估计它的方位,例如,利用编码器机器人估计它的运动。在这阶段,量程器误差随时间积分,有关机器人方位的不确定性增加
2、在感知(或测量)更新期间,机器人利用外感式传感器的信息,校正预测阶段所估计的位置。例如,用一个测距仪测量它离墙的距离,并相应地校正在预测阶段所估计的位置。在感知阶段,机器人的方位不确定性缩小


基于概率地图定位的两种不同方法:马尔可夫定位和卡尔曼滤波器定位

为了解决机器人定位问题,需要以下信息:
1、初始概率分布 在不知道机器人初始位置的情况下,初始信任度对整个姿态是均匀分布的
2、环境地图
3、数据 为了定位,机器人显然需要使用来自它本体感受式传感器和外感受式传感器数据。一般来讲,我们用z表示从外感受式传感器来的当前读数,称为观测值。u表示从本体感受式传感器来的读数或控制输入,对差分驱动机器人,u表示来自左轮右轮编码器读数
4、概率运动模型 从机器人运动学推导而来,x_t = f(x_t-1,u_t) 当前位置由前一个位置和编码器读数组成的函数f计算出
5、概率测量模型 从外感受式传感器模型推导出来


定位问题分类

位置跟踪 机器人的当前位置是根据对它以前位置的知识而更新的

全局定位 全局定位假定机器人的初始位置是不知道的

绑架机器人问题 机器人被绑架,并且被移动到其他地方的情况,类似漂移


在说定位问题之前,搞清楚移动机器人中的先验和后验先验是在考虑任何传感器测量之前,对全空间的机器人位置的概率分布,后验概率p(x|y) 是在纳入数据之后计算的

马尔可夫定位
马尔可夫定位利用一个任意概率密度函数表示机器人的位置,跟踪机器人的信任度状态。

在两种定位方法中,预测更新都是基于全概率定理,也就是这个

全概率定理

感知更新 基于贝叶斯定理,也就是这个

贝叶斯定理

下面是关于公式对应机器人的解释

在读取传感器数据A之后,我们想要知道机器人占有指定位置B的概率P(B|A)。如果机器人早先在那个位置上,我们只要将观察这些测量的条件概率P(A|B),乘上在读取传感器数据之前,机器人就在那里的概率P(B)。结果除以某个规格化因子P(A)。
重要的是,P(A)不依赖于B,P(A)_-1可以写成为规格化因子η

马尔可夫假设意味着它们的输出x_t只是机器人以前位置x_t-1和它的最近动作(量程仪,通常是里程计)u_t和感知z_t的函数。然而在一般情况下,非马尔可夫情况中,系统状态依赖于所有它的经历

卡尔曼滤波定位
对卡尔曼滤波来讲,状态概率密度函数和观测模型都是高斯分布。

前面所说到的马尔可夫定位在机器人位置方面可以表示任何概率密度函数,该方法是一般的,但是由于它的通用性所以效能很差。
现在,我们换个角度考虑一下,对机器人定位来讲,关键需求不是概率密度曲线的精确赋值,而是对鲁棒定位至关重要的传感器融合问题。机器人通常包含大量的异质的传感器,各提供关于机器人定位线索。关键是,各传感器都经受它自己的失误模式

下面图中,系统有一个控制信号和作为输入的系统误差源。测量装置能够测量带有误差的某些系统状态。


卡尔曼滤波器是基于系统的知识和测量装置,产生系统状态最优估计的一个数学机制,是对系统噪声,测量误差和动态模型不确定性的描述

其中,系统被假定为是线性并具有高斯白噪声。然而对于大多数移动机器人,系统并不是线性的。卡尔曼滤波扩展到非线性系统,称为扩展卡尔曼滤波

典型卡尔曼滤波应用.jpg


卡尔曼滤波器定位不使用任何密度函数,而是用高斯代表机器人信任度,运动模型和测量模型。
因为高斯简单地由它的均值和协方差来定义,在预测测量(还记得吗?前面的马尔可夫定位也是这两个阶段)阶段这两个参数被更新。很显然,由此带来的问题就是卡尔曼滤波器定位这样的假设限制了初始信任度以及高斯的选择。这意味着,必须以一定的近似知道机器人的初始位置

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 203,362评论 5 477
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 85,330评论 2 381
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 150,247评论 0 337
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 54,560评论 1 273
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 63,580评论 5 365
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 48,569评论 1 281
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 37,929评论 3 395
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 36,587评论 0 258
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 40,840评论 1 297
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,596评论 2 321
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 37,678评论 1 329
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 33,366评论 4 318
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 38,945评论 3 307
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 29,929评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,165评论 1 259
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 43,271评论 2 349
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 42,403评论 2 342

推荐阅读更多精彩内容