智能汽车如何眼观六路、耳听八方?传感器融合与卡尔曼滤波技术

李永乐老师
23 Mar 202117:33

Summary

TLDR李永樂老師在這期視頻中詳細解釋了自動駕駛汽車的傳感器融合技術。他通過比喻和實際例子,講解了毫米波雷達、激光雷達、攝像頭等傳感器如何相互配合,以及如何通過卡爾曼濾波技術融合這些傳感器的數據,以實現精確的環境感知和定位。此外,他還介紹了高精度地圖在自動駕駛中的重要作用,以及小鵬P7汽車如何利用這些技術提升駕駛的安全性和效率。

Takeaways

  • 🚗 自动驾驶汽车需要多种传感器来感知周围环境,包括摄像头、毫米波雷达、超声波雷达等。
  • 📐 小鹏P7配备了多个传感器和高精度地图,以实现NGP自动导航辅助驾驶功能。
  • 🔍 传感器融合技术允许汽车综合不同传感器的信息,提高对环境的感知能力。
  • 🌧️ 激光雷达在雨雪天气下性能受限,而毫米波雷达具有全天候工作的优势。
  • 📷 摄像头能够识别颜色和形状,但夜间和恶劣天气下性能下降。
  • 🗺️ 高精度地图与传感器数据结合,可以实现厘米级的车辆定位。
  • 📡 GPS和地面基站结合使用,可以提高定位精度至分米级。
  • 🤖 卡尔曼滤波是一种数学方法,用于处理和融合多个传感器的数据,提高估计的准确性。
  • 🚀 卡尔曼滤波技术曾帮助阿波罗飞船登月,现在广泛应用于GPS导航系统。
  • 🧭 自动驾驶汽车通过多传感器融合和卡尔曼滤波技术,提高对位置和环境的判断准确性。
  • 📚 李永乐老师通过视频讲解,帮助观众理解自动驾驶技术的复杂性和背后的科学原理。

Q & A

  • 小鵬P7的自動駕駛功能有哪些特點?

    -小鵬P7的自動駕駛功能包括多個攝像頭、毫米波雷達、超聲波雷達、分米級的高德地圖以及厘米級的高精度定位,還有互為冗余的雙計算平臺,這些技術使得汽車能夠更準確地感知周圍環境並進行精確定位。

  • 傳感器融合是什麼?

    -傳感器融合是自動駕駛汽車感知環境的一種技術,通過結合多種傳感器(如攝像頭、雷達等)收集的信息,以獲得更全面、準確的環境感知能力。

  • 激光雷達和毫米波雷達有哪些區別?

    -激光雷達通過發射激光並接收回波來測量障礙物距離,能夠進行3D建模,但波長短,難以穿透雨雪雲霧。毫米波雷達波長較長,能夠穿透雨雪,稱為全天候雷達,但不能進行3D建模。

  • 為什麼需要高精度地圖?

    -高精度地圖能夠提供分米級甚至厘米級的定位精度,對於自動駕駛汽車來說,這種精度是必要的,因為它們需要精確地知道自己的位置以及周圍環境的詳細信息。

  • 卡爾曼濾波是什麼?

    -卡爾曼濾波是一種數學算法,用於處理多傳感器融合問題,能夠將帶有誤差的測量值融合,得到最優的估計結果。它在自動駕駛、導航系統以及宇宙飛船的定位中都有應用。

  • 小鵬P7是如何實現高精度定位的?

    -小鵬P7通過結合GPS或北鬥導航系統的定位、地面基站校準(如千尋定位系統),以及高精地圖的對比,實現了分米級甚至厘米級的高精度定位。

  • 傳感器融合中遇到的矛盾信息該如何處理?

    -在傳感器融合中,如果不同傳感器提供的信息存在矛盾,可以通過卡爾曼濾波算法來處理。該算法會根據各傳感器測量值的準確度(方差大小)來分配權重,從而得出最優的估計結果。

  • 卡爾曼濾波的優點是什麼?

    -卡爾曼濾波的優點在於它能夠有效地處理多源信息,並在存在誤差和不確定性時提供最優的估計結果。它通過數學方法最小化總的方差,從而提高估計的準確度。

  • 小鵬P7的NGP自動導航輔助駕駛功能是如何工作的?

    -NGP功能通過融合多種傳感器收集的數據,並利用卡爾曼濾波等算法進行處理,以實現對汽車周圍環境的精確感知和自身位置的高精度定位,從而輔助駕駛,使駕駛更加安全和高效。

  • 在自動駕駛中,為什麼需要考慮傳感器的空間定標和時間定標?

    -空間定標是為了將不同傳感器在車輛不同位置收集的數據融合到同一參考系統中,確保數據的一致性。時間定標則是為了處理不同傳感器感知頻率不一致的問題,確保融合的數據是同步的。

  • 小鵬P7的NGP功能如何提升駕駛安全?

    -NGP功能通過精確的環境感知和定位,能夠預測和應對各種駕駛情境,如避讓障礙物、遵守交通規則等,從而降低事故風險,提升駕駛安全。

