机器人学蔡自兴课后习题答案
机器人学蔡自兴课后习题答案解析
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解： 坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ；
对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥⎥⎥⎥⎦
⎤⎢⎢⎢⎢⎣⎡=100001005010000102T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=10
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解：Θ坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ； 对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10000100501000010
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解：Θ坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ；
对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10000100501000010
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
【精品】机器人学蔡自兴课后习题答案
【关键字】精品
其余的比较简单，大家可以自己考虑。
3. 坐标系的位置变化如下：初始时，坐标系与重合，让坐标系绕轴旋转角；然后再绕旋转角。给出把对矢量的描述变为对描述的旋转矩阵。
解：坐标系相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变换顺序为依次右乘。
对描述有；
其中。
9. 图2-10a示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。
（3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系、，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：；
对楔块2进行的变换矩阵为：
；
其中；
所以：；
对楔块2的变换步骤：
①绕自身坐标系X轴旋转；
②绕新形成的坐标系的Z轴旋转；
③绕定系的Z轴旋转；
④沿定系的各轴平移。
方法2：如图建立两个坐标系、与参照坐标系重合，两坐标系与2个楔块相固联。
图1：楔块坐标系建立（方法2）
对楔块1进行的变换矩阵为：；
对楔块2进行的变换矩阵为：
；
所以：；。
备注：当建立的相对坐标系位置不同时，到达理想位置的变换矩阵不同。
（2）、（3）略。
2. 图3-11 给出一个3自由度机械手的机构。轴1和轴2垂直。试求其运动方程式。
解：方法1建模：
如图3建立各连杆的坐标系。
图3：机械手的坐标系建立
根据所建坐标系得到机械手的连杆参数，见表1。
表1：机械手的连杆参数
该3自由度机械手的变换矩阵：；
最新机器人学蔡自兴课后习题答案
最新机器人学蔡自兴课后习题答案
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解： 坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ； 对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10000100501000010
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
完整版机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3.坐标系｛B｝的位置变化如下：初始时，坐标系｛A｝与｛B｝重合，让坐标系｛B｝绕Z B轴旋转角；然后再绕XB旋转角。给出把对矢量B P的描述变为对A P描述的旋转矩阵。
解：坐标系｛ B｝相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
对A P描述有A P B T B P；
其中A T Rot（z, ）Rot（x,）。
9.图2-10a示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移
或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。
（3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系｛qx^zj、｛o2x2y2z2｝，与2个楔块相固联。
图1:楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：T1 Rot（y,90）Rot（z,90）；
对楔块2进行的变换矩阵为:
10 0 0
010 5 0 0 10 0 0 0 1
0 0 1 0
0 0 1 2
1 0 0 0
1
0 0
所以： T 1
；T 2
0 1 0 0 0 1 0 4
0 0 0 1
1
对楔块 2的变换步骤:
① 绕自身坐标系X 轴旋转90 ; ② 绕新形成的坐标系的Z 轴旋转180 ； ③ 绕定系的Z 轴旋转90 ； ④
沿定系的各轴平移(3,0,4)。
与2个楔块相固联。
对楔块1进行的变换矩阵为：T 1 Rot(y,90)Rot(z,90)； 对楔块2进行的变换矩阵为:
机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕B Z 轴旋转
角；然后再绕B X 旋转
角。给出把对矢量
P B
的描述变为对
P A
描述
的旋转矩阵。解：
坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
对P A
描述有
P T P
B
A B
A
；
其中
),(),(x Rot z Rot T A B
。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。（3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法
1）
对楔块1进行的变换矩阵为：)90,()90,(1
z Rot y Rot T ；
对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o
02
o
2
z Rot x TRot z Rot Trans T ；
其中
1000010050100
00102
T
；
所以：1
000001000010
1001
T ；1
401000012100
2
T 对楔块2的变换步骤：①绕自身坐标系X 轴旋转90；②绕新形成的坐标系的Z 轴旋转180；③绕定系的Z 轴旋转
90；
④
沿定系的各轴平移)4,0,3(。
机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解： 坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
1对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=1000010050100001
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
① 绕自身坐标系X 轴旋转︒90； ② 绕新形成的坐标系的Z 轴旋转︒180； ③ 绕定系的Z 轴旋转︒-90； ④ 沿定系的各轴平移)4,0,3(-。
机器人学蔡自兴课后习题答案
For personal use only in study and research; not for commercial use
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解： 坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ； 对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥⎥⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10
00
0100501000010
2T ；
所以 ：⎥⎥
机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解：Θ坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ；
对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10000100501000010
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
(完整版)机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解： 坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ；
对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10000100501000010
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解： 坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ；
对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10000100501000010
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解：Θ坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ；
对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10000100501000010
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解：Θ坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ；
对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10000100501000010
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的
描述变为对P A
描述的旋转矩阵。
解： 坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变换顺序为依次右乘。
∴对P A 描述有 P T P B
A B
A = ； 其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ； 对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢⎢⎣⎡=1000010050100001
02T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
机器人学蔡自兴课后习题答案
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解：Θ坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B
A = ； 其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ； 对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10000100501000010
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
其余的比较简单，大家可以自己考虑。
3. 坐标系}B {的位置变化如下：初始时，坐标系}A {与}B {重合，让坐标系}B {绕
B Z 轴旋转θ角；然后再绕B X 旋转φ角。给出把对矢量P B 的描述变为对P A
描述
的旋转矩阵。
解： 坐标系}B {相对自身坐标系（动系）的当前坐标系旋转两次，为相对变换，齐次变
换顺序为依次右乘。
∴对P A 描述有 P T P B
A B A = ；
其中 ),(),(φθx Rot z Rot T A
B = 。
9. 图2-10a 示出摆放在坐标系中的两个相同的楔形物体。要求把它们重新摆放在图2-10b 所示位置。
（1）用数字值给出两个描述重新摆置的变换序列，每个变换表示沿某个轴平移或绕该轴旋转。
（2）作图说明每个从右至左的变换序列。 （3）作图说明每个从左至右的变换序列。
解：（1）方法1:如图建立两个坐标系}{1111z y x o 、}{2222z y x o ，与2个楔块相固联。
图1：楔块坐标系建立（方法1）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ；
对楔块2进行的变换矩阵为：
)180,()90,()90,()4,0,3(o
o 02o 2z Rot x TRot z Rot Trans T --= ；
其中 ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢
⎢⎣⎡=10000100501000010
2T ； 所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=1000
00100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10
004010000121
002T 对楔块2的变换步骤：
① 绕自身坐标系X 轴旋转︒90； ② 绕新形成的坐标系的Z 轴旋转︒180； ③ 绕定系的Z 轴旋转︒-90； ④ 沿定系的各轴平移)4,0,3(-。
方法2：如图建立两个坐标系}{1111z y x o 、}{2222z y x o 与参考坐标系重合，两坐标系与2个楔块相固联。
图1：楔块坐标系建立（方法2）
对楔块1进行的变换矩阵为：)90,()90,(1z Rot y Rot T = ； 对楔块2进行的变换矩阵为：
)90,()180,()90,()0,0,4()9,0,2(o o o 2--=z Rot x Rot y Rot Trans Trans T ；
所以 ：⎥⎥
⎥⎥⎦⎤⎢⎢⎢
⎢⎣⎡=100000100001
01001T ；⎥⎥⎥⎥⎦
⎤
⎢
⎢⎢
⎢⎣⎡--=10009010000121
002T 。 备注：当建立的相对坐标系位置不同时，到达理想位置的变换矩阵不同。 （2）、（3）略。
2. 图3-11 给出一个3自由度机械手的机构。轴1和轴2垂直。试求其运动方程式。
解：方法1建模：
如图3建立各连杆的坐标系。
图3：机械手的坐标系建立
根据所建坐标系得到机械手的连杆参数，见表1。
表1：机械手的连杆参数
连杆
i α
i a i d i θ
1
o 90
1L
1θ
2 0
2L
2θ 3 0 0 0
3θ
该3自由度机械手的变换矩阵： 32130A A A T = ；
⎥⎥
⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=10
00001000
111
1
111
11θθθθθθs L c s c L s c A ； ⎥
⎥
⎥⎥⎦
⎤⎢⎢⎢⎢⎣⎡-=100
010000222
22222
2θθθθθθs L c s c L s c A ； ⎥⎥
⎥⎥⎦
⎤⎢⎢⎢⎢⎣⎡-=1000
010000003
3
333θθθθc s s c A ； ⎥
⎥⎥
⎥⎦⎤⎢
⎢⎢⎢⎣
⎡+-++----+---=10
002
23
23232322121113
213213213
212121113213213
2132130
θθθθθθθθθθθθθθθθθθθθ
θθθθθθθθθθθθθθθθθθθθθs L c c s s s c c s c s L s L c c s s s c s s s s c c s c c L c L s c s c s c c s s c c c c T
方法二进行建模：
坐标系的建立如图4所示。
图4：机械手的坐标系建立
根据所建坐标系得到机械手的连杆参数，见表2。
表2：机械手的连杆参数
⎥⎥
⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡-=10000100000011
111θθθθc s s c A ； ⎥⎥
⎥⎥⎦⎤⎢
⎢⎢⎢⎣⎡--=100
00001000
22122
2θθθθc s L s c A ； ⎥⎥
⎥⎥⎦
⎤⎢⎢⎢⎢⎣⎡-=100
010000033
2333θθθθc s L s c A ； ⎥
⎥⎥⎥⎦
⎤
⎢
⎢⎢⎢⎣
⎡+-++----+---=10
002
23
23232322121113
213213213
2121211132132132132130
θθθθθθθθθθθθθθθθθθθθ
θθθθθθθθθθθθθθθθθθθθθs L c c s s s c c s c s L s L c c s s s c s s s s c c s c c L c L s c s c s c c s s c c c c T
3. 图3-12 所示3 自由度机械手，其关节1与关节2相交，而关节2与关节3平行。图中所示关节均处于零位。各关节转角的正向均由箭头示出。指定本机械手各连杆的坐标系，然后求各变换矩阵10T ，21T 和32T 。
解：对于末端执行器而言，因为单独指定了末端执行器的坐标系，则要确定末端执行器与最后一个坐标系之间的变换关系。 方法1建模：
按照方法1进行各连杆的坐标系建立，建立方法见图5。