planeframerotationmatrix.m

来自「平面刚架（带弹簧支座）有限元程序」· M 代码 · 共 11 行

function RT=PlaneFrameRotationMatrix(pj,pk)
dp=pk-pj;
L=norm(dp);
cx=dp(1)/L;
cy=dp(2)/L;
R=[cx cy 0;...
    -cy cx 0;...
    0 0 1;];
RT=[R zeros(3);...
    zeros(3) R;];