【個人筆記】2-1 描述位姿

位置描述

建立坐標系后用一個 3×1 的位置矢量就可以確定坐標系當中的任何點位

image

用一個向量就可以表示,圖中的是 ^{A}P
位置矢量可以描述空間當中點的位置
^{A}P=\begin{pmatrix} p_{x}\\ p_{y}\\ p_{z} \end{pmatrix}

姿態(tài)描述

不僅要表示空間中點的位置,還要表示出空間中物體的姿態(tài)
于是定義兩個坐標系,分別是{A}和{B}

在機器人學導論這本書當中,坐標系用中括號{}來表示择浊,例如這個例子當中的{A}以及后面在計算連桿坐標系時的{0}、{1}

image

從圖中可以看到,整個{B}坐標系是從{A}旋轉(zhuǎn)再平移得到的氛谜,先研究旋轉(zhuǎn)的這一部分
通過對坐標系旋轉(zhuǎn)就可以表達機械臂的姿態(tài),定義一個旋轉(zhuǎn)矩陣為 _{B}^{A}R区端,通過這個旋轉(zhuǎn)矩陣可以實現(xiàn){B}再{A}上的表示值漫。{A}的三個單位矢量分別定義為 \hat{X}_{A}$$\hat{Y}_{A}$$\hat{Z}_{A} ,同理{B}的單位矢量也為 \hat{X}_{B}$$\hat{Y}_{B}$$\hat{Z}_{B}织盼,則可以表示旋轉(zhuǎn)矩陣 _{B}^{A}R 為{B}的三個單位矢量再{A}上的投影杨何,對于向量來說做投影就是進行點乘,所以可以表示為
_{B}^{A}R=(^{A}\hat{X}_{B},^{A}\hat{Y}_{B},^{A}\hat{Z}_{B})

^{A}\hat{X}_{B} 表示為{B}的 X 方向單位矢量在{A}的表示沥邻,既然是在{A}的表示肯定是一個向量危虱,所以是個 1×3 的向量,而整個旋轉(zhuǎn)矩陣是 3×3 的矩陣

具體進行計算時整個矩陣可以表示為
_{B}^{A}R= \begin{pmatrix} \hat{X}_{B}\cdot\hat{X}_{A}& \hat{Y}_{B}\cdot\hat{X}_{A} & \hat{Z}_{B}\cdot\hat{X}_{A} \\ \hat{X}_{B}\cdot\hat{Y}_{A}& \hat{Y}_{B}\cdot\hat{Y}_{A} & \hat{Z}_{B}\cdot\hat{Y}_{A} \\ \hat{X}_{B}\cdot\hat{Z}_{A} & \hat{Y}_{B}\cdot\hat{Z}_{A} & \hat{Z}_{B}\cdot\hat{Z}_{A} \end{pmatrix}
通過這種方式可以計算出{B}當中所有的單位向量在{A}當中的表示唐全,現(xiàn)在對這個矩陣進行轉(zhuǎn)置操作
_{B}^{A}R^T= \begin{pmatrix} \hat{X}_{B}\cdot\hat{X}_{A}& \hat{X}_{B}\cdot\hat{Y}_{A} & \hat{X}_{B}\cdot\hat{Z}_{A} \\ \hat{Y}_{B}\cdot\hat{X}_{A}& \hat{Y}_{B}\cdot\hat{Y}_{A} & \hat{Y}_{B}\cdot\hat{Z}_{A} \\ \hat{Z}_{B}\cdot\hat{X}_{A} & \hat{Z}_{B}\cdot\hat{Y}_{A} & \hat{Z}_{B}\cdot\hat{Z}_{A} \end{pmatrix}

點乘有交換律的埃跷,a\cdot b=b\cdot a

所以
_{B}^{A}R^T= \begin{pmatrix} \hat{X}_{A}\cdot\hat{X}_{B}& \hat{Y}_{A}\cdot\hat{X}_{B} & \hat{Z}_{A}\cdot\hat{X}_{B} \\ \hat{X}_{A}\cdot\hat{Y}_{B}& \hat{Y}_{A}\cdot\hat{Y}_{B} & \hat{Z}_{A}\cdot \hat{Y}_{B}\\ \hat{X}_{A}\cdot\hat{Z}_{B} & \hat{Y}_{A}\cdot\hat{Z}_{B} & \hat{Z}_{A}\cdot\hat{Z}_{B} \end{pmatrix} =_{A}^{B}R
所以對{B}對{A}的旋轉(zhuǎn)矩陣進行轉(zhuǎn)置就可以得到{A}對{B}的旋轉(zhuǎn)矩陣,即
_{B}^{A}R=_{A}^{B}R^T
這是旋轉(zhuǎn)矩陣的重要性質(zhì)
對于旋轉(zhuǎn)矩陣還有另外一個重要性質(zhì)邮利,即旋轉(zhuǎn)矩陣為正交矩陣

