matlab空间圆弧插补程序

空间圆弧插补matlab程序代码，matlab程序

% 计算圆弧AOC的圆心角AOC
% theta = CalCentralAngle（abcOr） 
% 
% a -- 圆弧起始点
% b -- 圆弧中间点
% c -- 圆弧终止点
% O -- 圆弧的圆心
% r -- 圆半径
% theta -- 圆心角AOC 


function theta = CalCentralAngle（abcOr） 

 % 计算法向量
 AB = a-b;
 BC = b-c;
 n = cross（ABBC）;

 OA = O-a;
 AC = a-c;
 n1 = cross（OAAC）;

 H = dot（nn1）;
 d = （c（1）-a（1））.^2 + （c（2）-a（2））.^2 + （c（3）-a（3））.^2;

 if H<0
    theta = 2*pi - 2*asin（sqrt（d）/（2*r））;
 else
    theta = 2*asin（sqrt（d）/（2*r））;
 end
    

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2014-05-17 09:50  Space-circular-interpolation\
     目录           0  2014-05-17 14:44  Space-circular-interpolation\matlab空间圆弧插补仿真代码\
     文件         525  2011-11-19 11:18  Space-circular-interpolation\matlab空间圆弧插补仿真代码\CalCentralAngle.m
     文件        1743  2014-05-17 11:47  Space-circular-interpolation\matlab空间圆弧插补仿真代码\CalCircleCenter.m
     文件         826  2011-11-19 15:02  Space-circular-interpolation\matlab空间圆弧插补仿真代码\circtraj.m
     文件        1308  2011-11-19 15:01  Space-circular-interpolation\matlab空间圆弧插补仿真代码\CirInterpolation.m
     文件         222  2011-11-18 17:41  Space-circular-interpolation\matlab空间圆弧插补仿真代码\Distance.m
     文件         266  2011-11-18 11:48  Space-circular-interpolation\matlab空间圆弧插补仿真代码\xj.m
     文件      161767  2011-11-12 14:54  Space-circular-interpolation\matlab空间圆弧插补仿真代码\机器人的三种规则曲线插补算法.pdf