Outlines

00:00

🚗 自动驾驶汽车的传感器融合技术

李永乐老师介绍了自动驾驶汽车如何通过多种传感器(如摄像头、毫米波雷达、激光雷达等)进行环境感知。他解释了传感器融合的重要性,以及如何通过这些传感器的互补特性来提高自动驾驶汽车对周围环境的感知能力。

05:02

📍 高精度定位与地图的重要性

李永乐老师阐述了自动驾驶汽车需要高精度地图和定位系统来确定车辆的精确位置。他解释了导航级地图与高精度地图的区别,并介绍了如何通过地面基站和高精度地图提高定位精度。

10:02

🤖 传感器数据融合的挑战与卡尔曼滤波

李永乐老师讨论了传感器数据融合面临的挑战,包括空间定标和时间定标问题。他介绍了卡尔曼滤波的原理和应用,以及如何通过数学计算融合不同传感器的信息,以获得更准确的车辆位置和环境感知。

15:05

🛰️ 卡尔曼滤波的历史与现代应用

李永乐老师讲述了卡尔曼滤波的历史背景,以及它在航天、航海和自动驾驶汽车中的应用。他解释了卡尔曼滤波如何帮助处理传感器数据的不确定性,并提供了一个简化的卡尔曼滤波模型示例。

Mindmap

Keywords

💡自动驾驶

自动驾驶是指汽车能够在没有人类驾驶员的情况下,通过内置的传感器和控制系统自主完成驾驶任务。在视频中,李永乐老师提到了自动驾驶汽车需要多种传感器来感知环境并做出决策。

💡传感器融合

传感器融合是指将来自汽车上多个不同类型传感器的数据结合起来,以获得更准确、全面的环境感知信息。视频中提到,小鹏P7通过融合多个摄像头、毫米波雷达等传感器的数据,实现了对周围环境的精确感知。

💡毫米波雷达

毫米波雷达是一种利用毫米波频段的电磁波进行探测的雷达,能够在各种天气条件下工作,用于自动驾驶汽车中检测周围物体的距离和速度。视频里提到毫米波雷达可以穿透雨雪,实现全天候的探测。

💡高精度地图

高精度地图是指具有非常精确位置信息的地图,能够为自动驾驶汽车提供分米级甚至厘米级的定位服务。视频中提到,高精度地图可以帮助汽车精确地知道自己在道路上的具体位置。

💡卡爾曼濾波

卡爾曼濾波是一种数学方法,用于处理和融合多个带有误差的测量值,以获得最准确的估计。在视频中,李永乐老师解释了卡爾曼濾波如何帮助自动驾驶汽车整合来自不同传感器的信息,提高定位和环境感知的准确性。

💡激光雷达

