平面度算法说明.docxVIP

检测工件平面度算法说明: 1:在基准面上取 3个点分别为 P1 (x1,y1,z1), P2 (x2,y2,z2), P3 (x3,y3,z3)禾U用三点成面 的公式计算出平面 AX+BY+CZ+D=0^为基准平面 注：1、P1的X, Y坐标由人工输入，其余点有输入的 X, Y移动量计算得出 2、 所有点的Z坐标由激光测距仪提供 3、 计算平面公式时，须计算出 A,B,C,D A=y1*z2-y1*z3-y2*z1+y2*z3+y3*z1-y3*z2; B=-x1*z2+x1*z3+x2*z1-x2*z3-x3*z1+x3*z2; C=x1*y2-x1*y3-x2*y1+x2*y3+x3*y1-x3*y2; D=x1*y2*z3-x1*y3*z2-x2*y1*z3+x3*y1*z2+x2*y3*z1-x3*y2*z1; 2:在计算面上取3个点分别为P4 ( x4,y4,z4), P5(x5,y5,z5), P6(x6,y6,z6)利用点到平面的距离 公式分别求出 D1,D2,D3,然后计算出D1,D2,D3的平方差，通过平方差的大小来判断计算面 与基准面之间的平行度 注：1、计算点到面的距离公式是： D=abs(axO+byO+czO+d)/sqrt(a*a+b*b+c*c); 2、 计算方差公式为： Avg = ( D1+D2+D3) /3 Var = ( ( D1-Avg) A