機(jī)器人機(jī)構(gòu)學(xué)基礎(chǔ) 部分習(xí)題及答案

機(jī)器人機(jī)構(gòu)當(dāng)基砒

部分習(xí)題解答

第1章

緒論

1-1制作一個(gè)年表，記錄工業(yè)機(jī)器人發(fā)展的主要事件。

略

1-2制作一個(gè)年表，記錄并聯(lián)機(jī)器人發(fā)展的主要事件。

略

1-3查閱文獻(xiàn)，試回答連續(xù)體機(jī)器人與軟體機(jī)器人有何區(qū)別。

答：連續(xù)體機(jī)器人是一種新型仿生機(jī)器人,它模仿自然界中象鼻、章魚臂等動(dòng)物器官的運(yùn)動(dòng)機(jī)理，自身不存

在運(yùn)動(dòng)關(guān)節(jié),但能依靠連續(xù)柔性變形來(lái)實(shí)現(xiàn)運(yùn)動(dòng)和抓取操作。由于連續(xù)體機(jī)器人可在任意部位產(chǎn)生柔性變形,

所以具有很強(qiáng)的避障能力,能夠更好地適應(yīng)非結(jié)構(gòu)環(huán)境、更牢靠地抓取各種不規(guī)則形狀的物體。因此它是對(duì)

傳統(tǒng)關(guān)節(jié)式機(jī)器人的補(bǔ)充,具有潛在的應(yīng)用價(jià)值。

摘自：謝世鵬,倪風(fēng)雷,王海榮,金明河.連續(xù)體機(jī)器人形狀檢測(cè)方法綜述[J].機(jī)械與電子,2015,(08):68-71.

軟體機(jī)器人是機(jī)器人領(lǐng)域的一個(gè)熱點(diǎn)，并被學(xué)術(shù)界視為一種最可能成為新一代機(jī)器人的發(fā)展方向，甚

至在工業(yè)領(lǐng)域的應(yīng)用和對(duì)社會(huì)革命的影響都非常廣泛。軟體仿生機(jī)器人通常由軟體材料制作，與環(huán)境交互

時(shí)，相比剛性機(jī)器人擁有更好的柔順性和適應(yīng)性。學(xué)者們正在進(jìn)行相關(guān)的的研究，意在從根本上解決了機(jī)

械手與人和環(huán)境相互作用的問(wèn)題，為解決復(fù)雜環(huán)境適應(yīng)性差、靈活性差等提供了新的思路和方向。

摘自：褚凱梅，趙虎，馮凱，吳杰，朱銀龍.軟體仿生機(jī)器人研究現(xiàn)狀[J].林業(yè)機(jī)械與木工設(shè)

備，2021,49(11):4-10+16.DOI:10.13279/j.cnki.fmwe.2021.0143.

1-4查閱文獻(xiàn)，試給出在機(jī)器人機(jī)構(gòu)創(chuàng)新方面做出重要貢獻(xiàn)的10個(gè)重要人物。

略

1-5查閱文獻(xiàn)，試給出在機(jī)器人機(jī)構(gòu)學(xué)理論方面做出重要貢獻(xiàn)的10個(gè)重要人物。

略

1-6查閱文獻(xiàn)，試給出目前能代表機(jī)器人水平的10個(gè)機(jī)器人產(chǎn)品。

略

1-7查閱文獻(xiàn)，試給出目前能代表機(jī)器人機(jī)構(gòu)學(xué)研究水平的10個(gè)實(shí)驗(yàn)室名稱。

略

1-8"機(jī)器人三原則”由誰(shuí)提出，具體內(nèi)容如何表述？

答：該原則最早在阿西莫夫的《我，機(jī)器人》中提出，阿西莫夫?yàn)檫@本書新寫了《引言》，而《引言》的小

標(biāo)題就是《機(jī)器人學(xué)的三大法則》，把“機(jī)器人學(xué)三大法則”放在了最突出、最醒目的地位。而三大法則之

間的互相約束，為后世的創(chuàng)作有一定的指導(dǎo)意義。

三大法則具體表述如下：

?機(jī)器人不能傷害人類，也不能在人類受到傷害時(shí)袖手旁觀；