激光雷达是一种使用激光进行测距和扫描的传感器,能够生成周围环境的三维点云图。视频中提到,激光雷达可以提供精确的距离和方向信息,但可能在恶劣天气下性能下降。

💡摄像头

摄像头在自动驾驶汽车中相当于人的眼睛,能够捕捉图像并识别颜色、交通信号等。视频中提到,摄像头可以与雷达等其他传感器配合使用,提供更全面的环境信息。

💡双计算平台

双计算平台指的是汽车中有两个独立的计算系统,它们可以互为备份,提高系统的可靠性。在视频中,小鹏P7拥有双计算平台,以确保自动驾驶系统的稳定运行。

💡NGP自动导航辅助驾驶功能

NGP(Navigation Guided Pilot)自动导航辅助驾驶功能是小鹏汽车的一项技术,它结合了高精度地图和传感器数据,实现车辆在高速公路上的自动驾驶辅助。视频中提到,NGP功能使得驾驶更加安全和高效。

💡冗余设计

冗余设计是指在系统设计中故意添加额外的组件或功能,以确保在主要系统发生故障时,备份系统可以接管工作,从而提高系统的安全性和可靠性。视频中提到小鹏P7的双计算平台就是冗余设计的一个例子。

Highlights

小鵬P7自動駕駛汽車擁有多個傳感器,包括攝像頭、毫米波雷達、超聲波雷達等。

小鵬P7使用分米級高德地圖和厘米級高精度定位。

小鵬P7具有互為冗余的雙計算平臺。

傳感器融合技術讓汽車能夠眼觀六路,耳聽八方。

激光雷達能進行3D建模,但難以穿透雨雪雲霧。

毫米波雷達是全天候雷達,能穿透雨雪。

攝像頭能判斷顏色,但定位準確度不如雷達。

小鵬P7利用多種傳感器融合技術,提高自動駕駛的安全性和效率。

高精度地圖對自動駕駛汽車至關重要,能實現分米級甚至厘米級定位。

卡爾曼濾波技術能夠融合不同傳感器的信息,提高定位精度。

小鵬P7通過卡爾曼濾波實現了厘米級的高精度定位。

卡爾曼濾波曾幫助阿波羅飛船登月,現在也應用於GPS導航系統。

多傳感器融合原理與早期航海家的方法相似,但現在有更先進的技術。

小鵬汽車NGP自動導航輔助駕駛功能是一種創新的自動駕駛技術。

小鵬P7的傳感器融合技術能夠準確判斷周圍環境和自身位置。

小鵬P7的技術展示了自動駕駛領域的進步和發展。

李永樂老師通過視頻解釋了自動駕駛汽車的技術原理。

小鵬P7的自動駕駛技術能夠讓駕駛變得更加安全和高效。

Transcripts

00:00

各位同學 大家好 我是李永樂老師

00:01

前一段時間 我講了一期關於自動駕駛的話題

00:04

有小朋友就跟我說

00:05

他最近就買了一輛自動駕駛的汽車小鵬P7

00:08

它擁有多個攝像頭 毫米波雷達

00:11

超聲波雷達 分米級的高德地圖

00:13

以及厘米級的高精度定位

00:15

還有互為冗余的雙計算平臺

00:17

他想問我

00:17

這麽一大堆聽不懂的名詞 到底是什麽意思呢

00:20

今天我們就來聊一聊

00:21

小鵬汽車的NGP自動導航輔助駕駛功能

00:24

為了聊這個話題

00:25

我們首先來講一講傳感器的融合 傳感器融合

00:34

我們在上一次講自動駕駛的時候說過

00:37

一個汽車要想自動駕駛的話

00:38

它必須能夠自動地感知外界的環境

00:41

同時進行決策以及執行

00:43

在感知的層面 就需要一大堆傳感器進行配合

00:46

汽車的傳感器就相當於人的感官

00:48

人的感官不只有一種

00:49

