▍定位的基本概念

了解定位，我們首先要先了解位置。位置這個術(shù)語其實不是很準(zhǔn)確，應(yīng)該叫做位姿，包含位置和目標(biāo)體的朝向（姿態(tài)），我們習(xí)慣于用笛卡爾坐標(biāo)系來表征位姿：

2D平面的位姿

三個自由度(x,y,rotation)，x,y是2D平面的坐標(biāo)位置，rotation 是偏向角。

3D世界的位姿

六個自由度（x,y,z,yaw,pitch,roll)。（x,y,z） 是3D立體坐標(biāo)系中的位置坐標(biāo)， yaw(航向角）、pitch(俯仰角）、roll(傾斜角）分別代表目標(biāo)剛體繞z,y,x軸按照順序旋轉(zhuǎn)后的朝向姿態(tài)。

具體到自動駕駛和機器人，它們都是在一個平面上進行移動，雖然中間有顛簸，但是我們關(guān)注的是水平面上的位姿，上下的顛簸引起的位姿變更，可以投影到水平面上，這樣定位問題其實是2D位姿的估計問題，與之相對的如無人機就是3D定位問題。

理解定位，必須理解的另外一個概念就是參考基準(zhǔn)，通俗講就是相對誰的位置和姿態(tài)。我們舉生活中的例子，坐公交汽車，我們相對公交車位置幾乎是不變的，相對于馬路上的某個站牌是一直在變化的。更加嚴(yán)謹(jǐn)?shù)亩x是參考幀， 這個參考幀具化成視覺效果，是一個坐標(biāo)系，遵守右手法則，規(guī)定了在空間的零點位置和三叉戟坐標(biāo)軸方向。

在這里有一個非常有意思的地方，可以細(xì)細(xì)琢磨，定位是研究參考幀與參考幀的相對位置關(guān)系。當(dāng)我們向別人描述“我在哪里”的時候，其實是描述我作為主體的參考幀相對于某個地標(biāo)（如天安門），甚至地球這個主體參考幀的相對位姿描述，放到太陽系就不對了。雖然我們描述位置的時候，常常是忽略掉這個地球參考幀的，但那是建立在大家都有這個地球參考幀的共識下，去討論位置。這里還有一個引申的概念就是剛體，組成這個剛體的所有參考幀互相之間的相對位姿在任何時刻都是不變的。我們與天安門的相對位置，在任何時刻都可以使用一個固定的運算，因為天安門這個地標(biāo)隸屬于地球這個剛體。但如果使用這個運算去推算我們與月亮的相對位置，由于月亮與地球不在一個剛體上，且月亮繞著地球轉(zhuǎn)，所以任何時刻這個轉(zhuǎn)換關(guān)系都在變。

了解了位置的表征后，我們再來考慮機器人和自動駕駛的定位問題，其實它是要估計運動主體（機器人本身或者車輛）這個參考幀，相對于周遭靜止環(huán)境的位姿或者位姿變化， 這個周遭靜止的環(huán)境，我們可以統(tǒng)稱為世界坐標(biāo)系。移動定位問題，可以簡化為跟重力方向垂直的水平面上的2D位姿估計。 2D坐標(biāo)系的(0,0)點, 及x,y軸的朝向其實可以是任意的，只要基準(zhǔn)定好了，后面的參考不變即可。

對于自動駕駛，有一些細(xì)節(jié)需要補充， 我們熟知的定位（GPS）是經(jīng)緯度坐標(biāo)，如何對應(yīng)平面笛卡爾坐標(biāo)系呢？

經(jīng)緯度坐標(biāo)可以通過墨卡托投影系統(tǒng)（Universal Transverse Mercator，UTM）投影到UTM 的一個區(qū)塊中， 區(qū)塊中再細(xì)的位置可以看成一個2D平面使用笛卡爾坐標(biāo)進行表征， 這樣球面的經(jīng)緯度坐標(biāo)和平面坐標(biāo)是可以轉(zhuǎn)換的。

深圳市不止技術(shù)有限公司是激光雷達(dá)行業(yè)頭部知名企業(yè)，團隊自2016年底就開始了多款激光雷達(dá)方案的研發(fā)，并創(chuàng)造了30多件發(fā)明專利，我們作為激光雷達(dá)行業(yè)5年多的資深老兵，對激光雷達(dá)有著深厚的技術(shù)積累。是一家能提供單點、單線到多線全系列、dtof、itof全品類激光雷達(dá)方案定制化的公司，而且掌握了機器人移動底盤技術(shù)。在激光雷達(dá)核心硬件、專用芯片、AI算法上具有完整的自主知識產(chǎn)權(quán)。