| | |
| | | } |
| | | |
| | | /// <summary> |
| | | /// 设备 运行 |
| | | /// 设备 运行(执行 板卡系列的操作的 集合) |
| | | /// </summary> |
| | | /// <param name="config"></param> |
| | | /// <returns></returns> |
| | | public override ResponseMessage Run(IOperationConfig config) |
| | | { |
| | | ResponseMessage responseMessage = new ResponseMessage(); |
| | | var opConfig = config as GTSCardOperationConfig; |
| | | 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 opConfig.PreCheckIOCollection) |
| | | foreach (var preCheck in operationSet.PreCheckIOCollection) |
| | | { |
| | | int timeout = opConfig.PreCheckIOTimeout; |
| | | int? ioData = null; |
| | | 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 || (opConfig.PreCheckIOTimeout > 0 && timeout < 0)) |
| | | if (preCheck.CheckValue == ioData || (operationSet.PreCheckIOTimeout > 0 && timeout < 0)) |
| | | { |
| | | break; |
| | | } |
| | |
| | | // 2.板卡运动 |
| | | if (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | responseMessage = MoveToPoint(opConfig); |
| | | |
| | | responseMessage = MoveToPoint(operationSet.MotionOperationCollection); |
| | | if (!responseMessage.Result) |
| | | { |
| | | return responseMessage; |
| | |
| | | // 3.IO输出 不需要超时 |
| | | if (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | foreach (var ioOutput in opConfig.IOOutputCollection) |
| | | 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) |
| | |
| | | // 4.IO确认 |
| | | if (CurrentState == DeviceState.DSOpen) |
| | | { |
| | | foreach (var ioConfirm in opConfig.IOConfirmCollection) |
| | | foreach (var ioConfirm in operationSet.IOConfirmCollection) |
| | | { |
| | | int timeout = opConfig.IOConfirmTimeout; |
| | | int? ioData = null; |
| | | 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 || (opConfig.IOConfirmTimeout > 0 && timeout < 0)) |
| | | if (ioConfirm.CheckValue == ioData || (operationSet.IOConfirmTimeout > 0 && timeout < 0)) |
| | | { |
| | | break; |
| | | } |
| | |
| | | public override ResponseMessage MoveToPoint(IOperationConfig opConfig) |
| | | { |
| | | ResponseMessage responseMessage = new ResponseMessage(); |
| | | var gtsOperationConfig = opConfig as GTSCardOperationConfig; |
| | | 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()); |
| | | responseMessage.Result = taskList.All(u => u.GetAwaiter().GetResult()); |
| | | if (!responseMessage.Result) |
| | |
| | | if (IConfig.AxisSettings.FirstOrDefault(a => a.AxisIndex == optionPara.AxisIndex)?.IsAxisEnabled ?? false) |
| | | { |
| | | string _position = ""; |
| | | string motionType = optionPara.MoveMode == EnumHelper.MotorMoveMode.Normal ? (optionPara.IsAbsolute ? "Abs" : "Rel") : optionPara.MoveMode.ToString(); |
| | | string motionType = optionPara.MoveMode == EnumHelper.MotionMode.Normal ? (optionPara.IsAbsolute ? "Abs" : "Rel") : optionPara.MoveMode.ToString(); |
| | | |
| | | _position = $"{DateTime.Now:yyyy-MM-dd HH:mm:ss.fff},{optionPara.AxisIndex},{motionType},{GetPosition(optionPara.AxisIndex)},{GetPrfPosition(optionPara.AxisIndex)},{optionPara.Destination},"; |
| | | |
| | | switch (optionPara.MoveMode) |
| | | { |
| | | case MotorMoveMode.Normal: |
| | | case MotionMode.Normal: |
| | | { |
| | | if (_isResetting) |
| | | { |
| | |
| | | |
| | | } |
| | | break; |
| | | case MotorMoveMode.FindOri: |
| | | case MotionMode.FindOri: |
| | | { |
| | | isSuccessAndStop = GoHome(optionPara); |
| | | } |
| | | break; |
| | | case MotorMoveMode.Jog: |
| | | case MotionMode.Jog: |
| | | { |
| | | isSuccessAndStop = JogMove(optionPara); |
| | | } |