?機(jī)器人必須服從人類命令，除非這些命令與第一條原則相沖突；

?在不違背第一、二條原則的前提下，機(jī)器人必須保護(hù)自己免受傷害。

第2章

■

數(shù)學(xué)知識(shí)

2-1證明所有經(jīng)過(guò)坐標(biāo)原點(diǎn)。的線矢量必然滿足？=Q=R=O。

2-2計(jì)算經(jīng)過(guò)點(diǎn)n(1,1,0)和點(diǎn)n(-l,1,2)的直線的Pliicker坐標(biāo)，并正則化該線矢量。

2-3計(jì)算經(jīng)過(guò)點(diǎn)r(l,l,0)且直線軸線的方向余弦為(-1,1,2)的直線Plucker坐標(biāo)，并正則化該線矢量。

FLA，、"，，———J-jτ

b?∣.正即化Y斗仁//,七丁J

T/.?二(，/，。)平,我苧兀(9,里切

［做3冬上珍)______________________

2-4填空：補(bǔ)充空格的數(shù)值，使之表示一條直線(或線矢量)。

⑴(1,2,_;0,-1,-2)

(2)(2,0,2;0,_,0)

⑶(1,_,0；0,0,0)

⑷0,0,1)

2-5確定以下兩條直線之間公法線的長(zhǎng)度與夾角。

(I)λ1=(l,0,-nθ,l∕√2,θ)>L,=(0,0,1;6,0,0)

(2)t1=(-1,0,^0,-1/72,0),4=((),(),1;40,0)

2-6填空：補(bǔ)充空格的數(shù)值，使之表示一個(gè)滿足特定節(jié)距的旋量。

(1)(1,0,0;_,0,0).h=?

(2)(1,0,0;1,_,0).Λ=l

(3)(1,0,0;1,O),Λ=1O

(4)(l,_,O;l,O,O),A=I

fjft/，從QLM好6

2-7證明旋量的節(jié)距是原點(diǎn)不變量。

2-8當(dāng)旋量與其自身互為反旋量時(shí)稱為自互易旋量(Self-reciprocalscrew)。試證明自互易旋量有且只有線

矢量和偶量?jī)煞N類型。

證福.吸九無(wú)性族量，若為級(jí)留姆重旃％

一39/O(S、5)十(y-γ)d")一一________

T~)OJA0_____

一?政八°asJ二。旦pJr_________

?>O"餞矢盤或?yàn)榧賢

；型也■必舒科M小廿”3+Cf地”)

R?為《二&)JK_

則*?尸(Hth)化J)MSXL"SX3(”9"----------

"二"3一一一------------

,網(wǎng)曰…----------------

_.嫁古攵上穿的姆篆右健倜的整包是儀自有旦勇技健熄.如---偶---篁---.-------------------

從射影幾何的角度來(lái)看，偶量可看作是處于無(wú)窮遠(yuǎn)處的線矢量。試從極限的角度證明之。

2-9

2-10填空：補(bǔ)充空格的數(shù)值，使之表示一個(gè)單位旋量，并確定該旋量的節(jié)距和軸線坐標(biāo)。

⑴(l∕√2,0,-jl,0,1)

I(2)(3∕5√2,4/5^,_；0,-5/4.1)

η

稚軸4族r量--jχ0j,/:2也,0-.3,0".39+-3靠)，>節(jié)跖h：fj."〃依

2-H試給出圖2-12所示單位正方體中12條邊所對(duì)應(yīng)單位線矢量的旋量坐標(biāo)表達(dá),參考坐標(biāo)系如圖中所示。