比如說亞裏士多德說人的感官有五種

00:52

就是眼睛 鼻子 舌頭 耳朵還有身體

00:55

分別對應了視覺 嗅覺 味覺 聽覺

00:58

還有觸覺 是吧

00:59

每一種感覺都有它的特點

01:00

比如說大部分情況下

01:02

視覺的範圍是比較廣泛的

01:03

但是如果你遇到了雨雪天氣

01:05

也許聽覺能為我們提供更準確的信息

01:08

只有幾種感官相互配合

01:09

人們才能準確地判斷外界的環境

01:12

那麽對於汽車來講

01:13

同樣是如此

01:14

使用一種傳感器 不能準確地判斷外界環境

01:17

所有的自動駕駛汽車

01:18

必須使用多種傳感器相互配合

01:20

這就是所謂的傳感器融合技術

01:22

它能夠讓汽車眼觀六路 耳聽八方

01:25

回答兩個重要的問題

01:26

那就是我周圍有什麽以及我在哪裏

01:29

我們首先來看第一個問題

01:31

說汽車可以通過傳感器回答

01:33

說自己的周圍到底有什麽這個話題 是吧

01:40

一般來講

01:41

在具有高級自動駕駛功能的汽車上

01:43

它在高速行駛的時候

01:45

有三種傳感器發揮了這個作用

01:47

這三種傳感器分別是激光雷達

01:52

以及以前我們講過的叫毫米波雷達

01:57

毫米波雷達 還有就是攝像頭 攝像頭

02:03

每一種傳感器都有自己不同的特點

02:08

我們來解釋一下 畫個表格

02:09

表格畫完了

02:10

我們首先來說一說激光雷達

02:12

激光雷達的原理

02:13

就是發射一束激光

02:15

遇到障礙物 然後反射接收到回波

02:17

計算發射和接收的時間差

02:19

從而判斷障礙物的距離

02:21

激光雷達又分為兩種

02:22

有一種叫機械式激光雷達

02:24

就是它可以向不同的方向360度的旋轉

02:27

然後掃描 是吧

02:28

這樣就可以判斷

02:29

說周圍的障礙物離自己都有多遠了

02:31

可以獲得一個3D點陣

02:33

就可以勾繪出周圍的這個情況

02:35

還有另外一種激光雷達叫做固體激光雷達

02:38

它就是由很多個光源形成一個陣列

02:40

通過調相的方法

02:42

就可以實現向不同的方向發射激光

02:44

它不需要旋轉

02:45

而且這種雷達 它相比來講造價比較低

02:48

這個壽命也比較長

02:49

可能是未來激光雷達的這個發展方向

02:51

激光雷達有很多很好的特征

02:53

比如說 首先它的定位非常準確

02:56

它可以準確地判斷這個障礙物離我們有多遠

02:59

而且是什麽方向的

03:00

它都可以準確地判斷出來

03:01

同時激光雷達是自己發出電磁波接收回波

03:04

它不需要有外界的光

03:05

所以夜晚也可以使用

03:07

而且激光的波長很短

03:09

它可以判斷這個物體的表面的形狀 是吧

03:12

這個物體是一個平面 還是一個凸起

03:14

它都可以判斷出來

03:15

我們稱之為可以3D建模

03:17

但是激光雷達也有它的缺點

03:19

比如說 因為激光波長比較短

03:21

很難穿透雨雪雲霧

03:23

到雨雪雲霧的天氣

03:25

激光雷達就不能用了 對吧

03:27

再比如說 激光雷達是靠發射激光接收回波

03:30

測量物體的距離

03:31

它沒有辦法判斷

03:33

這個物體是紅色還是綠色的 是吧

03:35

它沒有辦法判斷物體的顏色

03:37

所以它看不出來紅綠燈 是吧

03:39

而且它也沒有辦法區分哪個車道線

03:41

是不是 這是激光雷達的一個缺點

03:43

