计算2D/3D参考系（ST）

PROGRAM MAIN
VAR

	frameReferenceX_RC1:REAL:=-184.049;(*参考系X*)
	frameReferenceY_RC1:REAL:=316.226;(*参考系Y*)

	frameReferenceX_RC2:REAL:=-317.442;(*参考系X*)
	frameReferenceY_RC2:REAL:=442.661;(*参考系Y*)

	fixtureAmount:INT:=3;(*数量*)

	fixtureInterval:REAL;(*间距*)
	angularDeviation:REAL;(*偏差角度*)

END_VAR


fixtureInterval:=
				EXPT(frameReferenceX_RC1-frameReferenceX_RC2,2)
				+EXPT(frameReferenceY_RC1-frameReferenceY_RC2,2);
(*转盘夹具间距*)
fixtureInterval:=(SQRT(fixtureInterval))/fixtureAmount;

(*夹具偏差角度*)
angularDeviation:=TAN(SQRT(fixtureInterval));(*正切直角边*)

以上程序按