ffΛ√*`jf∕υ6f〃母N；。_

白(弛0N,-m∕j

時(shí)篌Y二的.:B-凡爐--------------------------

牽收族電力C，'/用.■八二5￡切-

車由SAY二以￡=(七3/a)7-

.<P(?Λ^;-------------------------A

LWgl放詞"“斗夕

I單用螳J★,?為1/川棲kg阻

圖2-12單位正方體

2-12試給出單位正方體中12條邊所對(duì)應(yīng)單位偶量的旋量坐標(biāo)表達(dá)，參考坐標(biāo)系如圖2-10所示。

2-13旋量系的互易性滿足坐標(biāo)系無(wú)關(guān)性(frameinvariant)。試證明：旋量系的互易積與坐標(biāo)系的選擇無(wú)關(guān)。

2-14旋量系的階數(shù)滿足坐標(biāo)系無(wú)關(guān)性(frameinvariant)。試證明：旋量系的階數(shù)與坐標(biāo)系的選擇無(wú)關(guān)。

第3章

位姿描述與剛體運(yùn)動(dòng)

3-1一矢量P繞ZA軸旋轉(zhuǎn)30。，然后繞XA軸旋轉(zhuǎn)45。，求按上述順序旋轉(zhuǎn)后得到的旋轉(zhuǎn)矩陣。

答：

R=R（X,45）R（z,30）

100使-10

22

√2√2

n1且0

2222

n√2√2

0——001

22

-^

2----U

^2

--√6_72

4-

-^Vv

4√6√2

V^T

3-2物體坐標(biāo)系｛B｝最初與慣性坐標(biāo)系｛A｝重合，將坐標(biāo)系｛B｝繞ZB軸旋轉(zhuǎn)30。，再繞新坐標(biāo)系的XB軸旋轉(zhuǎn)

45。，求按上述順序旋轉(zhuǎn)后得到的旋轉(zhuǎn)矩陣。

答：

'cos（30）（）

-Sin300、\00

Sin（30）COS（30）00cos（45）-Sin（45）

0010Sin（45）COS（45）,

√3√2也、

COS（30）_Sin（30）cos（45）Sin（30）sin（45）、V4

?√6_76

sin（30）COS（30）cos（45）-COS（30卜in（45）

244

0sin（45）CoS（45）,√2√2√2

222;

3-3在什么條件下，兩個(gè)旋轉(zhuǎn)矩陣可以交換順序？

答：一般情況對(duì)于既有原點(diǎn)平移和姿態(tài)改變的變換是不滿足交換律的，只有在特殊情況下如：繞同一

坐標(biāo)軸進(jìn)行連續(xù)旋轉(zhuǎn)偏移，或者其中?個(gè)矩陣是單位矩陣時(shí)，旋轉(zhuǎn)矩陣可以交換。

3-4如果旋轉(zhuǎn)角度足夠小，任意兩個(gè)旋轉(zhuǎn)矩陣是否可以交換？

答：可以，角度足夠小時(shí)，結(jié)果與轉(zhuǎn)動(dòng)順序無(wú)關(guān)。

3-5假設(shè)一個(gè)剛體內(nèi)嵌有兩個(gè)單位矢量，試證明，無(wú)論剛體如何旋轉(zhuǎn)，兩個(gè)矢量的夾角保持不變。

答：設(shè)兩向量為P，4,令旋轉(zhuǎn)軸為Z軸建立坐標(biāo)系8,已知ZiMa,仇C)BqS,e,/),已知

坐標(biāo)軸旋轉(zhuǎn)角度為夕，則

cosθ-Sine0

R=sin。CoSe0

001

此時(shí)p,q夾角為

BB_ad+be+Cf

p'q~∕a2+b2+c2+^+e2+f2

A坐標(biāo)系下AP坐標(biāo)為

CoSe-Sine0^aacosθ-bsinθ

sin6CoSeOb々sin。+/?COSe

001c

同理，q坐標(biāo)為

dcos。一esin6

dSine+ecos6

_f_

此時(shí)

AP?AQ

_adcos2θ+besin2θ+adsin20÷?ecos2θ+cf

222212

y∣(acosθ-bsinθ)+(as?nθ+bcosθ)+c+?/(t/eos^-esin^)+(ds?v?θ+ecosθ)+f

_ad+be+cf

yja2+b2+c2÷y∣d~+e~+f2

="PA

由單位向量可知，單位向量點(diǎn)乘，結(jié)果為兩向量p,9夾角余弦值，所以兩矢量的夾角保持不變。

3-6證明任何旋轉(zhuǎn)矩陣行列式的值恒等于1。

證：由題意，假設(shè)有兩個(gè)坐標(biāo)系A(chǔ)和B及其中的6個(gè)相互正交的單位向量EPtPZzpSs，工，28,則由

定義可得

*=(ASBAyBA與)=抑

考慮到｛B｝系坐標(biāo)軸的三個(gè)單位向量都滿足相互正交、且模長(zhǎng)為1,由此可以導(dǎo)出

f4?∩

W?:R=λyτ(A?A%ΛZ)=!

UvβJB3X3

兩邊同時(shí)取行列式可得

det。R)=I

得證(姿態(tài)矩陣的行列式等于對(duì)應(yīng)旋轉(zhuǎn)矩陣的行列式值)

3-7證明KRT和RTR都是反對(duì)稱矩陣。

證：以R-P—丫角為例

W=WW記)

法/卑<與■]=(或X/①汴然成Xs)=Q然R

atatat)x'

根據(jù)歐拉旋轉(zhuǎn)定理，假設(shè)繞左軸轉(zhuǎn)過(guò)A0,當(dāng)Aa足夠小時(shí)，角度與旋轉(zhuǎn)順序無(wú)關(guān)，因此可矢量合成

Na=?ɑ,+?αv+?α.

ClbaX

------=ωxλ+69yλ+0,z

dtxvy2

則

'O-OLω、

Zyv

Qt=CD二O-COx

Iy40,

為反對(duì)稱矩陣

則顯然

:R：RT=QKR：K

為反對(duì)稱矩陣。而對(duì)于B

AR':R

Bp-lBp_Br>I(?βBR—BRTcBBR

AKA?-%口4A"

由其對(duì)稱性可知其乘積為反對(duì)稱矩陣，也可計(jì)算驗(yàn)證得到。

3-8求解姿態(tài)矩陣R的特性：

(1)求解姿態(tài)矩陣R的特征值，并求與特征值為1對(duì)應(yīng)的特征向量;

r

(2)令姿態(tài)矩陣R=(Or.)，試證明del(R)=η(4χC3);

(3)證明姿態(tài)矩陣K滿足R〃=(R[〃]RT『。

答：(1)使用Z-Y-Z歐拉角表示旋轉(zhuǎn)矩陣

cφcθcψ-sφsψ-cφcθsψ-sφcψcφsθ

Rsφcθcψ+cφsψ-sφcθsψ+cφcψsφsθ

-sθcψsθsψcθ

cφcθcψ-sφsψ-a-cφcθsψ-sφcψcφsθ

IR-0/1=sφcθcψ+cφsψ-sφcθsψ+cφcψ一asφsθ

-sθcψsθsψcθ-a

=^cφcθcψ-sφsψ-a^-sφcθsψ+cφcψ-a^^cθ-a)-sθsψsφsθy

-(-cφcθsψ-sφcψ)?j?sφcθcψ+cφsψ)(Co-4)-{-sθcψsφsθ^

+cφsθ"sφcθcψ+cφsψ)sθsψ-{-sφcθsψ÷cφcψ一a)(一SeC夕)]

{cφcθcψ-sφsψ-a)[-c2θsφsψ+cφcθcψ-acθ+acθsφsψ-acφcψ+a?-s2θsψsφ^

+(cφcθsιμ+sφcψ)ysφc~θcψ+cφcθsψ+cψs~Θsφ^

Λ-[cφsθ)^cθcψsφsθsψ+cφsθs2ψ-cψcθsφsψsθ+cφc2ψsθ^=0

觀察上式為關(guān)于特征值。的3次方程，可以在復(fù)平面求出3個(gè)解析解。將其表示成關(guān)于3個(gè)轉(zhuǎn)角的數(shù)學(xué)

通式太過(guò)復(fù)雜，實(shí)際問(wèn)題中可以代入實(shí)際角度進(jìn)行數(shù)值計(jì)算。

考慮其特征值L利用R的性質(zhì)

RRr=R1R=X

.?.det(7?)=det(/?-')=1

???det(/?-/)

=det[(/?-7)7]

=det(∕?7-7)

=det(/?-1-7)

=det

=det(7?')det(Z-/?)

=det("R)

=(-l)3det(T?-/)

=-det(R-1)

.?.det(R-∕)=0

所以R?定有特征值工，其對(duì)應(yīng)特征向量同樣可以在實(shí)際問(wèn)題中通過(guò)數(shù)值計(jì)算求出

R=電f^22t^32

t

[乙323?>

r22丫32f2?Gl為1GI

det(R)=J一，2+

f23r33f23,22?2

ir2?Gl

^22z32_z3lr2}41

r

4(弓XG)=(J色G)J22r32=生+%

z23???f23z33r22,32

kG公

證畢

(3)略

3-9已知一剛體的齊次變換矩陣

?√3∕2-1/2O2、

∣∕20/2O4

OO1O

?°OO

試求解該變換的逆變換r」。

答：

(Rr-Rτp}

其中

r√[

--O

22

?BO

R=

22

OO1

7

因此可知

?O

22

I-，2、(6+2、

-1√3

RTP=O4=2上-1

?Z?

OO

I7

OO1

√

解得

?

0-√3-2

22

-1√3

TT=0-2√3+l

22

0010

k0001

3-10證明平面齊次變換矩陣(Pkmarhomogenoustransformationmatrix)滿足

‘cosα-SinaXQ-xpcosa+ypsina

D=SinaCOSayQ-ypsina-ypcosa

`θθ1)

