rotatec.m

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

% 旋转矩阵C程序
function [a,p1,p2,p3,p4]=RotateC(m1,m2,m3,x1,x2,x3)

[a1,p1,p2,p3]=RotateB(m1,m2,x1,x2);
[a2,p4]=RotateA(m3,x3);

p3=(a1*p4')';       % p3可能没有用
a=a1*a2;