rotateb.m

用于计算多体系统动力学的程序,可用于多体系统动力学的计算和仿镇,也可用于机器人的设计和计算

% 旋转矩阵B程序
function [a,p1,p2,p3]=RotateB(m1,m2,x1,x2)

[a1,p1]=RotateA(m1,x1); 
[a2,p3]=RotateA(m2,x2);

p2  = (a1*p3')';
a=a1*a2;