答：假設(shè)點(diǎn)P經(jīng)過(guò)平移變換得到點(diǎn)B,點(diǎn)6經(jīng)過(guò)旋轉(zhuǎn)變換得到坐標(biāo)系｛。｝

'R

PQ~RPP+PBORG

其中

(coSa-sine、

R=.

`sinɑcosσJ

(XQ)'cosα-sinaVxpΛ(XQ-XPCoSa+%sinc'

`sinɑCoSa(y0-尤PSina一力cos%

則

y

,cosα一SinaXQ-xpcosa+yps?na

'RPBORG'

—

D=SinaCoSayQ-xpsina-ypcosa

,\01

<°01>

3-11已知?jiǎng)傮w繞Z軸方向的軸線旋轉(zhuǎn)30。，且軸線經(jīng)過(guò)點(diǎn)(1,1,O)T,求物體坐標(biāo)系｛B｝相對(duì)慣性坐標(biāo)系｛A｝的

位形。

答：設(shè)慣性坐標(biāo)系為A系，固聯(lián)在剛體上的坐標(biāo)系為B系，定義兩個(gè)中間坐標(biāo)系A(chǔ)'和B',它們的

姿態(tài)分別與A、B系相同，它們的原點(diǎn)在(11O)',令A(yù)'系與A系固聯(lián)，B'系與5系固聯(lián)，則

017

?

f√3?

0

2^2

cos30-sin300、

?√3

:R=sin30cos300=0

2V

001,

0o1

√

r

"匕。KG=(IIo)

則

f√31n3-61

222

AT?VS,,1—5/3

J=—-0--------

222

OOlO

.0001,

此即為所求齊次變換矩陣。

3-12已知?jiǎng)傮w繞X軸方向的軸線旋轉(zhuǎn)30。，且軸線經(jīng)過(guò)點(diǎn)(),0,1),求物體坐標(biāo)系｛B｝相對(duì)慣性坐標(biāo)系｛4｝

