![人形机器人(原书第2版)](https://wfqqreader-1252317822.image.myqcloud.com/cover/375/51975375/b_51975375.jpg)
上QQ阅读APP看本书,新人免费读10天
设备和账号都新为新人
2.1.3 基于一个局部坐标系定义另一个局部坐标系
在图2.4a中,Σa是作为基准的局部坐标系Σb。Σb是与小臂一起运动的局部坐标系,胳膊肘挺直的状态下坐标轴设定为和Σa平行。Σb的x、y、z方向的单位向量分别为。如果胳膊的回转角度是θ,那么
![](https://epubservercos.yuewen.com/210333/30719289307016706/epubprivate/OEBPS/Images/36_07.jpg?sign=1738890741-NtHyVl6hDY7SEOKJ4hNf4XP4W4Yuylnb-0-89acae9b3c31ea89076816f89dd356a2)
胳膊关节围绕y轴旋转,因此只有aebx和aebz会发生变化。此外,这些向量都以Σa为基准定义,因此左上方会加上字母a。
![](https://epubservercos.yuewen.com/210333/30719289307016706/epubprivate/OEBPS/Images/37_01.jpg?sign=1738890741-IJorFldZJsNHEsKnfuhOx32ceYMupr7z-0-10b7716aa80e10d4a4b98eface820ac7)
图2.4 大臂的局部坐标系Σa和小臂局部坐标系Σb
三个单位矩阵由以下矩阵aRb定义。
![](https://epubservercos.yuewen.com/210333/30719289307016706/epubprivate/OEBPS/Images/37_02.jpg?sign=1738890741-GeZT67B1OgHxyZ3waopbBaXshpV5norp-0-c11f02c3cd9f37059e003dd2a0309bdf)
从Σb的视角得到将手指位置bph(见图2.4a)转换为aph的公式。
![](https://epubservercos.yuewen.com/210333/30719289307016706/epubprivate/OEBPS/Images/37_03.jpg?sign=1738890741-TEqX5C057cxJ3iHivFerprNUSGAo21GM-0-9be6d24e71b268087a9beda850ac7a5b)
在这里,同次变换矩阵bTa有如下定义。
![](https://epubservercos.yuewen.com/210333/30719289307016706/epubprivate/OEBPS/Images/37_04.jpg?sign=1738890741-MLUIAnLeHRZDXS6Pbulgr4hwoLk6ZgD2-0-95b8829f234bdda4b23b102d18956044)
bpb是在Σa上观察到的Σb的原点。
把式(2.10)代入式(2.7),从Σb视角指尖位置在世界坐标系中指尖位置变换的式子可以从下式求得。
![](https://epubservercos.yuewen.com/210333/30719289307016706/epubprivate/OEBPS/Images/37_05.jpg?sign=1738890741-rAKAdu8ttumzjPsAPSgqVyjXCKYB83sP-0-0645c26b1adc6f76f3b6c01eef3cb14a)
把式(2.11)右边的同次变换矩阵的乘积归纳为Tb,可得
Tb≡TaaTb
矩阵Tb是一个以世界坐标系形式表示Σb的同次变换矩阵,可以用于表示大臂的位置和姿态。Ta会随着肩膀的旋转而变化,aTb是会随着手肘的旋转而变化,这很好地表现了Tb受到这两方面的影响。