%局部坐标与全局坐标的转换函数
function [R]=CoordTransform(x,y,z,BarLength)
l=(x(2)-x(1))/BarLength; m=(y(2)-y(1))/BarLength;n=(z(2)-z(1))/BarLength;
R=[l m n 0 0 0;0 0 0 l m n];
end