的齊次變換矩陣。

答：設(shè)慣性坐標(biāo)系為A系，固聯(lián)在剛體上的坐標(biāo)系為3系，定義兩個(gè)中間坐標(biāo)系A(chǔ)'和B',它們的

姿態(tài)分別與A、B系相同，它們的原點(diǎn)在(1。1)7，令A(yù)'系與A系固聯(lián)，8'系與3系固聯(lián)，則

fARA

B/-網(wǎng)PA:ORG

JA=

01

?

00

I00

√3

0cos30-sin300

^2^~2

0sin30cos30

/?√3

0

2

OKG=(I0ι)r

則

<1000

0且??

2^22

BT=

0?1.走

222

10001Z

此即為所求齊次變換矩陣。

3-13已知一機(jī)器人末端工具中心點(diǎn)為p<>,求：經(jīng)過(guò)機(jī)器人的一般運(yùn)動(dòng)變換（旋轉(zhuǎn)餐.,和平移PMI）以后點(diǎn)

P的表達(dá)，并寫出其逆變換矩陣表達(dá)。

答：已知旋轉(zhuǎn)矩陣和平移矩陣，3xl，則該變換的齊次變換矩陣為

則運(yùn)動(dòng)變換后的點(diǎn)P表達(dá)式為

逆變換的旋轉(zhuǎn)矩陣

