AC-DMIS 5.3 RPS找正

Posted 2022-06-07 山涧果子

DEFINE RPS RPS-ALIG
    V101=5
    V102=0.0500
    V106=0.1000
    SET-RPS-PARA(9,V102)
    !XYZ三个选项个数不能相等！
    RPS-AXIS-ELE(0,2,"点-1")
    RPS-AXIS-ELE(1,2,"点-2")
    RPS-AXIS-ELE(2,2,"点-3")
    RPS-AXIS-ELE(3,2,"点-4")
    RPS-AXIS-ELE(4,1,"点-5")
    RPS-AXIS-ELE(5,1,"点-6")
    RPS-AXIS-ELE(6,1,"点-7")
    RPS-AXIS-ELE(7,0,"点-8")
    RPS-AXIS-ELE(8,0,"点-9")
    V103=RPS-ALIGNMENT
    V105=GET-RPS-ERR
    IF(V105<0)
        DISP("找正出错，请检查相关参数！程序将中止！")
        PAUSE
    ENDIF
    IF(V103 > V102 OR V109 > V106)
        DISP("请将机器移动到安全位置")
        FOR(V104,1,V101)
            POINT    点-1
            POINT    点-2
            POINT    点-3
            POINT    点-4
            POINT    点-5
            POINT    点-6
            POINT    点-7
            POINT    点-8
            POINT    点-9
            V103=RPS-ALIGNMENT
            V105=GET-RPS-ERR
            IF(V105<0)
                DISP("找正出错，请检查相关参数！程序将中止！")
                PAUSE
            ENDIF
            IF(V103<=V102 AND V109<=V106 )
                V104=V101+1
            ENDIF
        NEXT
    ENDIF
    SAVE-COORSYS("RPS-ALIG")
    IF(V103 > V102 OR V109 > V106)
        DISP("坐标系未建立成功，程序是否继续运行！")
    ENDIF
ENDDEF