正交矩陣:一個矩陣 A 有 AA^T=E 或者是 A^TA=E 的性質(zhì)說明該矩陣為正交矩陣捌蚊,其中 E 為單位矩陣

_{B}^{A}R^T\ _{B}^{A}R=I_{3}
I_{3} 為 3×3 的單位矩陣
因此
_{B}^{A}R=_{A}^{B}R^{-1}=_{A}^{B}R^{T}

位姿描述

完整描述操作的位姿所需要的信息為兩個,一個是位置另一個是姿態(tài)近弟,在機器人學當中位置和姿態(tài)往往成對出現(xiàn)缅糟,于是將其組合為位姿,通過一個矢量例如 ^AP=(p_{x},p_{y},p_{z})^T 來表示位置祷愉,再用一個以三個矢量所構(gòu)成的旋轉(zhuǎn)矩陣 _{B}^{A}R 來表示姿態(tài)窗宦。
在后面的案例當中,表示位置常常用坐標系的原點位置二鳄,即 ^AP_{BORG}

BORG 分兩部分赴涵,一部分是 B 代表坐標系,另一部分是 ORG 代表原點订讼。例如坐標系{0}的原點位置為 0 ORG

那么位姿{B}可以通過 ^AP_{BORG}_{B}^{A}R 確定髓窜,即:
\{B\}=\{_{B}^{A}R,^{A}P_{BORG}\}
下面對位姿的圖解表示法進行介紹,圖解表示法是通過圖示的方式說明位姿,如下圖

image

在圖中寄纵,世界坐標系當中存在三個位姿鳖敷,已知位姿{A}和位姿{B}相對于世界坐標系的關(guān)系以及位姿{C}相對于位姿{A}的關(guān)系。
在圖中使用圖示的方式對位姿進行說明程拭,每個位姿可以通過三個標有箭頭的單位矢量來描述定踱,定義位子的三根主軸。在圖中可以看到從一個原點指向另一個原點的箭頭恃鞋,即圖中藍色箭頭崖媚,這個矢量表示箭頭處原點相對于箭尾處原點的位置,箭頭方向表示相對的方向恤浪,例如在圖中是{C}相對于{A}而不是{A}相對于{C}

總結(jié)

為了避免與后面的概念混淆畅哑,進行簡單的總結(jié),對于位姿的描述需要注意的幾個點

  • 機器人操作臂的姿態(tài)各異水由,通過操作臂坐標系與其他坐標系相對比旋轉(zhuǎn)角度來描述操作臂的姿態(tài)
  • 操作臂也有相對于其他坐標系的移動荠呐,也就是平移,其運動的量無非就是一個三維的矢量绷杜,參數(shù)也就是 xyz 這三個
  • 把旋轉(zhuǎn)后的姿態(tài)和平移的方向與距離進行描述就可以描述出操作臂的在空間中的特性
  • 后面會講到坐標的映射與算子,計算的方式和這一節(jié)的內(nèi)容差不多濒募,但是概念完全不同
    • 位姿描述說的是如何描述操作臂在空間的狀態(tài)
    • 下一節(jié)映射說的是一個坐標系上的點在另外一個坐標系上的表示鞭盟,是一個相同的量在不同坐標系下的表達
    • 算子說的是在同一個坐標系下的旋轉(zhuǎn)平移操作,類似于 3D 軟件當中將一個方塊進行 Translate 和 Rotate 操作