R=R7

?3

逆變換的平移矩陣

P=-R〃3xi=-乩“3x1

故逆變換的齊次變換矩陣為

3-14當(dāng)前工業(yè)機(jī)器人領(lǐng)域經(jīng)常要定義4種坐標(biāo)系：慣性坐標(biāo)系仍｝、末端或工具坐標(biāo)系｛口、圖像坐標(biāo)系｛C｝

和工件坐標(biāo)系｛W｝,如圖3-51所示。

圖3?51工業(yè)機(jī)器人

(1)基于圖中所給尺寸，試確定⑦和/;

U004、

(2)若7τO100,試求7。

a

O010

O001

'ιoo-P'0100、

OlOl1000

答：（1）。丁=，wT=

OOlO00-12

、°°01,、000ι?

'010-1、

100-3

(2)BT=

I00-12

、0001;

3-15試證明三次繞固定坐標(biāo)軸XY-Z旋轉(zhuǎn)的最終姿態(tài)與以相反順序三次繞運(yùn)動(dòng)坐標(biāo)軸x-y-z旋轉(zhuǎn)的最終姿

態(tài)相同，即Rzyx（a,β,γ）=Rιyχ（χ,夕,α）。

答：繞固定軸（絕對(duì)變換，連續(xù)左乘），先X軸轉(zhuǎn)α,再Y軸轉(zhuǎn)夕，最后繞Z軸轉(zhuǎn)/的旋轉(zhuǎn),

其旋轉(zhuǎn)矩陣

cosβcosysinasinβcosγ-cosasinγcosasinβcos/+sinσsinγ

R=RZ⑺Rγ(a)Rχ(a)=cosβsinγsinαsinQSinγ+cosacosγcosasin尸Siny-sinacosγ

-sinβsinacosγCoSaCOSr

繞自身軸（相對(duì)變換，連續(xù)右乘）

COS/-sin/O-cosβ0sin∕7"^100

R=RM邸=RZ⑺R,(f)Rχ(a)=sin/cos/00100cosa一Sina

00?-sinβ0COSyff0sinaCOSa

CoSPCOSrsinasinβcosγ-cosasinγcosasinβcos/+sinasinγ

COS/7Sinysinasin∕7sin/+cosacosγcosasin夕Siny-sinacosγ

-sinyffsincrcosycosacosγ

可以看到二者是等價(jià)的。

3-16在描述空間剛體姿態(tài)的各種方法中，歐拉角描述被稱為是一種局部參數(shù)的描述方法。以Z-X-Z歐拉角

為例，試證明當(dāng)。=0時(shí)，姿態(tài)矩陣奇異。

答：注：題目有誤，若按θ“）旋轉(zhuǎn)，當(dāng)。=0時(shí)，姿態(tài)矩陣不可能奇異，故推測(cè)應(yīng)為證

明6=0時(shí)，姿態(tài)矩陣奇異。

證明過(guò)程如下：

（1）當(dāng)。=0時(shí),

RKz?(。,aψ)=RZg)RNe)R人W)

'iOoYι00](cψsψ0、

—OlOoce-招sψcψ0

100"

?01JIkOSecθ)

(cψsψ0、

=cθsψcθcψ-sθ

~sθsψsθcψcθ)

可以求出。和”的確定解，故姿態(tài)矩陣無(wú)奇異狀態(tài)。

(2)當(dāng)。=0時(shí)

R“(06⑺=旦(。)&(0)0(⑺

cφ-sφ0、勺0OVcψ-sψ0、

=sφcφ金OloWO

IOOj1001

N°ι>?

cφcψ-sφsψ-cφsψ-sφcψ0、

=sφcψ+cφsψ-sφsψ+cφcψ0

、001?

'c(φ+ψ)-5(。+〃)0、

=s<φ+ψ)c{φ-?-ψ)0

1001?

這是只能求出。與〃的和，故姿態(tài)矩陣奇異。

3-17在歐拉角的定義中，連續(xù)旋轉(zhuǎn)總是基于正交(坐標(biāo))軸來(lái)進(jìn)行的，這種限制是否是必須的？

答：不是的，是為了方便計(jì)算，因?yàn)檎惠S里各軸互不干涉。