那麽為了克服這些缺點

03:45

人們還需要其他雷達

03:46

比如說毫米波雷達

03:47

毫米波雷達和激光雷達原理類似

03:49

它只不過波長長一些

03:50

它也可以實現比較準確的定位

03:53

在夜晚也可以使用

03:55

它還有一個優點

03:56

就是因為波長長 可以穿透雨雪 是吧

03:58

所以也稱它為全天候雷達

04:00

白天晚上都能用 雨雪天氣也能用

04:03

但是它也有缺點

04:04

首先它跟激光雷達一樣

04:06

不能夠區分物體的顏色

04:08

而且因為它波長比較長

04:10

就沒有辦法準確地描繪出

04:11

這個物體到底是長什麽樣子

04:13

沒有辦法進行3D建模 這是它的一缺點

04:16

那麽怎麽辦呢

04:17

人們又提出我們還可以用攝像頭

04:19

攝像頭就相當於汽車的眼睛

04:22

它跟雷達不一樣

04:23

雷達是發射電磁波 接收回波

04:25

而這個攝像頭它只接收外界的光信號

04:28

它不往外發射 對不對

04:29

所以它的特征首先它可以判斷顏色 對吧

04:32

它拍攝了很多很多的照片

04:34

然後把這些照片輸入計算機 進行機器學習

04:36

它就可以知道這個是紅綠燈 那個是斑馬線

04:39

這個是人 那個是車 對吧

04:41

它就可以知道這些信息了

04:42

但是攝像頭也有它的缺點

04:44

首先來講 晚上沒光的時候

04:46

攝像頭肯定是用不了的 對不對

04:48

雨雪天氣 這個光也很容易被遮擋

04:51

所以也沒有辦法判斷前方的物體了

04:54

如果你是雙目攝像頭

04:55

你倒是可以進行簡單的定位

04:57

但是攝像頭它是有畸變的

04:59

所以它的定位準確度遠遠沒有雷達好

05:02

如果是單目攝像頭 那就沒有辦法實現定位了

05:04

同時攝像頭也沒有辦法進行3D建模

05:08

你這樣一看

05:08

每一種傳感器 其實都有它的優點和它的缺點

05:12

所以我們得把多種傳感器配合起來使用

05:14

才能夠準確地判斷出外界的環境

05:16

你比如說你用這個激光雷達進行定位 是吧

05:19

定位完了之後

05:20

用它勾勒出這個物體的這個形狀來

05:23

最後我們再用這個攝像頭進行上色

05:25

我就可以知道是什麽了

05:26

如果攝像頭發現前面有一只老虎

05:28

結果激光雷達判斷這是一個平面的 是吧

05:31

那我們就可以知道這是一張老虎的年畫

05:33

我就可以準確地進行判斷了

05:35

那小鵬P7就是利用了這樣的技術

05:37

它有5個毫米波雷達

05:38

還有14個攝像頭進行融合

05:40

那自動駕駛汽車除了要知道周圍有什麽以外

05:43

還有一個 就是自己在哪裏

05:45

或者說要實現這個高精度的定位

05:49

那我們現在定位用導航 是不是

05:51

我們用手機打開百度地圖或者高德地圖

05:54

我們就可以導航了

05:55

那種地圖它叫導航級地圖

05:59

導航級地圖精確度不高 大概是米級

06:04

就是說我們使用導航級地圖

06:06

它的誤差在幾米的這個量級

06:07

我沒有辦法區分

06:09

自己的汽車到底是在主路上還是在輔路上

06:11

到底是在第一條車道還是在第二條車道

06:14

那麽這種導航及地圖

06:15

其實對於自動駕駛汽車是不夠的

06:18

自動駕駛汽車必須使用高精度的地圖

06:22

高精地圖

06:24

這個高精地圖要精到什麽程度呢

06:27

要能夠對汽車進行分米級

06:29

甚至厘米級的這種定位

06:32

