【TRIO-Basic从入门到精通教程二十】Trio通过空间圆弧三点计算圆弧中心和半径

兄弟们，大家好。今天给大家带来空间圆弧三点计算圆弧中心和半径公式。在Trio中，集成了计算函数，今天我们的目的自己来实现这个计算公式。

'导入计算数据
TABLE(100,0,0,0,5,5,5,5,0,0)

'自己写算法实现
calcriclecen(100,FALSE)
PRINT "XYZ 1=",TABLE(100+10),TABLE(100+11),TABLE(100+12)

'Trio原装算法实现
SPHERE_CENTRE(100+3, 100+6, 100+10)
PRINT "XYZ 2=",TABLE(100+10),TABLE(100+11),TABLE(100+12)

Trio指令帮助

从这个指令能够看出，它的起点必须是0,0,0，这意味着计算必须是增量计算方式。

我们看下我们自己手写的算法：

'=================================================================
'=================================================================
'给定空间三点计算圆弧中心和半径
'partable给定输入参数
'Table0-2  给定P点坐标（起点）
'Table3-5  给定Q点坐标（中点）
'Table6-8  给定Q点坐标（终点)

'Table10-13  输出圆弧中心XYZR

'needprint 确认是否需要打印计算过程数据 false不打印，true打印
FUNCTION calcriclecen(partable AS INTEGER,needprint AS BOOLEAN) AS BOOLEAN

    '输入参数检查
    IF partable<0 OR partable>511980 THEN
        PRINT "Parameter out of range,Par=",partable
        RETURN FALSE
    ENDIF

    '给定空间三点计算圆弧中心和半径
    DIM dpx,dpy,dpz AS FLOAT
    dpx=TABLE(partable+0)
    dpy=TABLE(partable+1)
    dpz=TABLE(partable+2)
    DIM dqx,dqy,dqz AS FLOAT
    dqx=TABLE(partable+3)
    dqy=TABLE(partable+4)
    dqz=TABLE(partable+5)
    DIM drx,dry,drz AS FLOAT
    drx=TABLE(partable+6)
    dry=TABLE(partable+7)
    drz=TABLE(partable+8)

    '打印过程数据
    IF needprint THEN
        PRINT "========================="
        PRINT "Input Parmater:"
        PRINT "P [XYZ]=",dpx,dpy,dpz
        PRINT "Q [XYZ]=",dqx,dqy,dqz
        PRINT "R [XYZ]=",drx,dry,drz
    ENDIF

'输出空间原点和半径
    DIM dx0,dy0,dz0,dr AS FLOAT
    DIM dx1,dy1,dz1 AS FLOAT
    dx0=0
    dy0=0
    dz0=0
    dr=0

'-------------------------------------------
    DIM pi0,pj0,pk0 AS FLOAT
    DIM x1,x2,y1,y2,z1,z2 AS FLOAT
    x1=dqx-dpx
    x2=drx-dpx
    y1=dqy-dpy
    y2=dry-dpy
    z1=dqz-dpz
    z2=drz-dpz

    pi0=y1*z2-z1*y2
    pj0=z1*x2-x1*z2
    pk0=x1*y2-y1*x2

    '打印过程数据
    IF needprint THEN
        PRINT "Proc Parmater:"
        PRINT "IJK =",pi0,pj0,pk0
    ENDIF
    IF (pi0=0) AND (pj0=0) AND (pk0=0) THEN
        STOP
    ENDIF

'-------------------------------------------
'求PQ和PR的中垂线
'---------------------
'1，过PQ的中点(Mx,My,Mz)
    DIM dmx,dmy,dmz AS FLOAT
    dmx=(dpx+dqx)/2
    dmy=(dpy+dqy)/2
    dmz=(dpz+dqz)/2

'与（Mi,Mj,Mk）＝（pi，pj，pk）×（x1,y1,z1）垂直
    DIM dmi,dmj,dmk AS FLOAT
    dmi=pj0*z1-pk0*y1
    dmj=pk0*x1-pi0*z1
    dmk=pi0*y1-pj0*x1

    IF needprint THEN
        PRINT "PQ M=",dmi,dmj,dmk
    ENDIF
'---------------------
'2，过PR的中点(Nx,Ny,Nz)
    DIM dnx,dny,dnz AS FLOAT
    dnx=(dpx+drx)/2
    dny=(dpy+dry)/2
    dnz=(dpz+drz)/2

'与（Ni,Nj,Nk）＝（pi，pj，pk）×（x2,y2,z2）垂直
    DIM dni,dnj,dnk AS FLOAT
    dni=pj0*z2-pk0*y2
    dnj=pk0*x2-pi0*z2
    dnk=pi0*y2-pj0*x2

    IF needprint THEN
        PRINT "PR M=",dni,dnj,dnk
    ENDIF


'合并计算
    DIM ds AS FLOAT
'ds=dNi*dNi+dNj*dNj+dNk*dNk
    ds=SQR(pi0*pi0+pj0*pj0+pk0*pk0)

    IF ds=0 THEN
        dx1=0
        dy1=0
        dz1=0
    ELSE
        dx1=pi0/ds
        dy1=pj0/ds
        dz1=pk0/ds
    ENDIF

    IF needprint THEN
        PRINT "DX1 =",dx1,dy1,dz1,ds
    ENDIF


'-------------------------------------------
'得到的两条中垂线为{X=dMx+dMi*tm;Y=dMy+dMj*tm;Z=dMz+dMk*tm;}
'或(x-dmx)/dmi=(y-dmy)/dmj=(z-dmz)/dmk
' {X=dNx+dNi*tn;Y=dNy+dNj*tn;Z=dNz+dNk*tn;}
'或(x-dnx)/dni=(y-dny)/dnj=(z-dnz)/dnk;

'解两直线交点
    DIM tm,tn AS FLOAT
    tn=((dmy-dny)*dmi+dmj*(dnx-dmx))/(dnj*dmi-dmj*dni)
    tm=(dnx+dni*tn-dmx)/dmi

'dx0,dy0,dz0,dr
    dx0=INT((dmx+dmi*tm)*100000+0.5)/100000
    dy0=INT((dmy+dmj*tm)*100000+0.5)/100000
    dz0=INT((dmz+dmk*tm)*100000+0.5)/100000

    dr=INT((SQR((dx0-dpx)*(dx0-dpx)+(dy0-dpy)*(dy0-dpy)+(dz0-dpz)*(dz0-dpz)))*100000+0.5)/100000

    TABLE(partable+10,dx0,dy0,dz0,dr)
    IF needprint THEN
        PRINT "Out Parmater:"
        PRINT "OUT X Y Z R =",dx0,dy0,dz0,dr
        PRINT "========================="
    ENDIF
    RETURN TRUE
ENDFUNC
'=================================================================

通过给定空间三点计算圆弧中心和半径

运行结果测试

两个方法运行一致！

本次课程任务结束，谢谢大家观看。。。

【TRIO-Basic从入门到精通教程二十】Trio通过空间圆弧三点计算圆弧中心和半径

猜你喜欢