| | |
| | | using System.Collections.Concurrent; |
| | | using System.Collections.Generic; |
| | | using System.Collections.ObjectModel; |
| | | using System.Diagnostics; |
| | | using System.Drawing; |
| | | using System.IO; |
| | | using System.Linq; |
| | | using System.Text; |
| | | using System.Threading; |
| | |
| | | namespace Bro.Device.GTSCard |
| | | { |
| | | [Device("GTSCard", "固高板卡", EnumHelper.DeviceAttributeType.Device)] |
| | | public class GTSCardDriver : DeviceBase, IMonitor, IMotion |
| | | public class GTSCardDriver : MotionCardBase |
| | | { |
| | | public event Action<DateTime, string, IDevice, MonitorSet> OnMonitorInvoke; |
| | | public event Action<DateTime, IDevice, WarningSet> OnMonitorAlarm; |
| | | |
| | | public delegate bool OnAxisStartToCheckDelegate(int axisIndex, int startPosition, int endPosition); |
| | | // 异常事件 |
| | | public Action<Exception> OnExceptionRaised; |
| | | |
| | | public GTSCardInitialConfig IConfig |
| | | public GTSCardInitialConfig IIConfig |
| | | { |
| | | get |
| | | { |
| | |
| | | _isResetting = isReset; |
| | | } |
| | | |
| | | public List<AxisInfo> GetCurrentAxisInfo(params string[] axisName) |
| | | public override List<AxisInfo> GetCurrentAxisInfo(params string[] axisName) |
| | | { |
| | | throw new NotImplementedException(); |
| | | } |
| | |
| | | AllMoveStop(); |
| | | AllAxisOff(); |
| | | } |
| | | |
| | | /// <summary> |
| | | /// 设备 运行(执行 板卡系列的操作的 集合) |
| | | /// </summary> |
| | | /// <param name="config"></param> |
| | | /// <returns></returns> |
| | | public override ResponseMessage Run(IOperationConfig config) |
| | | { |
| | | ResponseMessage responseMessage = new ResponseMessage(); |
| | | var motionCardOperationConfig = config as MotionCardOperationConfigBase; |
| | | foreach (var operationSet in motionCardOperationConfig.OperationCollection) |
| | | { |
| | | responseMessage = RunOperationSet(operationSet); |
| | | if (!responseMessage.Result) |
| | | { |
| | | return responseMessage; |
| | | } |
| | | } |
| | | return responseMessage; |
| | | } |
| | | |
| | | /// <summary> |
| | | /// 执行 一个系列的操作 |
| | | /// </summary> |
| | | private ResponseMessage RunOperationSet(MotionCardOperationSet operationSet) |
| | | { |
| | | ResponseMessage responseMessage = new ResponseMessage(); |
| | | // 1.预检查 |
| | | if (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | foreach (var preCheck in operationSet.PreCheckIOCollection) |
| | | { |
| | | int timeout = operationSet.PreCheckIOTimeout; |
| | | IOValue? ioData = null; |
| | | while (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | Thread.Sleep(10); |
| | | ioData = MonitorValues.FirstOrDefault(u => u.IONum == preCheck.IOItem.IONum && u.IOType == preCheck.IOItem.IOType)?.Value;//IO 是开、关 从MonitorValues 获取 |
| | | timeout -= 10; |
| | | if (preCheck.CheckValue == ioData || (operationSet.PreCheckIOTimeout > 0 && timeout < 0)) |
| | | { |
| | | break; |
| | | } |
| | | } |
| | | |
| | | if (preCheck.CheckValue != ioData) |
| | | { |
| | | responseMessage.Result = false; |
| | | responseMessage.Message = $"预检查不通过,配置:{preCheck.GetDisplayText()},当前值:{ioData}"; |
| | | return responseMessage; |
| | | } |
| | | } |
| | | } |
| | | |
| | | // 2.板卡运动 |
| | | if (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | responseMessage = MoveToPoint(operationSet.MotionOperationCollection); |
| | | if (!responseMessage.Result) |
| | | { |
| | | return responseMessage; |
| | | } |
| | | } |
| | | |
| | | |
| | | // 3.IO输出 不需要超时 |
| | | if (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | foreach (var ioOutput in operationSet.IOOutputCollection) |
| | | { |
| | | var ioData = MonitorValues.FirstOrDefault(u => u.IONum == ioOutput.IOItem.IONum && u.IOType == ioOutput.IOItem.IOType)?.Value;//IO 是开、关 从MonitorValues 获取 |
| | | if (ioOutput.CheckValue != ioData) |
| | | { |
| | | responseMessage.Result = false; |
| | | responseMessage.Message = $"IO输出不通过,配置:{ioOutput.GetDisplayText()},当前值:{ioData}"; |
| | | return responseMessage; |
| | | } |
| | | } |
| | | } |
| | | |
| | | // 4.IO确认 |
| | | if (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | foreach (var ioConfirm in operationSet.IOConfirmCollection) |
| | | { |
| | | int timeout = operationSet.IOConfirmTimeout; |
| | | IOValue? ioData = null; |
| | | while (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | Thread.Sleep(10); |
| | | ioData = MonitorValues.FirstOrDefault(u => u.IONum == ioConfirm.IOItem.IONum && u.IOType == ioConfirm.IOItem.IOType)?.Value;//IO 是开、关 从MonitorValues 获取 |
| | | timeout -= 10; |
| | | if (ioConfirm.CheckValue == ioData || (operationSet.IOConfirmTimeout > 0 && timeout < 0)) |
| | | { |
| | | break; |
| | | } |
| | | } |
| | | |
| | | if (ioConfirm.CheckValue != ioData) |
| | | { |
| | | responseMessage.Result = false; |
| | | responseMessage.Message = $"IO确认不通过,配置:{ioConfirm.GetDisplayText()},当前值:{ioData}"; |
| | | return responseMessage; |
| | | } |
| | | } |
| | | } |
| | | |
| | | return responseMessage; |
| | | } |
| | | #endregion |
| | | |
| | | #region GTSCard |
| | |
| | | throw new Exception("板卡载入配置文件异常,错误码:" + res); |
| | | } |
| | | } |
| | | |
| | | |
| | | public bool AllAxisOn() |
| | | { |
| | |
| | | /// </summary> |
| | | /// <param name="item">运动对象</param> |
| | | /// <returns>运动控制+停止判断</returns> |
| | | public bool MoveToPoint(IOperationConfig opConfig) |
| | | public override ResponseMessage MoveToPoint(IOperationConfig opConfig) |
| | | { |
| | | bool resultOK = false; |
| | | var gtsOperationConfig = opConfig as GTSCardOperationConfig; |
| | | ResponseMessage responseMessage = new ResponseMessage(); |
| | | var gtsOperationCollection = opConfig as MotionOperationCollection; |
| | | List<Task<bool>> taskList = new List<Task<bool>>(); |
| | | //TaskFactory factory = new TaskFactory(TaskCreationOptions.LongRunning, TaskContinuationOptions.None); |
| | | // 如果是多个轴的运动 等每个轴运动结束 |
| | | foreach (var movingOp in gtsOperationConfig.MovingOps) |
| | | foreach (var movingOp in gtsOperationCollection.MovingOps) |
| | | { |
| | | //var task = factory.StartNew<bool>((op) => |
| | | //{ |
| | | // return SingleAxisMoving(op as MovingOption); |
| | | //}, movingOp); |
| | | var task = SingleAxisMoving(movingOp); |
| | | taskList.Add(task); |
| | | } |
| | | Task.WaitAll(taskList.ToArray()); |
| | | resultOK = taskList.All(u => u.GetAwaiter().GetResult()); |
| | | |
| | | return resultOK; |
| | | Task.WaitAll(taskList.ToArray()); |
| | | responseMessage.Result = taskList.All(u => u.GetAwaiter().GetResult()); |
| | | if (!responseMessage.Result) |
| | | { |
| | | responseMessage.Message = $"点位运动异常"; |
| | | } |
| | | return responseMessage; |
| | | } |
| | | |
| | | /// <summary> |
| | |
| | | return await Task.Run(() => |
| | | { |
| | | bool isSuccessAndStop = false; |
| | | if (IConfig.AxisSettings.FirstOrDefault(a => a.AxisIndex == optionPara.AxisIndex)?.IsAxisEnabled ?? false) |
| | | try |
| | | { |
| | | string _position = ""; |
| | | string motionType = optionPara.MoveMode == EnumHelper.MotorMoveMode.Normal ? (optionPara.IsAbsolute ? "Abs" : "Rel") : optionPara.MoveMode.ToString(); |
| | | |
| | | _position = $"{DateTime.Now.ToString("yyyy-MM-dd HH:mm:ss.fff")},{optionPara.AxisIndex},{motionType},{GetPosition(optionPara.AxisIndex).ToString()},{GetPrfPosition(optionPara.AxisIndex).ToString()},{optionPara.Destination},"; |
| | | |
| | | switch (optionPara.MoveMode) |
| | | if (IConfig.AxisSettings.FirstOrDefault(a => a.AxisIndex == optionPara.AxisIndex)?.IsAxisEnabled ?? false) |
| | | { |
| | | case MotorMoveMode.Normal: |
| | | { |
| | | if (_isResetting) |
| | | { |
| | | LogAsync(DateTime.Now, "复位中启动运动异常", optionPara.AxisIndex + "启动运动异常"); |
| | | return false; |
| | | } |
| | | string _position = ""; |
| | | string motionType = optionPara.MoveMode == EnumHelper.MotorMoveMode.Normal ? (optionPara.IsAbsolute ? "Abs" : "Rel") : optionPara.MoveMode.ToString(); |
| | | |
| | | if (optionPara.IsAbsolute) |
| | | { |
| | | isSuccessAndStop = P2PMoveAbs(optionPara); |
| | | } |
| | | else |
| | | { |
| | | isSuccessAndStop = P2PMoveRel(optionPara); |
| | | } |
| | | _position = $"{DateTime.Now:yyyy-MM-dd HH:mm:ss.fff},{optionPara.AxisIndex},{motionType},{GetPosition(optionPara.AxisIndex)},{GetPrfPosition(optionPara.AxisIndex)},{optionPara.Destination},"; |
| | | |
| | | } |
| | | break; |
| | | case MotorMoveMode.FindOri: |
| | | { |
| | | isSuccessAndStop = GoHome(optionPara); |
| | | } |
| | | break; |
| | | case MotorMoveMode.Jog: |
| | | { |
| | | isSuccessAndStop = JogMove(optionPara); |
| | | } |
| | | break; |
| | | switch (optionPara.MoveMode) |
| | | { |
| | | case MotorMoveMode.Normal: |
| | | { |
| | | if (_isResetting) |
| | | { |
| | | LogAsync(DateTime.Now, "复位中启动运动异常", optionPara.AxisIndex + "启动运动异常"); |
| | | return false; |
| | | } |
| | | |
| | | if (optionPara.IsAbsolute) |
| | | { |
| | | isSuccessAndStop = P2PMoveAbs(optionPara); |
| | | } |
| | | else |
| | | { |
| | | isSuccessAndStop = P2PMoveRel(optionPara); |
| | | } |
| | | |
| | | } |
| | | break; |
| | | case MotorMoveMode.FindOri: |
| | | { |
| | | isSuccessAndStop = GoHome(optionPara); |
| | | } |
| | | break; |
| | | case MotorMoveMode.Jog: |
| | | { |
| | | isSuccessAndStop = JogMove(optionPara); |
| | | } |
| | | break; |
| | | } |
| | | _position += $"{GetPosition(optionPara.AxisIndex)},"; |
| | | _position += $"{DateTime.Now:yyyy-MM-dd HH:mm:ss.fff}"; |
| | | LogAsync(DateTime.Now, "", _position); |
| | | } |
| | | _position += $"{GetPosition(optionPara.AxisIndex)},"; |
| | | _position += $"{DateTime.Now:yyyy-MM-dd HH:mm:ss.fff}"; |
| | | LogAsync(DateTime.Now, "", _position); |
| | | } |
| | | catch (Exception ex) |
| | | { |
| | | isSuccessAndStop = false; |
| | | LogAsync(DateTime.Now, $"轴{optionPara.AxisIndex}运动异常", ex.GetExceptionMessage()); |
| | | } |
| | | return isSuccessAndStop; |
| | | }); |
| | |
| | | /// <returns></returns> |
| | | public double GetPrfPosition(int axisNum) |
| | | { |
| | | lock (moveLock) |
| | | double position = 0; |
| | | double prfpos = 0; uint pclock = 0; |
| | | var ret = GTSCardAPI.GT_GetPrfPos((short)IConfig.CardNum, (short)axisNum, out prfpos, 1, out pclock); |
| | | if (ret != (short)GTSRetCode.GRCRunOK) |
| | | { |
| | | double position = 0; |
| | | double prfpos = 0; uint pclock = 0; |
| | | var ret = GTSCardAPI.GT_GetPrfPos((short)IConfig.CardNum, (short)axisNum, out prfpos, 1, out pclock); |
| | | if (ret != (short)GTSRetCode.GRCRunOK) |
| | | { |
| | | throw new Exception("轴" + axisNum + "获取规划位置异常,错误码:" + ret); |
| | | } |
| | | position = prfpos / IConfig.AxisVelocityRatio; |
| | | return position; |
| | | throw new Exception("轴" + axisNum + "获取规划位置异常,错误码:" + ret); |
| | | } |
| | | position = prfpos / IConfig.AxisVelocityRatio; |
| | | return position; |
| | | } |
| | | |
| | | /// <summary> |
| | |
| | | return position; |
| | | } |
| | | } |
| | | |
| | | |
| | | /// <summary> |
| | | /// Set Single Axis Do Jog Move |
| | |
| | | if (ret != (short)GTSRetCode.GRCRunOK) |
| | | { |
| | | LogAsync(DateTime.Now, "轴" + optionPara.AxisIndex + "APS_absolute_move异常", "错误码:" + ret + ";" + "重试次数:" + repeatTime); |
| | | Thread.Sleep(50); |
| | | Thread.Sleep(10); |
| | | } |
| | | repeatTime--; |
| | | } while (ret != (short)GTSRetCode.GRCRunOK && repeatTime > 0); |
| | |
| | | |
| | | LogAsync(DateTime.Now, "轴" + optionPara.AxisIndex + "开始运动", "目标坐标:" + optionPara.Destination); |
| | | short ret = 0; |
| | | repeatTime = 100; |
| | | bool isSuccessSetAxisParam = false; |
| | | int currentPosition = (int)GetPosition(optionPara.AxisIndex); |
| | | int dPosition = optionPara.Destination + currentPosition; |
| | | do |
| | | int timeout = optionPara.MovingTimeout; |
| | | while (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | //设置 运动参数 |
| | | isSuccessSetAxisParam = SetAxisParam(optionPara); |
| | |
| | | LogAsync(DateTime.Now, "轴" + optionPara.AxisIndex + "APS_absolute_move异常", "错误码:" + ret + ";" + "重试次数:" + repeatTime); |
| | | Thread.Sleep(50); |
| | | } |
| | | repeatTime--; |
| | | } while (ret != (short)GTSRetCode.GRCRunOK && !isSuccessSetAxisParam && repeatTime > 0); |
| | | timeout -= 50; |
| | | if ((ret == (short)GTSRetCode.GRCRunOK && isSuccessSetAxisParam) || (optionPara.MovingTimeout > 0 && timeout < 0)) |
| | | { |
| | | break; |
| | | } |
| | | } |
| | | |
| | | //运动开始后 检查运动是否停止 |
| | | bool isStop = false; |
| | |
| | | } |
| | | LogAsync(DateTime.Now, "轴" + optionPara.AxisIndex + "开始运动", "目标坐标:" + optionPara.Destination); |
| | | short ret = 0; |
| | | repeatTime = 100; |
| | | bool isSuccessSetAxisParam = false; |
| | | do |
| | | int timeout = optionPara.MovingTimeout; |
| | | while (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | //设置 运动参数 |
| | | isSuccessSetAxisParam = SetAxisParam(optionPara); |
| | |
| | | LogAsync(DateTime.Now, "轴" + optionPara.AxisIndex + "APS_absolute_move异常", "错误码:" + ret + ";" + "重试次数:" + repeatTime); |
| | | Thread.Sleep(50); |
| | | } |
| | | repeatTime--; |
| | | } while (ret != (short)GTSRetCode.GRCRunOK && !isSuccessSetAxisParam && repeatTime > 0); |
| | | timeout -= 50; |
| | | if ((ret == (short)GTSRetCode.GRCRunOK && isSuccessSetAxisParam) || (optionPara.MovingTimeout > 0 && timeout < 0)) |
| | | { |
| | | break; |
| | | } |
| | | } |
| | | |
| | | bool isStop = false; |
| | | repeatTime = 1000; |
| | |
| | | } |
| | | |
| | | /// <summary> |
| | | /// 运动停止 |
| | | /// 某个轴运动停止 |
| | | /// </summary> |
| | | /// <param name="axisNum">axisNo</param> |
| | | /// <param name="option">0表示平滑停止,1表示紧急停止</param> |
| | |
| | | } |
| | | |
| | | /// <summary> |
| | | /// 读取输入 |
| | | /// 读取IO输入 |
| | | /// </summary> |
| | | /// <param name="cardNum">卡号</param> |
| | | /// <param name="index">输入口</param> |
| | |
| | | { |
| | | int value; |
| | | GTSCardAPI.GT_GetDi(cardNum, GTSCardAPI.MC_GPI, out value); |
| | | if ((value & 1 << index) == 0) return true;//有输入返回true |
| | | if ((value & (1 << index)) == 0) return true;//有输入返回true |
| | | else return false; //无输入返回false |
| | | } |
| | | |
| | | /// <summary> |
| | | /// 输出 |
| | | /// 读取IO输出 |
| | | /// </summary> |
| | | /// <param name="cardNum">卡号</param> |
| | | /// <param name="index">输出口,返回1-16</param> |
| | | /// <param name="value">false表示输出,true表示关闭</param> |
| | | public void WriteOut(short cardNum, short index, bool value) |
| | | { |
| | | short outNum = (short)(index % 100 + 1); |
| | | if (value) |
| | | { |
| | | GTSCardAPI.GT_SetDoBit(cardNum, GTSCardAPI.MC_GPO, outNum, 0); |
| | | } |
| | | else |
| | | { |
| | | GTSCardAPI.GT_SetDoBit(cardNum, GTSCardAPI.MC_GPO, outNum, 1); |
| | | } |
| | | } |
| | | |
| | | /// <summary> |
| | | /// 停止 某个轴 |
| | | /// </summary> |
| | | /// <param name="cardNum"></param> |
| | | /// <param name="axisNum">轴号</param> |
| | | /// <param name="value">停止方式,false表示平滑停止,true表示紧急停止</param> |
| | | public void Stop(short cardNum, short axisNum, bool emergencyStop) |
| | | { |
| | | if (emergencyStop) |
| | | { |
| | | GTSCardAPI.GT_Stop(cardNum, 1 << (axisNum - 1), 1 << (axisNum - 1)); |
| | | } |
| | | else |
| | | { |
| | | GTSCardAPI.GT_Stop(cardNum, 1 << (axisNum - 1), 0); |
| | | } |
| | | } |
| | | |
| | | /// <summary> |
| | | /// IO输出 |
| | | /// </summary> |
| | | /// <param name="cardNum">卡号</param> |
| | | /// <param name="mdl">模块号</param> |
| | | /// <param name="index">IO输出</param> |
| | | /// <param name="value">true表示输出,false表示无输出</param> |
| | | public void MC_WriteDigitalOutput(short cardNum, short mdl, short index, bool value) |
| | | { |
| | | if (value) |
| | | { |
| | | GTSCardAPI.GT_SetExtIoBit(cardNum, mdl, index, 0); |
| | | } |
| | | else |
| | | { |
| | | GTSCardAPI.GT_SetExtIoBit(cardNum, mdl, index, 1); |
| | | } |
| | | } |
| | | |
| | | /// <summary> |
| | | /// 读取IO输出状态 |
| | | /// </summary> |
| | | /// <param name="cardNum"></param> |
| | | /// <param name="index"></param> |
| | | /// <param name="index">io索引</param> |
| | | /// <returns></returns> |
| | | public bool GetDoSts(short cardNum, short index) |
| | | public bool GetDoSts(short index) |
| | | { |
| | | short outNum = 0; |
| | | int outSts; |
| | | outNum = (short)(index % 100); |
| | | GTSCardAPI.GT_GetDo(cardNum, GTSCardAPI.MC_GPO, out outSts); |
| | | short outNum = (short)(index % 100); |
| | | GTSCardAPI.GT_GetDo((short)IConfig.CardNum, GTSCardAPI.MC_GPO, out outSts); |
| | | if ((outSts & (1 << outNum)) == 0) return true; |
| | | else return false; |
| | | } |
| | | |
| | | /// <summary> |
| | | /// 按位设置数字 IO 输出状态 |
| | | /// </summary> |
| | | /// <param name="index">输出口,返回1-16</param> |
| | | /// <param name="value">false表示输出,true表示关闭</param> |
| | | public override void WriteOutput(short index, IOValue value) |
| | | { |
| | | short outNum = (short)(index % 100 + 1); |
| | | if ((int)value <= 1) |
| | | { |
| | | GTSCardAPI.GT_SetDoBit((short)IConfig.CardNum, GTSCardAPI.MC_GPO, outNum, (short)value); |
| | | } |
| | | else |
| | | { |
| | | var currentValue = (int)MonitorValues.FirstOrDefault(u => u.IONum == outNum && u.IOType == IOType.OUTPUT).Value; |
| | | GTSCardAPI.GT_SetDoBit((short)IConfig.CardNum, GTSCardAPI.MC_GPO, outNum, (short)(currentValue == 1 ? 0 : 1)); |
| | | } |
| | | } |
| | | |
| | | /// <summary> |
| | |
| | | |
| | | #endregion |
| | | |
| | | public void Monitor() |
| | | #region IMonitor |
| | | |
| | | //public List<IOItem> MonitorValues { get; set; } = new List<IOItem>(); |
| | | |
| | | |
| | | public List<IOItem> GetMonitorValues() |
| | | { |
| | | throw new NotImplementedException(); |
| | | var result = new List<IOItem>(); |
| | | //读取IO输入 |
| | | int inValue; |
| | | GTSCardAPI.GT_GetDi((short)IConfig.CardNum, GTSCardAPI.MC_GPI, out inValue); |
| | | //读取IO输出 |
| | | int outValue; |
| | | GTSCardAPI.GT_GetDo((short)IConfig.CardNum, GTSCardAPI.MC_GPO, out outValue); |
| | | |
| | | //解析结果 |
| | | for (var index = 1; index <= 16; index++) |
| | | { |
| | | IOItem inItem = new IOItem() |
| | | { |
| | | IONum = index, |
| | | Value = (inValue & (1 << index)) == 0 ? IOValue.TRUE : IOValue.FALSE, |
| | | IOType = IOType.INPUT |
| | | }; |
| | | IOItem outItem = new IOItem() |
| | | { |
| | | IONum = index, |
| | | Value = (outValue & (1 << index)) == 0 ? IOValue.TRUE : IOValue.FALSE, |
| | | IOType = IOType.OUTPUT |
| | | }; |
| | | result.Add(inItem); |
| | | result.Add(outItem); |
| | | } |
| | | |
| | | return result; |
| | | } |
| | | |
| | | public void ResetAlarm() |
| | | public async override void Monitor() |
| | | { |
| | | await Task.Run(() => |
| | | { |
| | | while (CurrentState != EnumHelper.DeviceState.DSClose && CurrentState != EnumHelper.DeviceState.DSExcept && CurrentState != EnumHelper.DeviceState.DSUninit) |
| | | { |
| | | try |
| | | { |
| | | if (!IConfig.IsEnableMonitor) |
| | | return; |
| | | var newValues = GetMonitorValues(); |
| | | if (newValues == null || newValues.Count == 0) |
| | | continue; |
| | | |
| | | Stopwatch sw = new Stopwatch(); |
| | | sw.Start(); |
| | | if (MonitorValues.Count == newValues.Count) |
| | | { |
| | | var tempNew = newValues.DeepSerializeClone();//clone |
| | | var tempOld = MonitorValues.DeepSerializeClone(); |
| | | MonitorCheckAndInvoke(tempNew, tempOld); |
| | | } |
| | | MonitorValues = new List<IOItem>(newValues); |
| | | sw.Stop(); |
| | | |
| | | if (sw.ElapsedMilliseconds > 20) |
| | | { |
| | | LogAsync(DateTime.Now, $"{this.Name}轮询时间:{sw.ElapsedMilliseconds}", ""); |
| | | } |
| | | |
| | | if (IConfig.MonitorInterval > 0) |
| | | { |
| | | Thread.Sleep(IConfig.MonitorInterval); |
| | | } |
| | | |
| | | } |
| | | catch (Exception ex) |
| | | { |
| | | if (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | LogAsync(DateTime.Now, $"{this.Name}监听异常", ex.GetExceptionMessage()); |
| | | } |
| | | } |
| | | } |
| | | }); |
| | | } |
| | | |
| | | public override void OnMethodInvoked(IAsyncResult ar) |
| | | { |
| | | MotionCardMonitorSet monitorSet = ar.AsyncState as MotionCardMonitorSet; |
| | | ProcessResponse resValues = monitorSet.Response; |
| | | if (resValues.ResultValue == (int)ReplyValue.IGNORE) |
| | | { |
| | | return; |
| | | } |
| | | |
| | | Stopwatch sw = new Stopwatch(); |
| | | sw.Start(); |
| | | // 将指定IOItem写入板卡 |
| | | foreach (var replyIOData in monitorSet.ReplyIODatas) |
| | | { |
| | | //写入IO输出 |
| | | if (replyIOData.IOType == IOType.OUTPUT) |
| | | { |
| | | GTSCardAPI.GT_SetDoBit((short)IConfig.CardNum, GTSCardAPI.MC_GPI, (short)replyIOData.IONum, (short)replyIOData.Value); |
| | | } |
| | | // in只读不能写 |
| | | } |
| | | sw.Stop(); |
| | | LogAsync(DateTime.Now, $"{Name}反馈完成,耗时{sw.ElapsedMilliseconds}ms", $"{resValues.GetDisplayText()}"); |
| | | } |
| | | |
| | | protected void MonitorCheckAndInvoke(List<IOItem> tempNew, List<IOItem> tempOld) |
| | | { |
| | | #region 警报信息 |
| | | Parallel.ForEach(IConfig.WarningSetCollection, wSet => |
| | | { |
| | | MotionCardWarningSet warningSet = wSet as MotionCardWarningSet; |
| | | |
| | | bool isOn = (((int)((tempNew.FirstOrDefault(u => u.IONum == warningSet.TriggerIndex && u.IOType == warningSet.WarningIOModel)?.Value)) >> warningSet.TriggerIndex) & 1) == (warningSet.TriggerValue ? 1 : 0); |
| | | |
| | | if (warningSet.CurrentStatus != isOn) |
| | | { |
| | | warningSet.CurrentStatus = isOn; |
| | | warningSet.TriggerTime = DateTime.Now; |
| | | SaveAlarmCSVAsync(DateTime.Now, this.Name, warningSet); |
| | | ExcuteMonitorAlarm(DateTime.Now, this, warningSet); |
| | | } |
| | | }); |
| | | #endregion |
| | | |
| | | #region 监听信息 |
| | | Parallel.ForEach(IConfig.MonitorSetCollection, mSet => |
| | | { |
| | | MotionCardMonitorSet monitorSet = mSet as MotionCardMonitorSet; |
| | | if (monitorSet.TriggerIndex < 0 || monitorSet.TriggerIndex > tempNew.Count) |
| | | { |
| | | return; |
| | | } |
| | | |
| | | var newIOItem = tempNew.FirstOrDefault(u => u.IONum == monitorSet.TriggerIndex); |
| | | var oldIOItem = tempOld.FirstOrDefault(u => u.IONum == monitorSet.TriggerIndex); |
| | | |
| | | if (newIOItem?.Value != oldIOItem?.Value) |
| | | { |
| | | if (monitorSet.TriggerValue == -999 || (int)newIOItem.Value == monitorSet.TriggerValue) |
| | | { |
| | | if (monitorSet.OpConfig == null) |
| | | { |
| | | monitorSet.OpConfig = new OperationConfigBase(); |
| | | } |
| | | |
| | | //monitorSet.OpConfig.InputPara = monitorSet.InputDataIndex.ConvertAll(index => |
| | | //{ |
| | | // return tempNew[index].Value; |
| | | //}).ToList(); |
| | | |
| | | ExcuteMonitorInvoke(DateTime.Now, monitorSet.InvokeDevice, this, monitorSet); |
| | | } |
| | | } |
| | | }); |
| | | #endregion |
| | | } |
| | | |
| | | public override void ResetAlarm() |
| | | { |
| | | int axis_sts; |
| | | uint clk; |
| | |
| | | GTSCardAPI.GT_ClrSts((short)IConfig.CardNum, 1, (short)IConfig.AxisSettings.FindAll(u => u.IsAxisEnabled).Count); |
| | | } |
| | | |
| | | object _alarmLock = new object(); |
| | | private async void SaveAlarmCSVAsync(DateTime now, string plcName, IWarningSet ws) |
| | | { |
| | | await Task.Run(() => |
| | | { |
| | | lock (_alarmLock) |
| | | { |
| | | DirectoryInfo dir = new DirectoryInfo(this.IConfig.LogPath); |
| | | if (!dir.Exists) |
| | | { |
| | | dir.Create(); |
| | | } |
| | | |
| | | string path = Path.Combine(IConfig.LogPath, $"Alarm_{Name}_{now.ToString("yyyyMMdd")}.csv"); |
| | | bool fileExist = File.Exists(path); |
| | | |
| | | using (StreamWriter writer = new StreamWriter(path, true, System.Text.Encoding.UTF8)) |
| | | { |
| | | if (!fileExist) |
| | | { |
| | | writer.WriteLine("Time,Source,AlarmCode,AlarmDescription,AlarmStatus"); |
| | | } |
| | | |
| | | writer.WriteLine($"{now.ToString("HH:mm:ss.fff")},{plcName},{ws.WarningCode},{ws.WarningDescription},{(ws.CurrentStatus ? "报警" : "停止")}"); |
| | | |
| | | writer.Flush(); |
| | | writer.Close(); |
| | | } |
| | | } |
| | | }); |
| | | } |
| | | #endregion |
| | | } |
| | | } |