dc-jiang
级别: 略有小成
精华主题: 0
发帖数量: 71 个
工控威望: 243 点
下载积分: 1209 分
在线时间: 156(小时)
注册时间: 2008-03-10
最后登录: 2024-10-11
查看dc-jiang的 主题 / 回贴
楼主  发表于: 2019-05-23 23:36
(*----------------------------------------------------------------------------*)
IF  NOT EmergencyStop    THEN
    VisionXYAlignmentBusy       := FALSE;
    VisionXYAlignmentComplete := FALSE;
    AxisRun1                   := FALSE;
    AxisRun2                   := FALSE;
    AxisRun3                   := FALSE;
END_IF;

(*----------------------------------------------------------------------------*)
IF     SaveBasePoint THEN
    InspectBasePos[0] := InspectResultPos[0];
    InspectBasePos[1] := InspectResultPos[1];
    InspectBasePos[2] := InspectResultPos[2];
    InspectBasePos[3] := InspectResultPos[3];
END_IF;

(*----------------------------------------------------------------------------*)
IF     VisionXYAlignmentStart AND NOT VisionXYAlignmentBusy    THEN
    VisionXYAlignmentBusy := TRUE;
    VisionXYAlignmentComplete := FALSE;
    VisionXYAlignmentStep := 0;
    RETURN;
END_IF;

(*----------------------------------------------------------------------------*)
IF     VisionXYAlignmentBusy    THEN
    IF     VisionXYAlignmentStep = 0    THEN
        TempFloatValue1 := InspectResultPos[0] - InspectBasePos[0];
        TempFloatValue2 := InspectResultPos[2] - InspectBasePos[2];
        TempFloatValue3 := ((TempFloatValue1 + TempFloatValue2) / 2.0) * 3.7;
        TempRunPos1 := CurrentAxisPos1 - REAL_TO_DINT(TempFloatValue3);
        
        TempFloatValue1 := InspectResultPos[1] - InspectBasePos[1];
        TempFloatValue2 := InspectResultPos[3] - InspectBasePos[3];
        TempFloatValue3 := ((TempFloatValue1 + TempFloatValue2) / 2.0) * 3.7;
        TempIntegerValue3 := ABS(REAL_TO_DINT(TempFloatValue3));
        
        IF TempFloatValue3 >= 0.0    THEN
            TempRunPos2 := CurrentAxisPos2 - TempIntegerValue3;
            TempRunPos3 := CurrentAxisPos3 + TempIntegerValue3;
        ELSE
            TempRunPos2 := CurrentAxisPos2 + TempIntegerValue3;
            TempRunPos3 := CurrentAxisPos3 - TempIntegerValue3;
        END_IF;
        
        AxisRunPos1 := TempRunPos1;
        AxisRun1 := TRUE;        
        AxisRunPos2 := TempRunPos2;
        AxisRun2 := TRUE;
        AxisRunPos3 := TempRunPos3;
        AxisRun3 := TRUE;

        VisionXYAlignmentStep := 1;
        RETURN;
    END_IF;

    IF     VisionXYAlignmentStep = 1    THEN
        IF    CurrentAxisPos1 = AxisRunPos1 AND IsAxisInPos1 AND NOT IsAxisMoving1    AND
            CurrentAxisPos2 = AxisRunPos2 AND IsAxisInPos2 AND NOT IsAxisMoving2    AND
            CurrentAxisPos3 = AxisRunPos3 AND IsAxisInPos3 AND NOT IsAxisMoving3    THEN
            AxisRun1 := FALSE;
            AxisRun2 := FALSE;
            AxisRun3 := FALSE;
        
            VisionXYAlignmentBusy := FALSE;
            VisionXYAlignmentComplete := TRUE;
        END_IF;
        RETURN;
    END_IF;
END_IF;
(*----------------------------------------------------------------------------*)
本帖最近评分记录:
  • 下载积分:+3(菜鸟入行) 看不懂。
    mall9002
    级别: 略有小成
    精华主题: 0
    发帖数量: 137 个
    工控威望: 248 点
    下载积分: 921 分
    在线时间: 182(小时)
    注册时间: 2017-11-30
    最后登录: 2024-12-16
    查看mall9002的 主题 / 回贴
    1楼  发表于: 2019-05-24 10:56
          
    易傳偉
    YUDO-STAR
    级别: 略有小成
    精华主题: 0
    发帖数量: 292 个
    工控威望: 400 点
    下载积分: 5480 分
    在线时间: 384(小时)
    注册时间: 2018-11-16
    最后登录: 2024-12-21
    查看易傳偉的 主题 / 回贴
    2楼  发表于: 2019-05-24 16:12
              
    guoqing3511
    随风飘荡
    级别: 家园常客
    精华主题: 0
    发帖数量: 478 个
    工控威望: 627 点
    下载积分: 1466 分
    在线时间: 237(小时)
    注册时间: 2016-06-03
    最后登录: 2024-12-10
    查看guoqing3511的 主题 / 回贴
    3楼  发表于: 2019-05-24 18:20
    baiyangfy
    交流与学习
    级别: 探索解密
    精华主题: 0
    发帖数量: 72 个
    工控威望: 136 点
    下载积分: 937 分
    在线时间: 44(小时)
    注册时间: 2019-04-19
    最后登录: 2024-12-05
    查看baiyangfy的 主题 / 回贴
    4楼  发表于: 2019-05-24 22:26
    大神写程序从来不加汉语注释,直接用标签表达释义。大神果然适合膜拜
    zl128828
    级别: 略有小成
    精华主题: 0
    发帖数量: 351 个
    工控威望: 445 点
    下载积分: 1185 分
    在线时间: 203(小时)
    注册时间: 2018-02-01
    最后登录: 2024-11-16
    查看zl128828的 主题 / 回贴
    5楼  发表于: 2019-05-25 15:01
    这个厉害额    加油
    weixin-keji
    工控小妖
    级别: 探索解密
    精华主题: 0
    发帖数量: 76 个
    工控威望: 171 点
    下载积分: 759 分
    在线时间: 81(小时)
    注册时间: 2016-01-21
    最后登录: 2024-12-18
    查看weixin-keji的 主题 / 回贴
    6楼  发表于: 2019-05-25 23:30
    大神哈,工控做到这份上可以自豪地说不亏做工控的