最后編輯于
?著作權(quán)歸作者所有,轉(zhuǎn)載或內(nèi)容合作請聯(lián)系作者
  • 序言:七十年代末瑰剃,一起剝皮案震驚了整個濱河市齿诉,隨后出現(xiàn)的幾起案子,更是在濱河造成了極大的恐慌晌姚,老刑警劉巖粤剧,帶你破解...
    沈念sama閱讀 219,539評論 6 508
  • 序言:濱河連續(xù)發(fā)生了三起死亡事件,死亡現(xiàn)場離奇詭異挥唠,居然都是意外死亡抵恋,警方通過查閱死者的電腦和手機,發(fā)現(xiàn)死者居然都...
    沈念sama閱讀 93,594評論 3 396
  • 文/潘曉璐 我一進店門宝磨,熙熙樓的掌柜王于貴愁眉苦臉地迎上來弧关,“玉大人,你說我怎么就攤上這事唤锉∈滥遥” “怎么了?”我有些...
    開封第一講書人閱讀 165,871評論 0 356
  • 文/不壞的土叔 我叫張陵窿祥,是天一觀的道長株憾。 經(jīng)常有香客問我,道長晒衩,這世上最難降的妖魔是什么嗤瞎? 我笑而不...
    開封第一講書人閱讀 58,963評論 1 295
  • 正文 為了忘掉前任墙歪,我火速辦了婚禮,結(jié)果婚禮上猫胁,老公的妹妹穿的比我還像新娘箱亿。我一直安慰自己,他們只是感情好弃秆,可當我...
    茶點故事閱讀 67,984評論 6 393
  • 文/花漫 我一把揭開白布届惋。 她就那樣靜靜地躺著,像睡著了一般菠赚。 火紅的嫁衣襯著肌膚如雪脑豹。 梳的紋絲不亂的頭發(fā)上衡查,一...
    開封第一講書人閱讀 51,763評論 1 307
  • 那天俱饿,我揣著相機與錄音塌忽,去河邊找鬼土居。 笑死,一個胖子當著我的面吹牛棉圈,可吹牛的內(nèi)容都是我干的分瘾。 我是一名探鬼主播吁系,決...
    沈念sama閱讀 40,468評論 3 420
  • 文/蒼蘭香墨 我猛地睜開眼氏捞,長吁一口氣:“原來是場噩夢啊……” “哼冒版!你這毒婦竟也來了?” 一聲冷哼從身側(cè)響起捆等,我...
    開封第一講書人閱讀 39,357評論 0 276
  • 序言:老撾萬榮一對情侶失蹤,失蹤者是張志新(化名)和其女友劉穎谒养,沒想到半個月后明郭,有當?shù)厝嗽跇淞掷锇l(fā)現(xiàn)了一具尸體,經(jīng)...
    沈念sama閱讀 45,850評論 1 317
  • 正文 獨居荒郊野嶺守林人離奇死亡始绍,尸身上長有42處帶血的膿包…… 初始之章·張勛 以下內(nèi)容為張勛視角 年9月15日...
    茶點故事閱讀 38,002評論 3 338
  • 正文 我和宋清朗相戀三年亏推,在試婚紗的時候發(fā)現(xiàn)自己被綠了吞杭。 大學時的朋友給我發(fā)了我未婚夫和他白月光在一起吃飯的照片芽狗。...
    茶點故事閱讀 40,144評論 1 351
  • 序言:一個原本活蹦亂跳的男人離奇死亡译蒂,死狀恐怖,靈堂內(nèi)的尸體忽然破棺而出炎辨,到底是詐尸還是另有隱情碴萧,我是刑警寧澤,帶...
    沈念sama閱讀 35,823評論 5 346
  • 正文 年R本政府宣布,位于F島的核電站盟榴,受9級特大地震影響曹质,放射性物質(zhì)發(fā)生泄漏。R本人自食惡果不足惜羽德,卻給世界環(huán)境...
    茶點故事閱讀 41,483評論 3 331
  • 文/蒙蒙 一、第九天 我趴在偏房一處隱蔽的房頂上張望宅静。 院中可真熱鬧章蚣,春花似錦姨夹、人聲如沸纤垂。這莊子的主人今日做“春日...
    開封第一講書人閱讀 32,026評論 0 22
  • 文/蒼蘭香墨 我抬頭看了看天上的太陽。三九已至够颠,卻和暖如春熙侍,著一層夾襖步出監(jiān)牢的瞬間蛉抓,已是汗流浹背巷送。 一陣腳步聲響...
    開封第一講書人閱讀 33,150評論 1 272
  • 我被黑心中介騙來泰國打工笑跛, 沒想到剛下飛機就差點兒被人妖公主榨干…… 1. 我叫王不留,地道東北人飞蹂。 一個月前我還...
    沈念sama閱讀 48,415評論 3 373
  • 正文 我出身青樓陈哑,卻偏偏與公主長得像,于是被迫代替她去往敵國和親伸眶。 傳聞我的和親對象是個殘疾皇子惊窖,可洞房花燭夜當晚...
    茶點故事閱讀 45,092評論 2 355

推薦閱讀更多精彩內(nèi)容