3-18已知姿態(tài)矩陣

,√3∕2-1/2O'

R=√3∕43/4-1/2

1/4同4√3∕2

求與之等效的Z-X-Z歐拉角。

答：由姿態(tài)矩陣

f√3?O

22

√3

R=_1

T42

?√3√3

4T

/

得

Z—Y—Z歐拉角：(SineW0),兩組解

e=Atan2圖考

,

?7θ=30

φ=Afa〃2（一g,θ）

,e∈（o,%）=.Φ=-90

ψ=120

ψ=Atanl——4，——

I4J

夕=—30

￠=4a〃2（；,0

,e∈（-%,0）=?￠=90

ψ=-60

ιι∕=A.tcinI2---4--,一4J

Z-Y-X歐拉角：(CoSe≠o),兩組解

6=—14.48

4K）

φ=ManL—,。€（0,萬(wàn)）=<￠=26.57

ψ=26.57

6=—165.5

φ=AtanZ---,6∈（-肛0）=<0=-153.4

-=—153.4

3-19已知姿態(tài)矩陣

r?OO'

R=O√3∕2-1/2

?01/275/2,

求與之等效的R-P-Y角。

答：因?yàn)?/p>

θ=+看)=A2(0,VΓ+0)=0≠-^?

所以存在兩組解。

D第一組解

6=0

<φ=Atan2^r2］+?j?)=Atan2(0,1)=0

ψ=Atan2(^2,^3)=Atan2=30

2)第二組解

=A∕6ZH2(0,—Jl+0)=—180

φ-4〃〃2(-弓］,一。］)=Amn2(0,-l)=-180

ψ=Atan{-r,2-r^=Atan=-150

3-20已知姿態(tài)矩陣

‘010、

R=00-1

-?θθ?

求與之對(duì)應(yīng)的等效軸-角及相應(yīng)的歐拉參數(shù)。

答：直接代入

￡。=；/+々+々+/

可得其歐拉參數(shù)為:

1111

因此該姿態(tài)矩陣的單位四元數(shù)為：

再將姿態(tài)矩陣代入式(4.133)和式(4.135)中，可得等效軸-角為:

3-21T&T(Tilt&Torsion)是加拿大學(xué)者BeneV提出的一種描述剛體姿態(tài)的方法，它實(shí)質(zhì)上是一種修正的

Z-KZ歐拉角。如果某類機(jī)構(gòu)在運(yùn)動(dòng)過(guò)程中始終滿足Torsion角為零，該機(jī)構(gòu)稱為零扭角機(jī)構(gòu)(zero-

torsionmechanism)?試通過(guò)查閱文獻(xiàn)，找出3~5種零扭角機(jī)構(gòu)的例子。

答：略

3-22試證明相似變換

&(，)=旦(O)K.(6>)El3)=KNdθ,-φ)

答：已知姿態(tài)矩陣為正交矩陣，有

Μ(。)=用3)

則可以得到

‘cos一0-sin-00、’cos。Sino0]

凡(一￠)=Sin一°COS一?0二-sinCoSo0

;00IJLo01>

所以

aKO，。,—。)=R人φ)R?(θ)R人f=Rv)Ry(θ)W'(φ)

等式右邊得證

由于

'c2φcθ+s~φcθsφcφ-sφcφcφsθ

22

RZVZ（0。,-￠）-cθsφcφ-sφcφcθsφ+cφsφsθ

-sθcφsθsφcθ

轉(zhuǎn)換為等效轉(zhuǎn)軸和轉(zhuǎn)角為

θ=cos-1+寸3-1)=CoST(浮>°

(G2一(—2sin°si∏e)j—sin^、

a=--------%-4ι=--------2cossin=cos。

2sin^2sin

<r2?~~r?2)?θ√?θ>

即存在使得等式左邊得證。

Ra(e)

綜上

凡(夕)=RZe)R?(θ)R[(φ)=Ra,aw

證畢

3-23若姿態(tài)矩陣

'一20、

R=%r22r23

?G1f32

能用只具有兩個(gè)參數(shù)的歐拉角來(lái)描述，即