円弧の中心座標

 開始時における円弧の中心座標を求めます。
 //**********************************************************************************
  #macro Beginning_center(Mx,Px1,Pz1,Px2,Pz2,Ox0,Oz0)
   #local A=2*(Mx*(Px1-Px2)-(Pz1-Pz2));
   #local B=2*(Px1-Px2)*(Mx*Pz1+Px1);
   #local C=(pow(Px2,2)-pow(Px1,2))+(pow(Pz2,2)-pow(Pz1,2));
   #if(A=0) #local A=pow(0.000001,10); #end
   #local Oz0=(B+C)/A; #local Ox0=Mx*(Pz1-Oz0)+Px1;
  #end
 //**********************************************************************************