领胜LDS 键盘AOI检测项目
wells.liu
2020-07-13 b2a5e60d5df66bc8a6be7e12eded1f7e923e9196
src/Bro.M071.Process/M071Process_MotionCard.cs
@@ -19,56 +19,103 @@
        public Timer ResetTimer = null;
        const int FULLRESETTIME = 5;
        object machineStateLock = new object();
        MachineState machineState = MachineState.Unknown;
        public MachineState MachineState
        {
            get => machineState;
            set
            {
                if (machineState == value)
                    return;
                machineState = value;
                switch (machineState)
                {
                    case MachineState.Ready:
                        SwitchBeep(false);
                        SwitchLightRed(false);
                        SwitchLightYellow(false);
                        lock (machineStateLock)
                        {
                            SwitchBeep(false);
                            SwitchLightRed(false);
                            SwitchLightYellow(false);
                        }
                        Task.Run(() =>
                        {
                            while (MachineState == MachineState.Ready)
                            {
                                SwitchLightGreen(true);
                                Thread.Sleep(1000);
                                SwitchLightGreen(false);
                                lock (machineStateLock)
                                {
                                    SwitchLightGreen(true);
                                    Thread.Sleep(1000);
                                    SwitchLightGreen(false);
                                    Thread.Sleep(1000);
                                }
                            }
                        });
                        break;
                    case MachineState.Running:
                        SwitchBeep(false);
                        SwitchLightRed(false);
                        SwitchLightYellow(false);
                        SwitchLightGreen(true);
                        lock (machineStateLock)
                        {
                            SwitchBeep(false);
                            SwitchLightRed(false);
                            SwitchLightYellow(false);
                            SwitchLightGreen(true);
                        }
                        break;
                    case MachineState.Alarm:
                        SwitchBeep(true);
                        SwitchLightRed(true);
                        SwitchLightYellow(false);
                        SwitchLightGreen(false);
                        lock (machineStateLock)
                        {
                            SwitchBeep(true);
                            SwitchLightRed(true);
                            SwitchLightYellow(false);
                            SwitchLightGreen(false);
                        }
                        break;
                    case MachineState.Pause:
                        SwitchBeep(false);
                        SwitchLightRed(false);
                        lock (machineStateLock)
                        {
                            SwitchBeep(false);
                            SwitchLightRed(false);
                        }
                        Task.Run(() =>
                        {
                            while (MachineState == MachineState.Pause)
                            {
                                SwitchLightYellow(true);
                                SwitchLightGreen(true);
                                Thread.Sleep(1000);
                                SwitchLightYellow(false);
                                SwitchLightGreen(false);
                                lock (machineStateLock)
                                {
                                    SwitchLightYellow(true);
                                    SwitchLightGreen(true);
                                    Thread.Sleep(1000);
                                    SwitchLightYellow(false);
                                    SwitchLightGreen(false);
                                    Thread.Sleep(1000);
                                }
                            }
                        });
                        break;
                    case MachineState.Resetting:
                        lock (machineStateLock)
                        {
                            SwitchBeep(false);
                            SwitchLightRed(false);
                            SwitchLightGreen(false);
                        }
                        Task.Run(() =>
                        {
                            while (MachineState == MachineState.Resetting)
                            {
                                lock (machineStateLock)
                                {
                                    SwitchLightYellow(true);
                                    Thread.Sleep(1000);
                                    SwitchLightYellow(false);
                                    Thread.Sleep(1000);
                                }
                            }
                        });
                        break;
@@ -83,7 +130,7 @@
        private void MotionCardSettingCheck()
        {
            IDevice device = DeviceCollection.FirstOrDefault(u => u is IMotionCard);
            if (device.InitialConfig is MotionCardInitialConfigBase iConfig)
            if (device?.InitialConfig is MotionCardInitialConfigBase iConfig)
            {
                outputCtrlCard = device as MotionCardBase;
@@ -143,6 +190,16 @@
            }
        }
        [ProcessMethod("MotionCardBase", "GotoReadyPosition", "运动到预备位置", InvokeType.TestInvoke)]
        public ProcessResponse GotoReadyPosition(IOperationConfig opConfig, IDevice invokeDevice, IDevice sourceDevice)
        {
            MotionCardDefaultRun("GotoReadyPosition", ref opConfig, ref invokeDevice);
            LogAsync(DateTime.Now, "运动到预备位置完成", "");
            return new ProcessResponse(true);
        }
        [ProcessMethod("MotionCardBase", "Reset", "简单复位操作", InvokeType.TestInvoke)]
        public ProcessResponse Reset(IOperationConfig opConfig, IDevice invokeDevice, IDevice sourceDevice)
        {
@@ -164,28 +221,45 @@
            //    }
            //}
            if (IsSafetyBeamTrigged || IsSafetyDoorTrigged)
            {
                LogAsync(DateTime.Now, $"{(IsSafetyDoorTrigged ? "安全门" : "")}{(IsSafetyBeamTrigged ? " 安全光线" : "")}触发中,复位失败", "");
                return new ProcessResponse(false);
            }
            MotionCardDefaultRun("Reset", ref opConfig, ref invokeDevice);
            //(invokeDevice as IMotionCard).Reset();
            RaisedAlarm("");
            MachineState = MachineState.Ready;
            if (ResetTimer == null)
            {
                ResetTimer = new Timer(FullReset, null, -1, -1);
            }
            if (opConfig.InputPara.Count > 0)
            if (opConfig?.InputPara != null && opConfig.InputPara.Count > 0)
            {
                //大复位信号
                ResetTimer.Change(-1, opConfig.InputPara[0] == 1 ? FULLRESETTIME * 1000 : -1);
                ResetTimer.Change(opConfig.InputPara[0] == 1 ? FULLRESETTIME * 1000 : -1, -1);
                if (opConfig.InputPara[0] == 0)
                    return new ProcessResponse(true);
            }
            if (!IsAllowedWork)
            {
                LogAsync(DateTime.Now, $"{SafetyMsg},复位失败", "");
                return new ProcessResponse(false);
            }
            MotionCardDefaultRun("Reset", ref opConfig, ref invokeDevice);
            (invokeDevice as MotionCardBase).ResetAlarm();
            RaisedAlarm("");
            MachineState = MachineState.Ready;
            if (IsEmergencyStopped)
            {
                RaisedAlarm("急停按钮未恢复,请执行大复位");
                MachineState = MachineState.Alarm;
            }
            //if (opConfig.InputPara?.Count > 0)
            //{
            //    //大复位信号
            //    ResetTimer.Change(-1, opConfig.InputPara[0] == 1 ? FULLRESETTIME * 1000 : -1);
            //}
            //if (invokeDevice is MotionCardBase motionCard)
            //{
@@ -199,10 +273,18 @@
        private void FullReset(object state)
        {
            FullReset(null, null, null);
            try
            {
                FullReset(null, null, null);
            }
            catch (Exception ex)
            {
                ExceptionRaisedInMonitor(ex);
            }
        }
        [ProcessMethod("MotionCardOperationConfigCollection", "FullReset", "大复位操作", InvokeType.TestInvoke)]
        //[ProcessMethod("MotionCardOperationConfigCollection", "FullReset", "大复位操作", InvokeType.TestInvoke)]
        [ProcessMethod("MotionCardBase", "FullReset", "大复位操作", InvokeType.TestInvoke)]
        public ProcessResponse FullReset(IOperationConfig opConfig, IDevice invokeDevice, IDevice sourceDevice)
        {
            //if (opConfig == null)
@@ -228,6 +310,7 @@
            //    motionCard.Run(opConfig);
            //}
            MachineState = MachineState.Resetting;
            MotionCardDefaultRun("FullReset", ref opConfig, ref invokeDevice);
            productionList.ForEach(u => u.Dispose());
@@ -235,7 +318,15 @@
            OnFullResetDone?.Invoke();
            isFullResetCovered = true;
            LogAsync(DateTime.Now, "大复位动作完成", "");
            RaisedAlarm("");
            MachineState = MachineState.Ready;
            GotoReadyPosition(null, null, null);
            return new ProcessResponse(true);
        }
@@ -249,36 +340,123 @@
            WaitHandle = new ManualResetEvent(true),
            WaitResult = true,
        };
        [ProcessMethod("", "PauseJob", "暂停流程", InvokeType.TestInvoke)]
        public ProcessResponse PauseJob(IOperationConfig opConfig, IDevice invokeDevice, IDevice sourceDevice)
        MachineState _machineStateBeforePause = MachineState.Unknown;
        List<MachineState> _statesAllowPause = new List<MachineState>() { MachineState.Running, MachineState.Ready, MachineState.Pause };
        [ProcessMethod("", "SwitchJobStatus", "流程状态切换", InvokeType.TestInvoke)]
        public ProcessResponse SwitchJobStatus(IOperationConfig opConfig, IDevice invokeDevice, IDevice sourceDevice)
        {
            if (!_pauseHandle.WaitResult)
            {
                #region 板卡暂停动作
                #endregion
            if (!_statesAllowPause.Contains(MachineState))
                return new ProcessResponse(-999);
                _pauseHandle.WaitHandle.Reset();
            MotionCardBase motionDevice = sourceDevice as MotionCardBase;
            if (motionDevice == null)
            {
                motionDevice = DeviceCollection.FirstOrDefault(u => u is MotionCardBase) as MotionCardBase;
            }
            _pauseHandle.WaitResult = !_pauseHandle.WaitResult;
            if (motionDevice == null)
                throw new ProcessException("未获取板卡设备");
            bool? isToPause = null; //true 暂停 false 继续
            //if (opConfig.InputPara != null && opConfig.InputPara.Count > 0)
            //{
            //    isToPause = opConfig.InputPara[0] == 1;
            //}
            if (opConfig.InputPara[0] == 10)
            {
                isToPause = false;
            }
            else if (opConfig.InputPara[0] == 11)
            {
                isToPause = true;
            }
            if (isToPause == null)
            {
                if (!_pauseHandle.WaitResult)
                {
                    #region 板卡暂停动作
                    motionDevice.SetImmediatePause();
                    #endregion
                    _pauseHandle.WaitHandle.Reset();
                    _pauseHandle.WaitResult = true;
                    _machineStateBeforePause = MachineState;
                    MachineState = MachineState.Pause;
                }
                else if (!_pauseHandle.WaitResult)
                {
                    #region 板卡恢复动作
                    motionDevice.ResetImmediatePause();
                    #endregion
                    _pauseHandle.WaitHandle.Set();
                    _pauseHandle.WaitResult = false;
                    MachineState = _machineStateBeforePause;
                }
            }
            else
            {
                if (isToPause.Value)
                {
                    if (!_pauseHandle.WaitResult)
                    {
                        #region 板卡暂停动作
                        motionDevice.SetImmediatePause();
                        #endregion
                        _pauseHandle.WaitHandle.Reset();
                        _pauseHandle.WaitResult = true;
                        MachineState = MachineState.Pause;
                    }
                }
                else
                {
                    if (!_pauseHandle.WaitResult)
                    {
                        #region 板卡恢复动作
                        motionDevice.ResetImmediatePause();
                        #endregion
                        _pauseHandle.WaitHandle.Set();
                        _pauseHandle.WaitResult = false;
                        MachineState = _machineStateBeforePause;
                    }
                }
            }
            return new ProcessResponse(_pauseHandle.WaitResult);
        }
        [ProcessMethod("", "ResumeJob", "继续流程", InvokeType.TestInvoke)]
        public ProcessResponse ResumeJob(IOperationConfig opConfig, IDevice invokeDevice, IDevice sourceDevice)
        {
            if (_pauseHandle.WaitResult)
            {
                #region 板卡恢复动作
                #endregion
        ////[ProcessMethod("", "PauseJob", "暂停流程", InvokeType.TestInvoke)]
        //public ProcessResponse PauseJob(IOperationConfig opConfig, IDevice invokeDevice, IDevice sourceDevice)
        //{
        //    if (!_pauseHandle.WaitResult)
        //    {
        //        #region 板卡暂停动作
        //        #endregion
                _pauseHandle.WaitHandle.Set();
            }
        //        _pauseHandle.WaitHandle.Reset();
        //    }
            _pauseHandle.WaitResult = !_pauseHandle.WaitResult;
            return new ProcessResponse(_pauseHandle.WaitResult);
        }
        //    _pauseHandle.WaitResult = !_pauseHandle.WaitResult;
        //    return new ProcessResponse(_pauseHandle.WaitResult);
        //}
        ////[ProcessMethod("", "ResumeJob", "继续流程", InvokeType.TestInvoke)]
        //public ProcessResponse ResumeJob(IOperationConfig opConfig, IDevice invokeDevice, IDevice sourceDevice)
        //{
        //    if (_pauseHandle.WaitResult)
        //    {
        //        #region 板卡恢复动作
        //        #endregion
        //        _pauseHandle.WaitHandle.Set();
        //    }
        //    _pauseHandle.WaitResult = !_pauseHandle.WaitResult;
        //    return new ProcessResponse(_pauseHandle.WaitResult);
        //}
        #region 三色灯 & 蜂鸣器
        //[ProcessMethod("MotionCardBase", "SwitchLightRed", "切换指示灯-红", InvokeType.TestInvoke)]
@@ -423,7 +601,7 @@
        private void MotionCardDefaultRun(string methodCode, ref IOperationConfig opConfig, ref IDevice invokeDevice)
        {
            IMonitorSet monitorSet = null;
            if (opConfig == null)
            if (opConfig == null || !(opConfig is MotionCardOperationConfigBase))
            {
                monitorSet = Config.MonitorSetCollection.FirstOrDefault(u => u.MethodCode == methodCode);
                if (monitorSet == null)
@@ -443,8 +621,21 @@
            if (invokeDevice is MotionCardBase motionCard)
            {
                motionCard.Run(opConfig);
                var response = motionCard.Run(opConfig);
                if (!response.Result)
                {
                    throw new ProcessException($"{motionCard.Name}异常,{response.Message}", null, ExceptionLevel.Fatal);
                }
            }
        }
        bool IsAllowedWork
        {
            get => !(IsSafetyBeamTrigged || IsSafetyDoorTrigged || IsEmergencyStopped);
        }
        string SafetyMsg
        {
            get => $"{(IsSafetyBeamTrigged ? "安全光幕" : "")}{(IsSafetyDoorTrigged ? " 安全门" : "")}{(IsEmergencyStopped ? " 急停按钮" : "")}触发中";
        }
        #region 安全门 & 安全光线
@@ -482,6 +673,9 @@
        [ProcessMethod("", "SafetyBeamSignal", "安全光幕信号监控,正常ON,OFF时报警", InvokeType.TestInvoke)]
        public ProcessResponse SafetyBeamSignal(IOperationConfig opConfig, IDevice invokeDevice, IDevice sourceDevice)
        {
            if (MachineState != MachineState.Running && MachineState != MachineState.Alarm)
                return new ProcessResponse(true);
            if (opConfig.InputPara == null || opConfig.InputPara.Count == 0)
                throw new ProcessException("安全光幕监控未配置输入信号");
@@ -496,5 +690,43 @@
            return new ProcessResponse(true);
        }
        #endregion
        #region 急停
        bool isEmergencyStopped = false;
        bool isFullResetCovered = true;
        public bool IsEmergencyStopped
        {
            get => isEmergencyStopped && isFullResetCovered;
            set
            {
                if (value)
                {
                    isFullResetCovered = false;
                    isEmergencyStopped = true;
                }
                else
                {
                    isEmergencyStopped = false;
                }
            }
        }
        [ProcessMethod("", "EmergencyStop", "急停按钮被拍下", InvokeType.TestInvoke)]
        public ProcessResponse EmergencyStop(IOperationConfig opConfig, IDevice invokeDevice, IDevice sourceDevice)
        {
            if (opConfig.InputPara == null || opConfig.InputPara.Count == 0)
                throw new ProcessException("急停按钮未配置输入信号");
            IsEmergencyStopped = opConfig.InputPara[0] == 0;
            if (IsEmergencyStopped)
            {
                RaisedAlarm("急停按钮被拍下");
                MachineState = MachineState.Alarm;
            }
            return new ProcessResponse(true);
        }
        #endregion
    }
}