它的誤差要在分米甚至是厘米的量級

06:35

那怎麽才能做到這麽高的精度呢

06:38

我給大家介紹一下這個方法

06:39

首先我們知道一個汽車上面

06:42

它會有一些這個定位的模塊

06:45

它可以和這個衛星進行聯絡

06:48

比如說我們可以用GPS或者北鬥這個導航系統

06:52

用這個導航系統跟衛星進行聯絡

06:55

理論上來講 四顆衛星就可以把你定位了

06:59

這就是第一步

07:00

就是通過這個北鬥或者GPS我們可以進行定位

07:04

但是這樣定位它是存在一定的誤差的

07:06

比如說因為雲霧的影響造成的這個光速的變化

07:09

等等會有誤差

07:10

那麽這個誤差怎麽辦呢

07:11

我們可以在地面上建立一系列的基站進行校準

07:16

我們不光要你和這個衛星聯絡

07:19

你還要和地面的基站進行校準聯絡

07:22

很多公司就做這個事

07:23

比如說像這個千尋定位系統

07:26

千尋定位就是在地面上安裝了一大堆的基站

07:30

這樣它就可以提高你定位的精度

07:32

比如說像導航系統只能給你達到米量級

07:35

而這個千尋定位就可以輔助你

07:37

達到分米量級的定位

07:39

但是我們怎麽樣才能

07:40

進一步提高這個定位的精度呢

07:42

還有方法

07:43

比如說像這個高德地圖

07:45

他做這個高精度地圖的方法是這樣的

07:47

首先他在做地圖的時候

07:49

他就會派一輛帶有這個激光雷達的汽車上路

07:52

這個激光雷達的汽車

07:54

它就會把周圍的環境都拍下來

07:56

周圍可能有什麽呢

07:58

周圍可能有一個 比如說一個房子

08:01

也可能是有一棵大樹

08:03

也可能這邊有一個紅綠燈

08:05

也可能這邊還有一個什麽花壇之類的

08:09

那麽這些東西

08:10

都會被這個激光雷達拍攝下來

08:13

拍攝下來之後

08:14

它就把這個數據都記錄下來了

08:15

然後放到這個高精地圖上面 是吧

08:18

這個就是高德的這個高精地圖

08:20

然後當我們的這個自動駕駛汽車

08:23

去使用這個地圖的時候

08:26

它自動駕駛汽車不是也有這些傳感器嗎

08:28

它也會拍攝周圍的環境

08:29

它會把周圍的環境

08:30

再和高精地圖中已經拍攝好的這個環境

08:33

進行對比

08:34

它一對比就知道了

08:35

你看 我現在在主路上 我在輔路上

08:37

我在第一條道 還是在第二條道

08:39

我就可以達到厘米的量級了

08:41

這個小鵬汽車就采用了這樣的一個技術

08:43

首先通過這個定位系統

08:45

以及這個千尋定位系統

08:47

達到了一個分米級的定位

08:48

然後再通過這個高精地圖

08:50

跟周圍的環境進行比對

08:51

達到這個厘米級的定位

08:52

這就是自動駕駛汽車的一個定位的原理

08:55

那剛才我們介紹了傳感器融合的作用

08:58

但傳感器究竟是怎麽融合到一塊的呢

09:00

這是一個很復雜的技術問題

09:02

舉個例子來講

09:03

不同的傳感器它們的獲得信息是不一樣的

09:06

這裏面面臨兩個方面的問題

09:08

第一個問題叫做空間定標

09:10

就是你不同的傳感器

09:11

你是安裝在車上不同的位置的

09:13

所以角度也不一樣

09:15

這樣你會看到不同的情景 拍攝到不同的畫面

09:17

你怎麽通過空間坐標的方法

09:19

把這些個畫面給融合到一塊

09:21

這就叫空間定標 是吧

09:22

第二個是時間定標

09:24

每一個傳感器它對外界環境的感知頻率不一樣

09:28

比如說攝像頭 它可能每秒鐘拍攝25張照片

09:31

而這個毫米波雷達

09:32

它可能每秒鐘只是探測10次

09:35

這樣一來 攝像頭拍照片的時候

09:36

可能這個毫米波雷達沒有信息傳回來

09:39

所以我要通過一些方法

09:40

把這個不同時間的信號 又把它融合起來

09:43

這個就叫所謂的時間定標

09:45

除了空間定標和時間定標以外

09:47

更為重要的是

09:48

有的時候傳感器獲得的信息是彼此矛盾的

09:50

比如說攝像頭告訴我們前方有一堵墻

09:53

而毫米波雷達告訴我們前面是個斜坡

09:55

我們到底相信誰呢

09:56

比如說定位系統告訴我們現在在主路上

09:59

但是這個雷達告訴我們現在我們在輔路上

10:02

我們又該相信誰呢

10:03

因為每一種傳感器它都是有誤差的

10:05

所以這樣的矛盾是每時每刻都在發生的

10:07

我們該怎麽辦呢

10:08

這裏我們就不得不提一位

10:10

在工程界家喻戶曉的人物了

10:12

他是一位出生在奧地利的美國數學家和工程師

10:16

名字叫做魯道夫·卡爾曼

10:18

他提出了卡爾曼濾波

10:22

卡爾曼濾波曾經幫助阿波羅飛船登上了月球

10:27

現在也在每時每刻都在幫助我們的GPS導航系統

10:30

我們利用卡爾曼濾波

10:31

就可以把不同傳感器的信息融合到一塊了

10:34

我們舉一個例子

10:35

比如說我們通過定位系統

10:37

比如GPS定位 或者是什麽其他的定位系統

10:40

我們知道了這個汽車的位置

10:43

這個位置就是z₁

10:45

我告訴你汽車是在z₁的位置

10:47

但是因為GPS是有誤差的

10:49

它不能準確地告訴你在什麽位置

10:50

而只能告訴你在一個範圍內

10:52

它還有一個誤差或者說方差 σ₁²

10:56

z₁只是表示

10:58

你可能在的位置中的這個平均位置

11:02

或者叫期望

11:03

而這個σ₁²就代表了你的誤差大小

11:07

如果這個σ₁²特別特別小

11:09

就表示你的定位特別準確

11:11

σ₁²特別大

11:12

就表示你的定位不太準確 誤差特別大

11:14

一般來講我們認為

11:15

這個GPS定位也好 其他的定位也好

11:18

它的這個誤差情況

11:20

都滿足一個高斯分布 或者正態分布

11:22

以前我們講過高斯分布是什麽意思呢

11:25

畫一個圖像

11:26

縱坐標表示的是概率密度

11:29

就出現在某一個位置的概率密度

11:31

橫坐標是表示你的位置

11:33

如果說GPS告訴我們

11:35

你的位置是以z₁為平均位置

11:37

而標準差是σ₁

11:39

我們可以畫出一個圖像來

11:41

它就長這個樣子 是吧

11:43

它這個最大概率的位置就是z₁

11:46

這個圖像就告訴我們

11:47

你的位置最有可能是在z₁的位置

11:49

你離z₁位置越近 你出現的概率就越大

11:52

你離z₁位置越遠 你出現的概率就越小

11:55

如果這個函數特別的瘦高

11:57

那就意味著你給我的信息特別準確

11:59

你分布的位置都是在z₁附近的

12:01

如果這個函數特別的矮胖

12:03

那就說明你誤差特別大

12:04

我也不太清楚你到底是在什麽位置

12:07

這就是所謂的這種高斯分布或者說正態分布

12:10

這裏邊的這個σ

12:11

其實就表示它瘦高還是矮胖的程度

12:13

如果σ特別小 那這個函數就特別瘦高

12:16

就表示比較準確

12:17

σ特別大 就說明你比較矮胖

12:19

好 總而言之

12:20

這個GPS定位告訴了我們這個位置的信息

12:23

但是我們不是還有其他傳感器嗎

12:26

什麽雷達什麽的 攝像頭

12:28

我們這些傳感器它也可以告訴我們位置的信息

12:32

比如它告訴我們汽車的位置是在z₂

12:35

而且這個方差是σ₂²

12:39

我也可以再畫出這個傳感器告訴我們的情況

12:42

比如說它有可能是長這個樣子的 長這個樣子

12:46

這個樣子就告訴我們

12:48

傳感器認為我們的位置更加靠前一點 是不是

12:51

而且傳感器提供的信息可能更加準確

12:54

它的這個標準差σ₂比較小

12:57

而剛才這個GPS告訴我們的這個標準差

13:00

σ₁它是比較大的

13:02

現在我們得到兩個不同的信息

13:03

我們如何把它融合到一塊呢

13:05

這卡爾曼就說了

13:06

經過數學計算 你有一個最優的估計

13:10

最優的估計 最優的估計是什麽呢

13:15

那就是這有一個公式

13:16

這公式告訴我們你最優估計的位置等於什麽呢

13:21

=σ₂²z₁/(σ₁²+σ₂²)+σ₁²z₂/(σ₁²+σ₂²)

13:34

有的同學們說什麽亂七八糟的

13:35

其實這個問題並不是難理解的

13:38

咱們仔細看

13:38

z₁和z₂是兩個傳感器告訴我們的位置

13:42

我們最後估計的位置

13:43

一定是要把它融合到一塊得出一個結論

13:46

但是誰更準確我就更相信誰

13:49

你看這兩個圖像你就應該知道

13:51

這個σ₂更小一些

13:53

說明z₂這個信息更加準確

13:55

所以我在計算權重的時候

13:57

我應該讓z₂的這個權重更大一些

14:00

我怎麽才能讓z₂的權重更大一些呢

14:02

我讓它前面的權重是

14:03

σ₁²/(σ₁²+σ₂²)

14:05

你σ₁比較大 所以這個權重就大

14:08

大家能明白嗎 對不對

14:09

同樣道理 你這個z₁它的標準差比較大

14:12

說明它不是那麽的準確

14:13

所以它的權重就要小一些 是吧

14:16

所以你可以簡單地理解一下

14:17

這個其實就是把兩個數據融合到一塊了

14:20

在融合的時候 誰準確誰的權重就會大一些

14:25

同時我也可以知道新的這個方差

14:29

1/σ²=1/σ₁²+1/σ₂²

14:35

這就是卡爾曼告訴我們的最優結論

14:38

你會發現 這個新的標準差的平方或者說方差

14:42

它是比原來的兩個方差都要小的

14:44

所以最終我們會得出來一個新的估計情況

14:48

它是長這個樣子的

14:52

它首先它的均值是介於兩個估計值之間的

14:59

而且它的方差比兩個估計值都要小

15:02

或者說我們獲得了一個更加準確的估計

15:05

那麽假如這輛汽車還有其他傳感器

15:07

比如說有什麽速度計 加速度計

15:08

你還可以繼續進行卡爾曼濾波

15:11

這樣就會獲得一個更加準確的結果了

15:13

我們剛才介紹的這個模型

15:15

其實是最簡單的一個卡爾曼濾波模型

15:17

在實際的情況下 卡爾曼濾波不光是多維的

15:20

而且還是跟時間有關的 它是一個時續的

15:24

我們來看一下這個卡爾曼濾波

15:26

它在航海上有什麽應用 在航海上應用

15:31

其實人類在大航海時代開始的時候

15:33

就已經在不知不覺中使用這種濾波的方法了

15:36

比如說一個有經驗的船長

15:38

他在t₁的時刻他會有一個位置

15:41

他知道自己的位置

15:43

那麽他會有一個航向或者是航速表 是吧