using Cognex.VisionPro; using Cognex.VisionPro.ToolBlock; using MathNet.Numerics.LinearAlgebra; using Microsoft.CodeAnalysis.Scripting; using Org.BouncyCastle.Tls; using Prism.Events; using Prism.Ioc; using Prism.Regions; using System; using System.Collections.Generic; using System.IO; using System.Linq; using System.Reflection; using System.Text; using System.Threading; using System.Threading.Tasks; using System.Windows.Shapes; using Team.FFFeederService; using Team.FFFeederService.Interfaces; using TeamAAS_VP.Core; using TeamAAS_VP.Data; using TeamAAS_VP.Enums; using TeamAAS_VP.Events; using TeamAAS_VP.Interfaces; using TeamAAS_VP.Models; using TeamAAS_VP.Models.Calibration; using TeamAAS_VP.Models.Feeder; using TeamAAS_VP.Models.Product; using TeamAAS_VP.Resources.Languages; using System.ComponentModel; using System.Collections.Concurrent; namespace TeamAAS_VP.Services { /// /// Lightweight migration of Management.ExecuteRemoteCommand into a dedicated service. /// This service depends on existing domain services and will call into them. /// Only the core helpers used by the old ExecuteRemoteCommand are migrated (LoadProduct, GetCurrentProductName, GetCurrentProductID, GetCurrentProductSpeed, etc.). /// public class RemoteCommandService : IRemoteCommandService, INotifyPropertyChanged { private readonly IEventAggregator _eventAggregator; private readonly IProductService _productService; private readonly IConfigService _configService; private readonly ICalibrationService _calibrationService; private readonly IFeederService _feederService; private readonly ICameraService _cameraService; private readonly IRobotService _robotService; private readonly IContainerProvider _container; private readonly IRegionManager _regionManager; private readonly ISystemDatabaseService _systemDatabaseService; /// /// 计时器任务取消令牌 /// private CancellationTokenSource _cycleTimingCts; /// /// 清料任务取消令牌字典,Key为任务编号 /// private readonly ConcurrentDictionary _clearMaterialCtsDict = new ConcurrentDictionary(); // 字段 private int _activeCount; private int _visionActiveCount; private readonly ConcurrentDictionary _runningTasks = new ConcurrentDictionary(); // 实现 INotifyPropertyChanged public event PropertyChangedEventHandler PropertyChanged; private void OnPropertyChanged(string name) => PropertyChanged?.Invoke(this, new PropertyChangedEventArgs(name)); // 公开属性(只读) public bool IsExecuting => Volatile.Read(ref _activeCount) > 0; public bool IsExecutingVisionCommand => Volatile.Read(ref _visionActiveCount) > 0; // 可选事件(如果不想用 INotifyPropertyChanged) public event EventHandler ExecutionStateChanged; /// /// 计时器计时通知事件 /// public event EventHandler CycleTimingTicked; public RemoteCommandService(IEventAggregator eventAggregator, IRegionManager regionManager, IProductService productService, IConfigService configService, ICalibrationService calibrationService, IFeederService feederService, ICameraService cameraService, IRobotService robotService, IContainerProvider container, ISystemDatabaseService systemDatabaseService) { _eventAggregator = eventAggregator; _regionManager = regionManager; _productService = productService; _configService = configService; _calibrationService = calibrationService; _feederService = feederService; _cameraService = cameraService; _robotService = robotService; _container = container; _systemDatabaseService = systemDatabaseService; } public void Dispose() { } // 通用包裹器:包装并追踪任意异步工作 private async Task TrackExecutionAsync(Func> work, bool isVision, CancellationToken ct) { // create id for this run (可用于日志/诊断) var id = Guid.NewGuid(); // 增加计数器并通知 Interlocked.Increment(ref _activeCount); if (isVision) Interlocked.Increment(ref _visionActiveCount); OnPropertyChanged(nameof(IsExecuting)); OnPropertyChanged(nameof(IsExecutingVisionCommand)); ExecutionStateChanged?.Invoke(this, EventArgs.Empty); try { // 记录 task(便于外部查询) var task = work(ct); _runningTasks.TryAdd(id, task); var result = await task.ConfigureAwait(false); return result; } finally { // 减少计数器并通知 Interlocked.Decrement(ref _activeCount); if (isVision) Interlocked.Decrement(ref _visionActiveCount); // 移除记录(如果仍存在) _runningTasks.TryRemove(id, out _); OnPropertyChanged(nameof(IsExecuting)); OnPropertyChanged(nameof(IsExecutingVisionCommand)); ExecutionStateChanged?.Invoke(this, EventArgs.Empty); } } public async Task ExecuteAsync(string command, CancellationToken cancellationToken, Action callback) { var items = (command ?? string.Empty).Split(new[] { ',' }, StringSplitOptions.None).Select(s => s.Trim()).ToArray(); if (items.Length == 0) return; //触发命令的第一个参数作为命令类型 string triggerCommand = items[0]; //剩余参数作为命令参数 string[] commandParams = items.Skip(1).ToArray(); string response = string.Empty; //根据命令类型执行不同的命令 switch (triggerCommand) { case "LoadProduct": if (commandParams.Length < 1) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { var ok = await LoadProductAsync(commandParams[0], ct); return ok ? "OK" : "NG"; }, isVision: false, cancellationToken); callback?.Invoke($"LoadProduct,{response}"); break; case "GetProductName": //如果没有参数,则获取当前产品名称 if (commandParams.Length < 1) { response = await TrackExecutionAsync(async ct => { return await GetCurrentProductNameAsync(ct); }, isVision: false, cancellationToken); if (string.IsNullOrEmpty(response)) { callback?.Invoke("GetProductName,NG"); } else { callback?.Invoke($"GetProductName,{response}"); } break; } //如果有参数,则通过产品编号获取产品名称 else if (commandParams.Length == 1) { if (!int.TryParse(commandParams[0], out int productNumber)) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { return await GetProductNameByNumberAsync(productNumber, ct); }, isVision: false, cancellationToken); if (string.IsNullOrEmpty(response)) { callback?.Invoke($"GetProductName,NG"); } else { callback?.Invoke($"GetProductName,{response}"); } break; } else { callback?.Invoke("InvalidParameters"); return; } case "GetProductID": //如果没有参数,则获取当前产品编号 if (commandParams.Length < 1) { response = await TrackExecutionAsync(async ct => { int productNum = await GetCurrentProductNumberAsync(ct); return productNum.ToString(); }, isVision: false, cancellationToken); if (response == "-1") { callback?.Invoke("GetProductID,NG"); } else { callback?.Invoke($"GetProductID,{response}"); } break; } //如果有参数,则通过产品名称获取产品编号 else if (commandParams.Length == 1) { response = await TrackExecutionAsync(async ct => { int productNum = await GetProductNumberByNameAsync(commandParams[0], ct); return productNum.ToString(); }, isVision: false, cancellationToken); if (response == "-1") { callback?.Invoke($"GetProductID,NG"); } else { callback?.Invoke($"GetProductID,{response}"); } break; } else { callback?.Invoke("InvalidParameters"); return; } case "GetRobotPointsCountById": if (commandParams.Length < 2 || !int.TryParse(commandParams[0], out int robotNumber) || !int.TryParse(commandParams[1], out int pointNumber)) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { return await GetRobotPointInfoAsync(robotNumber, pointNumber, ct); }, isVision: false, cancellationToken); if (string.IsNullOrEmpty(response)) { callback?.Invoke($"GetRobotPointsCountById,NG"); } else { callback?.Invoke($"GetRobotPointsCountById,{response}"); } break; case "GetPalletPoint": if (commandParams.Length < 2 || !int.TryParse(commandParams[0], out int robotNumber1) || !int.TryParse(commandParams[1], out int palletNumber1) || !int.TryParse(commandParams[2], out int pointNumber1)) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { return await GetRobotPalletPointInfoAsync(robotNumber1, palletNumber1, pointNumber1, ct); }, isVision: false, cancellationToken); if (string.IsNullOrEmpty(response)) { callback?.Invoke($"GetPalletPoint,NG"); } else callback?.Invoke($"GetPalletPoint,{response}"); break; case "CycleTime": if (commandParams.Length < 1) { callback?.Invoke("InvalidParameters"); return; } if (int.Parse(commandParams[0]) == 1) { response = await TrackExecutionAsync(async ct => { bool cycleResult = await StartCycleTimingAsync(ct); return cycleResult ? "OK" : "NG"; }, isVision: false, cancellationToken); callback?.Invoke($"CycleTime,{response}"); break; } else { response = await TrackExecutionAsync(async ct => { bool cycleResult = await StopCycleTimingAsync(ct); return cycleResult ? "OK" : "NG"; }, isVision: false, cancellationToken); callback?.Invoke($"CycleTime,{response}"); break; } case "Record": if (commandParams.Length < 1) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { bool recordResult = await CreateProductionCountAsync(commandParams[0].Trim(), ct); return recordResult ? "OK" : "NG"; }, isVision: false, cancellationToken); callback?.Invoke($"Record,{response}"); break; case "RecordQuery": if (commandParams.Length < 1) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { int recordCount = await GetCurrentProductionCountAsync(commandParams[0].Trim(), ct); return recordCount.ToString(); }, isVision: false, cancellationToken); callback?.Invoke($"RecordQuery,{response}"); break; case "RecordReset": if (commandParams.Length < 1) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { bool recordResetResult = await ResetProductionCountAsync(commandParams[0].Trim(), ct); return recordResetResult ? "OK" : "NG"; }, isVision: false, cancellationToken); callback?.Invoke($"RecordReset,{response}"); break; case "Err": if (commandParams.Length < 2) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { bool errResult = await CreateAlarmRecordAsync(commandParams[0].Trim(), commandParams[1].Trim(), ct); return errResult ? "OK" : "NG"; }, isVision: false, cancellationToken); callback?.Invoke($"Err,{response}"); break; case "Info": if (commandParams.Length < 1) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { bool infoResult = await CreateOperationLogAsync(commandParams[0].Trim(), ct); return infoResult ? "OK" : "NG"; }, isVision: false, cancellationToken); callback?.Invoke($"Info,{response}"); break; case "GetGlobalParam": if (commandParams.Length == 1) { response = await TrackExecutionAsync(async ct => { return await GetGlobalParameterAsync(int.Parse(commandParams[0]), -1, ct); }, isVision: false, cancellationToken); if (string.IsNullOrEmpty(response)) { callback?.Invoke("GetGlobalParam,NG"); } else { callback?.Invoke($"GetGlobalParam,{response}"); } break; } else if (commandParams.Length == 2) { response = await TrackExecutionAsync(async ct => { return await GetGlobalParameterAsync(int.Parse(commandParams[0]), int.Parse(commandParams[1]), ct); }, isVision: false, cancellationToken); if (string.IsNullOrEmpty(response)) { callback?.Invoke("GetGlobalParam,NG"); } else { callback?.Invoke($"GetGlobalParam,{response}"); } break; } else { callback?.Invoke("InvalidParameters"); return; } case "GetSpeed": response = await TrackExecutionAsync(async ct => { return await GetOperationSpeedAsync(ct); }, isVision: false, cancellationToken); if (string.IsNullOrEmpty(response)) { callback?.Invoke("GetSpeed,NG"); return; } else callback?.Invoke($"GetSpeed,{response}"); break; case "GetToolParam": if (commandParams.Length < 2) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { return await GetToolParamAsync(commandParams[0], int.Parse(commandParams[1]), ct); }, isVision: false, cancellationToken); if (string.IsNullOrEmpty(response)) { callback?.Invoke("GetToolParam,NG"); return; } else callback?.Invoke($"GetToolParam,{response}"); break; case "GetProcedureParam": if (commandParams.Length < 1) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { return await GetProcessParamAsync(commandParams[0], ct); }, isVision: false, cancellationToken); if (string.IsNullOrEmpty(response)) { callback?.Invoke("GetProcedureParam,NG"); return; } else callback?.Invoke($"GetProcedureParam,{response}"); break; case "StartClearMaterial": if (commandParams.Length < 1) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { bool startClearResult = await ExecuteClearMaterialTaskAsync(int.Parse(commandParams[0]), ct); return startClearResult ? "OK" : "NG"; }, isVision: false, cancellationToken); callback?.Invoke($"StartClearMaterial,{response}"); break; case "StopClearMaterial": if (commandParams.Length < 1) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { bool stopClearResult = await StopClearMaterialTaskAsync(int.Parse(commandParams[0]), ct); return stopClearResult ? "OK" : "NG"; }, isVision: false, cancellationToken); callback?.Invoke($"StopClearMaterial,{response}"); break; //获取机器人是否进入调试模式 case "RobotIsDebugMode": if (commandParams.Length < 1) { callback?.Invoke("InvalidParameters"); return; } response = await TrackExecutionAsync(async ct => { bool isDebugMode = await IsRobotInDebugModeAsync(int.Parse(commandParams[0]), ct); return isDebugMode ? "1" : "0"; }, isVision: false, cancellationToken); callback?.Invoke($"RobotIsDebugMode,{response}"); break; default: //获取当前产品 var currentProduct = _productService.GetCurrentProduct(); if (currentProduct == null) return; // 查找对应的流程 var procedure = currentProduct.CameraProcedures .SelectMany(cp => cp.ProcedureModels) .FirstOrDefault(p => p.TriggerCommand == triggerCommand); if (procedure == null) return; // 假设 ExecuteFeederVisionTaskAsync 返回 (bool, string[]) var visionResult = await TrackExecutionAsync(async ct => { var r = await ExecuteVisionTaskAsync(procedure, commandParams, ct); // 如果需要转换类型,包装成 Tuple return Tuple.Create(r.IsSucceed, r.Response); }, isVision: true, cancellationToken); if (visionResult.Item1) { foreach (var item in visionResult.Item2) { callback?.Invoke($"{triggerCommand},OK,{item}"); } } else { string msg = string.Empty; if (visionResult.Item2 != null && visionResult.Item2.Length>0) { msg = visionResult.Item2[0]; } callback?.Invoke($"{triggerCommand},NG,{msg}"); } break; } } //加载产品 public async Task LoadProductAsync(string productName, CancellationToken cancellationToken) { //检查是否存在该名称的产品 bool exists = _productService.ContainsProductByName(productName); if (exists) { //获取产品名称对应的产品 var product = _productService.GetAllProducts().FirstOrDefault(p => p.Name == productName); //加载产品 await _productService.LoadProductAsync(product.ID); //设置为当前产品 _productService.SetCurrentProduct(product.ID); return true; } //获取产品编号对应的产品 if (int.TryParse(productName, out int productNumber)) { var product = _productService.GetAllProducts().FirstOrDefault(p => p.NumberCode == productNumber); if (product != null) { //加载产品 await _productService.LoadProductAsync(product.ID); //设置为当前产品 _productService.SetCurrentProduct(product.ID); return true; } } return false; } //通过产品编号获取产品名称 public Task GetProductNameByNumberAsync(int productNumber, CancellationToken cancellationToken) { var product = _productService.GetAllProducts().FirstOrDefault(p => p.NumberCode == productNumber); if (product != null) { return Task.FromResult(product.Name); } return Task.FromResult(string.Empty); } //获取当前的产品名称 public Task GetCurrentProductNameAsync(CancellationToken cancellationToken) { var currentProduct = _productService.GetCurrentProduct(); if (currentProduct != null) { return Task.FromResult(currentProduct.Name); } return Task.FromResult(string.Empty); } //通过产品名称获取产品编号 public Task GetProductNumberByNameAsync(string productName, CancellationToken cancellationToken) { //检查是否存在该名称的产品 bool exists = _productService.ContainsProductByName(productName); if (exists) { //获取产品名称对应的产品 var product = _productService.GetAllProducts().FirstOrDefault(p => p.Name == productName); return Task.FromResult(product.NumberCode); } return Task.FromResult(-1); } //获取当前的产品编号 public Task GetCurrentProductNumberAsync(CancellationToken cancellationToken) { var currentProduct = _productService.GetCurrentProduct(); if (currentProduct != null) { return Task.FromResult(currentProduct.NumberCode); } return Task.FromResult(-1); } //通过机器人编号和点位编号获取机器人点位信息 public Task GetRobotPointInfoAsync(int robotNumber, int pointNumber, CancellationToken cancellationToken) { //获取当前产品 var currentProduct = _productService.GetCurrentProduct(); if (currentProduct == null) return Task.FromResult(string.Empty); //获取机器人编号对应的机器人信息 var robot = _configService.GetAllRobots().FirstOrDefault(r => r.RobotNo == robotNumber); if (robot == null) return Task.FromResult(string.Empty); //获取机器人点位信息 var robotPoint = currentProduct.RobotPoint.Robots.FirstOrDefault(rp => rp.Id == robot.Id); if (robotPoint == null) return Task.FromResult(string.Empty); //获取点位信息 var point = robotPoint.Points.FirstOrDefault(p => p.Number == pointNumber); if (point == null) return Task.FromResult(string.Empty); return Task.FromResult(point.ToString()); } // /// 通过机器人编号和托盘编号、点编号获取机器人托盘点位信息 /// /// 机器人编号 /// 托盘编号 /// 点编号 /// /// public Task GetRobotPalletPointInfoAsync(int robotNumber, int palletNumber, int pointNumber, CancellationToken cancellationToken) { // 获取当前产品 var currentProduct = _productService.GetCurrentProduct(); if (currentProduct == null) return Task.FromResult(string.Empty); //获取机器人编号对应的机器人信息 var robot = _configService.GetAllRobots().FirstOrDefault(r => r.RobotNo == robotNumber); if (robot == null) return Task.FromResult(string.Empty); //获取机器人点位信息 var robotPoint = currentProduct.RobotPoint.Robots.FirstOrDefault(rp => rp.Id == robot.Id); if (robotPoint == null) return Task.FromResult(string.Empty); //获取托盘 var pallet = robotPoint.Pallets.FirstOrDefault(p => p.PalletNo == palletNumber); if (pallet == null) return Task.FromResult(string.Empty); PalletTool palletTool = new PalletTool(pallet); if (pointNumber > palletTool.Points.Length || pointNumber < 1) return Task.FromResult(string.Empty); var pos = palletTool.Points[pointNumber - 1]; string response = $"{robotNumber},{palletNumber},{palletTool.Points.Length},{pos.Number},{pos.X:F3},{pos.Y:F3},{pos.Z:F3},{pos.U:F3},{pos.V:F3},{pos.W:F3},{pos.Local},{pos.Tool},{pos.Hand}"; return Task.FromResult(response); } //开始节拍计时 public Task StartCycleTimingAsync(CancellationToken cancellationToken) { //TODO: 实现节拍计时开始逻辑 //如果当前已经在计时,则取消之前的计时,然后重新开始计时 if (_cycleTimingCts != null) { _cycleTimingCts.Cancel(); _cycleTimingCts.Dispose(); } _cycleTimingCts = new CancellationTokenSource(); var token = _cycleTimingCts.Token; Task.Run(async () => { var startTime = DateTime.UtcNow; while (!token.IsCancellationRequested) { var elapsed = DateTime.UtcNow - startTime; OnCycleTimingTicked(elapsed); await Task.Delay(100, token); // 每100毫秒更新一次 } }, token); return Task.FromResult(true); } //停止节拍计时 public Task StopCycleTimingAsync(CancellationToken cancellationToken) { if (_cycleTimingCts != null) { _cycleTimingCts.Cancel(); _cycleTimingCts.Dispose(); _cycleTimingCts = null; } return Task.FromResult(true); } //创建一条生产计数,传入计数项 public Task CreateProductionCountAsync(string countItem, CancellationToken cancellationToken) { _systemDatabaseService.RecordProductionAsync(new ProductionRecord { Category = countItem, ProductName = _productService.GetCurrentProduct()?.Name ?? "Unknown", Quantity = 1, Timestamp = DateTime.UtcNow }); return Task.FromResult(true); } //获取当前生产计数 public async Task GetCurrentProductionCountAsync(string countItem, CancellationToken cancellationToken) { //获取当前产品 var currentProduct = _productService.GetCurrentProduct(); if (currentProduct == null) return 0; //获取分类集合 var records = _systemDatabaseService.GetProductCategoriesAsync(currentProduct.Name); //计算指定分类的总产能 int totalCount =await _systemDatabaseService.GetTotalProductionAsync(currentProduct.Name, new List { countItem }); return totalCount; } //重置生产计数 public async Task ResetProductionCountAsync(string countItem, CancellationToken cancellationToken) { //获取当前产品 var currentProduct = _productService.GetCurrentProduct(); if (currentProduct == null) return false; await _systemDatabaseService.ResetProductionAsync(currentProduct.Name); return true; } //创建一条报警记录 public Task CreateAlarmRecordAsync(string alarmCode, string alarmDescription, CancellationToken cancellationToken) { SendTaskMessage(alarmDescription, MessageLevel.Error); _systemDatabaseService.RecordAlarmAsync(new AlarmRecord { Code = alarmCode, Message = alarmDescription, Source = "Unknown", Time = DateTime.UtcNow }); return Task.FromResult(true); } //创建一条运行信息记录 public Task CreateOperationLogAsync(string logMessage, CancellationToken cancellationToken) { SendTaskMessage(logMessage, MessageLevel.Info); return Task.FromResult(true); } //获取当前产品指定编号的全局参数 public Task GetGlobalParameterAsync(int parameterNumber, int itemIndex, CancellationToken cancellationToken) { //获取当前产品 var currentProduct = _productService.GetCurrentProduct(); if (currentProduct == null) return Task.FromResult(string.Empty); if (currentProduct.GlobalParamListCollection == null) return Task.FromResult(string.Empty); //获取产品全局参数 var globalParam = currentProduct.GlobalParamListCollection.FirstOrDefault(p => p.Number == parameterNumber); if (globalParam == null) return Task.FromResult(string.Empty); string response = string.Empty; if (itemIndex == 1) { response = $"{globalParam.Number},{globalParam.Name},{globalParam.Param1}"; } else if (itemIndex == 2) { response = $"{globalParam.Number},{globalParam.Name},{globalParam.Param2}"; } else if (itemIndex == 3) { response = $"{globalParam.Number},{globalParam.Name},{globalParam.Param3}"; } else if (itemIndex == 4) { response = $"{globalParam.Number},{globalParam.Name},{globalParam.Param4}"; } else { response = globalParam.ToString(); } return Task.FromResult(response); } //获取当前产品的运行速度 public Task GetOperationSpeedAsync(CancellationToken cancellationToken) { //获取当前产品 var currentProduct = _productService.GetCurrentProduct(); if (currentProduct == null) return Task.FromResult(string.Empty); string response = $"{currentProduct.Speed},{currentProduct.Accel},{currentProduct.Speeds},{currentProduct.Accels},{Convert.ToInt16(currentProduct.Power)},{Convert.ToInt16(currentProduct.IsUserUpCamera)}"; return Task.FromResult(response); } //获取末端工具信息,传入流程触发命令和工具编号 public Task GetToolParamAsync(string triggerCommand, int toolNumber, CancellationToken cancellationToken) { //获取当前产品 var currentProduct = _productService.GetCurrentProduct(); if (currentProduct == null) return Task.FromResult(string.Empty); //查找对应的流程 ProcedureModel procedure = currentProduct.CameraProcedures .SelectMany(cp => cp.ProcedureModels) .FirstOrDefault(p => p.TriggerCommand == triggerCommand); if (procedure == null || procedure.ToolInfo == null) return Task.FromResult(string.Empty); //查找对应的工具 var tool = procedure.ToolInfo.FirstOrDefault(t => t.Number == toolNumber); if (tool == null) return Task.FromResult(string.Empty); if (tool.Tool == null) return Task.FromResult(string.Empty); string response = $"{tool.Tool.Number},{tool.Tool.X:F3},{tool.Tool.Y:F3},{tool.OffsetX:F3},{tool.OffsetY:F3},{tool.OffsetZ:F3},{tool.OffsetU:F3}"; return Task.FromResult(response); } //获取流程参数信息,传入流程触发命令 public Task GetProcessParamAsync(string triggerCommand, CancellationToken cancellationToken) { //获取当前产品 var currentProduct = _productService.GetCurrentProduct(); if (currentProduct == null) return Task.FromResult(string.Empty); //查找对应的流程 ProcedureModel procedure = currentProduct.CameraProcedures .SelectMany(cp => cp.ProcedureModels) .FirstOrDefault(p => p.TriggerCommand == triggerCommand); if (procedure == null || procedure.ToolInfo == null) return Task.FromResult(string.Empty); StringBuilder response = new StringBuilder(); response.Append($"{procedure.WaitPhoto}"); if (procedure.UserDefineParameters != null) { //附加用户自定义参数 //遍历所有用户自定义参数,以分号分隔 foreach (var param in procedure.UserDefineParameters) { response.Append("," + param.ToString()); } } return Task.FromResult(response.ToString()); } //执行清料任务 public async Task ExecuteClearMaterialTaskAsync(int taskNumber, CancellationToken cancellationToken) { //获取清料任务 var feederClearWork=_configService.GetClearanceTaskByNumber(taskNumber); if (feederClearWork == null) { return false; } IVoiceCoilMotorFeeder Feeder = _feederService.GetFeeder(feederClearWork.FeederId); if (!Feeder.IsConnected) { return false; } //如果当前已有该任务在执行,则返回失败 if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode)) { return false; } _clearMaterialCtsDict[feederClearWork.TaskCode] = new CancellationTokenSource(); if (cancellationToken != null) { //将外部取消令牌与内部取消令牌关联 cancellationToken.Register(() => { if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode)) { _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel(); } }); } var token = _clearMaterialCtsDict[feederClearWork.TaskCode].Token; for (int i = 0; i < feederClearWork.ClearCount; i++) { //1.Feeder振动之前,打开挡板 await Feeder.OutputAsync((int)feederClearWork.BeforeOutput + 1, 0); await Task.Delay(200, token); if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token!=null && token.IsCancellationRequested)) { await Feeder.StopOutputAsync(); if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode)) { _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel(); _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _); } return false; } //2.执行配置的Feeder振动任务 for (int j = 0; j < feederClearWork.VibrationCount; j++) { await ExecuteFeederWorks(Feeder, feederClearWork.FeederWorks, token, true); if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested)) { await Feeder.StopOutputAsync(); if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode)) { _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel(); _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _); } return false; } //如果料仓停止了,则打开料仓运动 if (!await Feeder.GetOutputStatusAsync()) { await Feeder.OutputAsync((int)feederClearWork.BeforeOutput + 1, 0); } if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested)) { await Feeder.StopOutputAsync(); if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode)) { _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel(); _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _); } return false; } } if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested)) { await Feeder.StopOutputAsync(); if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode)) { _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel(); _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _); } return false; } //3.Feeder振动之后,关闭挡板 await Feeder.StopOutputAsync(); await Task.Delay(300, token); if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested)) { await Feeder.StopOutputAsync(); if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode)) { _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel(); _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _); } return false; } } //3.Feeder振动之后,关闭挡板 await Feeder.StopOutputAsync(); await Task.Delay(300, token); if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested)) { await Feeder.StopOutputAsync(); if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode)) { _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel(); _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _); } return false; } if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode)) { _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel(); _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _); } return true; } //终止清料任务 public Task StopClearMaterialTaskAsync(int taskNumber, CancellationToken cancellationToken) { //获取清料任务 var feederClearWork = _configService.GetClearanceTaskByNumber(taskNumber); if (feederClearWork == null) { return Task.FromResult(false); } if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode)) { _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel(); _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _); } return Task.FromResult(true); } /// /// 获取机器人是否进入调试模式 /// /// /// public Task IsRobotInDebugModeAsync(int robotNumber, CancellationToken cancellationToken) { var robotInfo = _configService.GetAllRobots().FirstOrDefault(r => r.RobotNo == robotNumber); if (robotInfo == null) { return Task.FromResult(false); } var robot = _robotService.GetRobot(robotInfo.Id); if (robot != null) return Task.FromResult(robot.EnterDebugMode); return Task.FromResult(false); } /// /// 执行视觉任务 /// /// 流程触发命令 /// 是否先振动 /// 是否先拍照 /// 机器人当前点位 /// 视觉工具输入参数 /// /// public async Task<(bool IsSucceed, string[] Response)> ExecuteVisionTaskAsync(ProcedureModel procedure, string[] items, CancellationToken cancellationToken) { //获取当前产品 var currentProduct = _productService.GetCurrentProduct(); //检测当前流程的本地是否存在流程执行脚本文件,如果存在则调用脚本执行视觉任务 string scriptFilePath = FilePath.ProductsPath + "//" + currentProduct.Name + "//" + procedure.CameraName + "//" + procedure.Name + ".cs"; if (File.Exists(scriptFilePath)) { //调用脚本执行视觉任务 try { string script = FileHelper.ReadFile(scriptFilePath); SendTaskMessage(Lang.执行视觉处理脚本, MessageLevel.Debug); Tuple rstn = null; var rst1 = await ScriptHelper.ExecuteVisionScriptingAsync(script, _regionManager, _eventAggregator, _container, procedure, items, rst => { rstn = rst; }); if (!rst1.Item1) { SendTaskMessage(Lang.视觉处理脚本出错, MessageLevel.Error); foreach (var item in rst1.Item2) { SendTaskMessage(item, MessageLevel.Error); } return (false, new string[] { "ScriptError" }); } return (rstn.Item1, rstn.Item2); } catch (Exception ex) { SendTaskMessage(ex.Message, MessageLevel.Error); LogHelper.WriteLogError("执行视觉处理脚本时出错!", ex); return (false, new string[] { "ScriptException" }); } } else { //正常执行模块,每次拍照,会返回所有的结果数据 IVoiceCoilMotorFeeder Feeder = null; if (procedure.FeederId != Guid.Empty) { Feeder = _feederService.GetFeeder(procedure.FeederId); return await ExecuteFeederVisionTaskAsync(Feeder, procedure, items, cancellationToken); } else { var result = await ExecuteNormalVisionTaskAsync(procedure, items, cancellationToken); return (result.IsSucceed, new string[] { result.Response }); } } } /// /// 更新计时器通知 /// /// private void OnCycleTimingTicked(TimeSpan elapsed) { CycleTimingTicked?.Invoke(this, elapsed); } private void SendTaskMessage(string msg, MessageLevel level) { App.Current.Dispatcher.Invoke(() => { _eventAggregator.GetEvent().Publish(new Models.MessageStruct() { Message = msg, level = level }); }); } #region 执行视觉任务辅助方法 /// /// 执行Feeder视觉引导任务 /// /// /// /// /// /// public async Task<(bool IsSucceed, string[] Response)> ExecuteFeederVisionTaskAsync(IVoiceCoilMotorFeeder feeder, ProcedureModel procedure, string[] items, CancellationToken cancellationToken) { // 如果输入的items中是否包含Vibration和NoVibration,这两个分别对应是否先振动和是否先拍照 bool doVibrateFirst = items != null && items.Contains("VibrateFirst"); bool doCaptureFirst = items != null && items.Contains("CaptureFirst"); if (doVibrateFirst && doCaptureFirst) doCaptureFirst = false; // 如果两个都包含,则以振动优先为准 // 触发命令传入的输入终端 Dictionary InputTerminal = null; // 解析触发命令传入的输入终端参数 //判断传入参数中是否存在“SetInputs” if (items != null && items.Length > 1 && items[0] == "SetInputs") { //依次从索引1开始解析参数,格式为 key=value,直到遇到非key=value格式的参数为止 InputTerminal = new Dictionary(); for (int i = 1; i < items.Length; i++) { var pair = items[i].Split('='); if (pair.Length == 2) { InputTerminal[pair[0]] = pair[1]; } else { break; // 遇到非key=value格式的参数,停止解析 } } } //执行Feeder相机拍照前的任务 await ExecuteFeederForPhotoBefore(feeder, procedure, doVibrateFirst, doCaptureFirst, cancellationToken); // 如果遇到取消令牌,则直接返回失败 if (cancellationToken != null && cancellationToken.IsCancellationRequested) { await feeder.CloseLightAsync(); return (false, new string[] { "FeederTaskCancelled" }); } DateTime nowtime = DateTime.Now; //拍照失败时,需要多次拍照 for (int i = 0; i < procedure.FeederFailLimit; i++) { if (cancellationToken != null && cancellationToken.IsCancellationRequested) { await feeder.CloseLightAsync(); return (false, new string[] { "VisionTaskCancelled" }); } SendTaskMessage(Lang.开始执行视觉流程.Replace("{0}", $"{i + 1}").Replace("{1}", procedure.Name), MessageLevel.Info); // 1. 执行相机拍照并运行视觉工具 bool visionSucceed = ExecutePhoto(procedure, InputTerminal, out CogToolBlockTerminalCollection outputCollection); if (!visionSucceed) { SendTaskMessage(Lang.视觉任务执行失败, MessageLevel.Error); continue; } if (!outputCollection.Contains("Found")) { SendTaskMessage(Lang.未找到视觉输出结果, MessageLevel.Error); return (false, new string[] { "NoFoundOutput" }); } procedure.LastBlobArea = Convert.ToDouble(outputCollection["BlobTotalArea"].Value); // 2. 获取视觉输出结果 bool Found = (bool)(outputCollection["Found"].Value); if (!Found) { SendTaskMessage(Lang.拍照NG, MessageLevel.Debug); await ExecuteFeederForPhotoLater(feeder, procedure, cancellationToken); continue; } SendTaskMessage(Lang.拍照OK, MessageLevel.Debug); if (procedure.ProcedureOutputs == null) { SendTaskMessage(Lang.视觉流程未配置输出项, MessageLevel.Alarm); return (false, new string[] { "NoOutputConfigured" }); } // 3. 获取视觉输出结果 LogHelper.WriteLogInfo("开始获取视觉输出结果"); var (IsSucceed, ErrMsg, Output) = GetVisionOutput(procedure, outputCollection, null); if (!IsSucceed) { SendTaskMessage(Lang.获取视觉输出结果失败, MessageLevel.Error); return (false, new string[] { ErrMsg }); } // 4. 组织返回结果 int outputPointCount = 0;//输出点的数量 List currentPoints = new List(); //点位数据 List outputItems = new List(); //多项输出结果集合 foreach (var output in procedure.ProcedureOutputs) { if (Output.ContainsKey(output.Name)) { var (IsPoint, Value) = Output[output.Name]; if (IsPoint) { //Value是点位数据,类型:List,string[]是一个点位,里面是X、Y,U等数据 //将所有点位数据和单个点位数据中的坐标之间都用逗号分隔,多个点位之间用逗号分隔 List points = Value as List; List allpoints = new List(); for (int j = 0; j < points.Count; j++) { //如果当前流程开启了剔除重复点功能,则进行剔除 if (procedure.IsExcludeNearPoint && procedure.LastRunPoints != null && procedure.LastRunPoints.Count > 0) { //当前点的坐标数据 double px = double.Parse(points[j][0]); double py = double.Parse(points[j][1]); double pu = double.Parse(points[j][2]); //检查当前点是否与上次运行的点过于接近 //使用linq来检测上一次的点位集合中,是否存在某个点与当前点的x,y,u的差值小于设定的阈值 bool isNear = procedure.LastRunPoints.Any(lp => Math.Abs(lp[0] - px) < procedure.ExcludeNearPointThreshol && Math.Abs(lp[1] - py) < procedure.ExcludeNearPointThreshol && Math.Abs(lp[2] - pu) < procedure.ExcludeNearPointThreshol); if (isNear) continue; //如果存在接近的点,则跳过当前点,不进行添加 } //单个点位内坐标之间逗号分隔 allpoints.Add(string.Join(",", points[j])); //如果输出模式是AllAtOnce或者BatchedUntilTerminator,则需要检查是否达到最大点位数量限制 if (procedure.OutputPointMode == OutputPointMode.AllAtOnce || procedure.OutputPointMode == OutputPointMode.BatchedUntilTerminator) { //如果当前总点位数量已经达到最大限制,则停止添加更多点位 if (allpoints.Count >= procedure.OutputPointCountMax) { break; } } currentPoints.Add(new double[] { double.Parse(points[j][0]), double.Parse(points[j][1]), double.Parse(points[j][2]) }); } //多个点位之间逗号分隔 string pointstr = allpoints.Count + "," + string.Join(",", allpoints); if (procedure.OutputPointMode == OutputPointMode.UntilTerminator || procedure.OutputPointMode == OutputPointMode.BatchedUntilTerminator) { outputItems.AddRange(allpoints); } else { outputItems.Add(pointstr); } outputPointCount += allpoints.Count; } else { string itemstr = Value != null ? Value.ToString() : string.Empty; outputItems.Add(itemstr); } } } procedure.LastRunPoints = currentPoints; //关闭Feeder灯光 if (feeder.IsConnected) { await feeder.CloseLightAsync(); } //如果输出模式是AllAtOnce或者BatchedUntilTerminator,则分次发送数据 if (procedure.OutputPointMode == OutputPointMode.UntilTerminator || procedure.OutputPointMode == OutputPointMode.BatchedUntilTerminator) { //将outputItems按照procedure.OutputSeparator进行拼接,得到最终返回结果 string finalResponse = string.Join(procedure.OutputSeparator, outputItems); return (true, outputItems.ToArray()); } else { //否则,一次发送所有数据 //将outputItems按照procedure.OutputSeparator进行拼接,得到最终返回结果 string finalResponse = string.Join(procedure.OutputSeparator, outputItems); return (true, new string[] { finalResponse }); } } //关闭Feeder灯光 if (feeder.IsConnected) { await feeder.CloseLightAsync(); } SendTaskMessage(Lang.多次拍照失败, MessageLevel.Alarm); return (false, new string[] { "VisionFailed" }); } /// /// 执行普通视觉任务 /// /// /// /// /// public async Task<(bool IsSucceed, string Response)> ExecuteNormalVisionTaskAsync(ProcedureModel procedure, string[] items, CancellationToken cancellationToken) { // 开始执行前的时间点 DateTime startTime = DateTime.Now; try { // 触发命令传入的输入终端 Dictionary InputTerminal = null; // 解析触发命令传入的输入终端参数 //判断传入参数中是否存在“SetInputs” if (items != null && items.Length>1 && items[0] == "SetInputs") { InputTerminal = items.Skip(1) .Select(x => x.Split('=')) .Where(y => y.Length == 2) .ToDictionary(z => z[0], z => z[1]); } // 机器人当前坐标 double[] currentpos = null; // 判断传入参数长度是否3,并且是否都是double if (items != null && items.Length >= 3 && double.TryParse(items[0], out double _x) && double.TryParse(items[1], out double _y) && double.TryParse(items[2], out double _u)) { currentpos = new double[] { _x, _y, _u }; } //拍照失败时,需要多次拍照 for (int i = 0; i < procedure.FeederFailLimit; i++) { if (cancellationToken != null && cancellationToken.IsCancellationRequested) { return (false, "VisionTaskCancelled"); } // 1. 执行相机拍照并运行视觉工具 LogHelper.WriteLogInfo("开始执行相机拍照并运行视觉工具"); bool visionSucceed = ExecutePhoto(procedure, InputTerminal, out CogToolBlockTerminalCollection outputCollection); if (!visionSucceed) { SendTaskMessage(Lang.视觉任务执行失败, MessageLevel.Error); continue; } if (!outputCollection.Contains("Found")) { SendTaskMessage(Lang.未找到视觉输出结果, MessageLevel.Error); return (false, "NoFoundOutput"); } bool Found = (bool)(outputCollection["Found"].Value); if (!Found) { SendTaskMessage(Lang.拍照NG, MessageLevel.Debug); continue; } SendTaskMessage(Lang.拍照OK, MessageLevel.Debug); // 2. 获取视觉输出结果 LogHelper.WriteLogInfo("开始获取视觉输出结果"); var (IsSucceed, ErrMsg, Output) = GetVisionOutput(procedure, outputCollection, currentpos); if (!IsSucceed) { SendTaskMessage(Lang.获取视觉输出结果失败, MessageLevel.Error); return (false, ErrMsg); } // 3. 组织返回结果 List outputItems = new List(); //多项输出结果集合 foreach (var output in procedure.ProcedureOutputs) { if (Output.ContainsKey(output.Name)) { var (IsPoint, Value) = Output[output.Name]; if (IsPoint) { //Value是点位数据,类型:List,string[]是一个点位,里面是X、Y,U等数据 //将所有点位数据和单个点位数据中的坐标之间都用逗号分隔,多个点位之间用逗号分隔 List points = Value as List; List allpoints = new List(); for (int j = 0; j < points.Count; j++) { //单个点位内坐标之间逗号分隔 allpoints.Add(string.Join(",", points[j])); } //多个点位之间逗号分隔 string pointstr = allpoints.Count + "," + string.Join(",", allpoints); outputItems.Add(pointstr); } else { string itemstr = Value != null ? Value.ToString() : string.Empty; outputItems.Add(itemstr); } } } //将outputItems按照procedure.OutputSeparator进行拼接,得到最终返回结果 string finalResponse = string.Join(procedure.OutputSeparator, outputItems); return (true, finalResponse); } return (false, "VisionFailed"); } catch (Exception ex) { SendTaskMessage(ex.Message, MessageLevel.Error); LogHelper.WriteLogError("执行普通视觉任务时出错!", ex); return (false, "Exception"); } } /// /// 执行相机拍照 /// /// /// 输入终端参数 /// 输出终端结果 /// public bool ExecutePhoto(ProcedureModel procedure, Dictionary InputTerminal, out CogToolBlockTerminalCollection outputCollection) { try { // 1. 采集图像 var camera = _cameraService.GetCamera(procedure.CameraId); bool succed = camera.SetExposureTime(procedure.ExposureTime); if (!succed) { SendTaskMessage($"相机曝光设置失败!", MessageLevel.Error); } succed = camera.SetGain(procedure.Gain); if (!succed) { SendTaskMessage($"相机增益设置失败!", MessageLevel.Error); } DateTime nowtime = DateTime.Now; LogHelper.WriteLogInfo("开始采集图像"); var image = camera.Grab(); if (image == null) { SendTaskMessage(Lang.图像采集失败, MessageLevel.Error); outputCollection = null; return false; } procedure.ToolBlock.Inputs["InputImage"].Value = image; LogHelper.WriteLogInfo($"采集图像完成;用时:{(DateTime.Now - nowtime).Milliseconds}ms"); // 2. 为ToolBlock传入其他输入终端 if (InputTerminal != null) { LogHelper.WriteLogInfo($"为ToolBlock传入输入终端"); foreach (var item in InputTerminal) { if (procedure.ToolBlock.Inputs.Contains(item.Key)) { LogHelper.WriteLogInfo($"传入[{item.Key}]={item.Value}"); procedure.ToolBlock.Inputs[item.Key].Value = item.Value; } else { LogHelper.WriteLogInfo($"创建并传入[{item.Key}]={item.Value}"); procedure.ToolBlock.Inputs.Add(new CogToolBlockTerminal(item.Key, item.Value)); } } } // 3. 运行视觉工具 LogHelper.WriteLogInfo("开始运行视觉工具"); procedure.ToolBlock.Run(); //运行ToolBlock if (procedure.ToolBlock.RunStatus.Result == CogToolResultConstants.Accept) { SendTaskMessage(Lang.视觉流程执行耗时.Replace("{0}", procedure.Name).Replace("{1}", $"{procedure.ToolBlock.RunStatus.ProcessingTime:F1}"), MessageLevel.Info); outputCollection = procedure.ToolBlock.Outputs; //获取输出终端集合 DatabaseHelper.AddCameraRecords(_productService.GetCurrentProduct().Name, procedure.Name, outputCollection); ICogRecord record = null; foreach (CogToolBlockTerminal item in outputCollection) { if (item.Value is ICogRecord) record = item.Value as ICogRecord; } _eventAggregator.GetEvent().Publish(new ShowRender() { CameraName = procedure.CameraName, Id = procedure.CameraId, Image = (ICogImage)procedure.ToolBlock.Inputs["InputImage"].Value, Graphic = outputCollection["Graphic"].Value as CogGraphicCollection, Record = record, Result = (bool)(outputCollection["Found"].Value), IsShow = true, IsSaveImage = procedure.IsSaveImage, SaveImageModel = procedure.SaveImageModel, SaveImagePathModel = procedure.SaveImagePathModel, SavePath = procedure.SavePath, IsCompress = procedure.IsCompress, }); return true; } else { SendTaskMessage(Lang.视觉流程执行出错耗时.Replace("{0}", procedure.Name).Replace("{1}", $"{procedure.ToolBlock.RunStatus.ProcessingTime:F1}"), MessageLevel.Error); SendTaskMessage(procedure.ToolBlock.RunStatus.Message, MessageLevel.Error); outputCollection = null; _eventAggregator.GetEvent().Publish(new ShowRender() { CameraName = procedure.CameraName, Id = procedure.CameraId, Image = (ICogImage)procedure.ToolBlock.Inputs["InputImage"].Value, Graphic = new CogGraphicCollection(), Result = false, IsShow = true, IsSaveImage = procedure.IsSaveImage, SaveImageModel = procedure.SaveImageModel, SaveImagePathModel = procedure.SaveImagePathModel, SavePath = procedure.SavePath }); return false; } } catch (Exception ex) { SendTaskMessage(ex.Message, MessageLevel.Error); LogHelper.WriteLogError("执行相机取图并执行视觉工具组时出错!", ex); outputCollection = null; return false; } } /// /// 获取需要输出项 /// /// /// /// /// 是否成功,错误返回内容,<项的名称,<是否是点位数据,值>> public (bool IsSucceed, string ErrMsg, Dictionary Output) GetVisionOutput(ProcedureModel procedure, CogToolBlockTerminalCollection outputCollection, double[] robotPos) { RobotBrand robotBrand = RobotBrand.Default; var robot = _configService.GetRobot(procedure.RobotId); if (robot != null) { robotBrand = robot.RobotBrand; } List SendResults = new List(); //<输出项的名称,<是否点位,每项输出集合值>> Dictionary ResultCollection = new Dictionary(); foreach (var output in procedure.ProcedureOutputs) //遍历配置的所有需要输出项 { //根据输出类型进行区分输出 if (output.ValueType == typeof(string)) { //需要点位转换时,进行点位提取 if (output.IsPointTran) { if (outputCollection[output.Name].Value == null || string.IsNullOrEmpty(outputCollection[output.Name].Value.ToString())) { //如果需要输出的项的值为空,即点位数据为空,则输出点位的个数为0 ResultCollection.Add(output.Name, (true, null)); continue; } string[] strpoints = outputCollection[output.Name].Value.ToString().Split(';'); //存储当前输出点位集合 List currentPointsForFeeder = new List(); //获取相机校准 var calib = _calibrationService.GetCalibration(procedure.CalibrationId); if (calib == null) { SendTaskMessage(Lang.没有相机校准信息, MessageLevel.Alarm); return (false, "NotCalibrations", null); } // 判断相机安装方式,如果是J4移动相机或者XYZ平台时,则需要判断robotPos不能为null if ((calib.CameraMount == CameraMount.MobileJ4 || calib.CameraMount == CameraMount.MobileDown_XYPlatform) && robotPos == null) { SendTaskMessage(Lang.机器人当前位置不能为空, MessageLevel.Alarm); return (false, "RobotPositionNull", null); } List SendDtat = new List(); List points = new List(); //遍历所有的输出点位 foreach (var pos in strpoints) { //先将pos按照逗号进行分隔,拿到数组,判断是否至少包含3个元素,并且前三个元素可以转换为double,确保是有效的点位数据 if (string.IsNullOrEmpty(pos)) { continue; } //先将pos按照逗号进行分隔,拿到数组 var posParts = pos.Split(','); if (posParts.Length < 3 || !double.TryParse(posParts[0], out double _pixel_x) || !double.TryParse(posParts[1], out double _pixel_y) || !double.TryParse(posParts[2], out double _pixel_u)) { SendTaskMessage(string.Format(Lang.点位数据格式错误, pos), MessageLevel.Alarm); return (false, "PointDataFormatError", null); } //转换点位-像素转换成机器人绝对坐标 var calibResult = _calibrationService.ConvertPixelToPosition((_pixel_x, _pixel_y, _pixel_u), robotPos, calib, robotBrand); if (!calibResult.IsSucceed) { return (false, "CalibrationFailed", null); } //截取posParts数组从索引3开始到结尾的所有元素,得到新新的数组extraInfoArray string[] extraInfoArray = posParts.Skip(3).ToArray(); //将rpos转换为字符串数组,保留3位小数 string[] strings = new string[] { $"{calibResult.X:F3}", $"{calibResult.Y:F3}", $"{calibResult.U:F3}" }; List rposString = new List(strings); if (extraInfoArray.Length > 0) { rposString.AddRange(extraInfoArray); } currentPointsForFeeder.Add(rposString.ToArray()); } ResultCollection[output.Name] = (true, currentPointsForFeeder); } //直接输出字符串 else { if (outputCollection[output.Name].Value == null || string.IsNullOrEmpty(outputCollection[output.Name].Value.ToString())) { ResultCollection.Add(output.Name, (false, null)); continue; } ResultCollection[output.Name] = (false, outputCollection[output.Name].Value.ToString()); } } else { if (outputCollection[output.Name].Value == null) { ResultCollection.Add(output.Name, (false, null)); } else { ResultCollection[output.Name] = (false, outputCollection[output.Name].Value.ToString()); } } } return (true, string.Empty, ResultCollection); } /// /// Feeder拍照前,执行Feeder /// /// Feeder /// 流程 /// 是否先振动 /// 是否先拍照 /// /// public async Task ExecuteFeederForPhotoBefore(IVoiceCoilMotorFeeder Feeder, ProcedureModel procedure, bool doVibrateFirst, bool doCaptureFirst, CancellationToken cancellationToken) { // 1. 设置Feeder光源亮度、打开光源 if (Feeder.FeederBrand == FeederBrand.AFAG) { await Feeder.SetLightValueAsync((ushort)procedure.LightValue); } else { //Feeder光源亮度设置 if (procedure.LightValue > 3) { var light = await Feeder.GetLightBrightnessAsync(); if (procedure.LightValue != light) { await Feeder.SetLightValueAsync((ushort)procedure.LightValue); } //获取光源的超时时间 int lightTimeout = await Feeder.GetLightTimeoutAsync(); if (lightTimeout < 10000) { await Feeder.SetLightTimeOutAsync(10000); } //打开光源 await Feeder.OpenLightAsync(); } } if (doCaptureFirst)//如果不振动,等待光源稳定时间 { if (procedure.WaitPhoto > 0) await Task.Delay(procedure.WaitPhoto); return; } //先振后拍时 if (procedure.VibrationModel == VibrationModel.VibrationPhoto || doVibrateFirst) { if (procedure.FeederWorks != null && procedure.FeederWorks.FeederWorkList != null) { bool flog = false; //如果上次的Blob面积小于设定的最小值,则触发供料 if (procedure.LastBlobArea <= procedure.MinArea) { flog = true; SendTaskMessage(Lang.执行料仓供料, MessageLevel.Info); await ExecuteFeederStockWorks(Feeder, procedure.FeederStockWorks, cancellationToken); if (procedure.WaitFeederStop > 0) await Task.Delay(procedure.WaitFeederStop); SendTaskMessage(Lang.料仓供料结束, MessageLevel.Info); } if (!flog) { //执行配置的Feeder振动任务 await ExecuteFeederWorks(Feeder, procedure.FeederWorks, cancellationToken, false); if (procedure.WaitFeederStop > 0) await Task.Delay(procedure.WaitFeederStop); } } } else { if (procedure.LightValue > 3) { if (procedure.WaitPhoto > 0) await Task.Delay(procedure.WaitPhoto); } //如果上次的Blob面积小于设定的最小值,则触发供料 if (procedure.LastBlobArea <= procedure.MinArea) { SendTaskMessage(Lang.执行料仓供料, MessageLevel.Info); await ExecuteFeederStockWorks(Feeder, procedure.FeederStockWorks, cancellationToken); if (procedure.WaitFeederStop > 0) await Task.Delay(procedure.WaitFeederStop); SendTaskMessage(Lang.料仓供料结束, MessageLevel.Info); } } } /// /// Feeder拍照后,拍照失败时,执行Feeder /// /// /// /// public async Task ExecuteFeederForPhotoLater(IVoiceCoilMotorFeeder Feeder, ProcedureModel procedure, CancellationToken cancellationToken) { //根据斑点面积决定是否料仓供料 if (procedure.LastBlobArea <= procedure.MinArea) { SendTaskMessage(Lang.执行料仓供料, MessageLevel.Info); await ExecuteFeederStockWorks(Feeder, procedure.FeederStockWorks, cancellationToken); if (cancellationToken != null && cancellationToken.IsCancellationRequested) return; if (procedure.WaitFeederStop > 0) await Task.Delay(procedure.WaitFeederStop, cancellationToken); SendTaskMessage(Lang.料仓供料结束, MessageLevel.Info); } else { if (procedure.FeederWorks != null && procedure.FeederWorks.FeederWorkList != null) { SendTaskMessage(Lang.执行Feeder振动, MessageLevel.Info); //执行配置的Feeder振动任务 await ExecuteFeederWorks(Feeder, procedure.FeederWorks, cancellationToken); if (cancellationToken != null && cancellationToken.IsCancellationRequested) return; if (procedure.WaitFeederStop > 0) await Task.Delay(procedure.WaitFeederStop, cancellationToken); SendTaskMessage(Lang.Feeder振动结束, MessageLevel.Info); } } } /// /// 执行Feeder料仓供料及振动集合 /// /// /// /// public async Task ExecuteFeederStockWorks(IVoiceCoilMotorFeeder feeder, FeederStockWorks works, CancellationToken cancellationToken, bool isUpdateParame = true) { //同时执行料仓供料和Feeder振动任务 var stockTask = ExecuteFeederStockWorksOnly(feeder, works.FeederStockWorkList.ToArray(), cancellationToken); var vibrationTask = ExecuteFeederWorkOnly(feeder, works.FeederWorkList.ToArray(), cancellationToken); await Task.WhenAll(stockTask, vibrationTask); } /// /// 执行料仓振动任务 /// /// /// /// /// public async Task ExecuteFeederStockWorksOnly(IVoiceCoilMotorFeeder feeder, FeederStockWork[] works, CancellationToken cancellationToken) { //执行配置的料仓振动任务 if (feeder.FeederBrand == FeederBrand.AFAG) { foreach (var stockwork in works) { if (stockwork.RegisterIndex == 0) { if (stockwork.Duration > 0) await Task.Delay(stockwork.Duration, cancellationToken); } else if (stockwork.RegisterIndex == 1) { //if (BgModbusTcpCommunicate != null) //{ // BgModbusTcpCommunicate.Slave.DataStore.HoldingRegisters[stockwork.Address] = 1; // await Task.Delay(stockwork.Duration); // BgModbusTcpCommunicate.Slave.DataStore.HoldingRegisters[stockwork.Address] = 0; //} } if (cancellationToken != null && cancellationToken.IsCancellationRequested) { return; } } } else { foreach (var stockwork in works) { if (stockwork.Function == VibrationFunction.Delay) { if (stockwork.Duration > 0) await Task.Delay(stockwork.Duration, cancellationToken); } else { await feeder.OutputAsync(((int)stockwork.Function) + 1, stockwork.Duration); if (stockwork.Duration > 0) await Task.Delay(stockwork.Duration, cancellationToken); } if (cancellationToken != null && cancellationToken.IsCancellationRequested) { return; } } } } /// /// 执行Feeder振动任务 /// /// /// /// /// /// public async Task ExecuteFeederWorkOnly(IVoiceCoilMotorFeeder feeder, FeederWork[] works, CancellationToken cancellationToken, bool isUpdateParame = true) { if (works == null) { return; } if (feeder.FeederBrand == FeederBrand.AFAG) { //执行配置的Feeder振动任务 foreach (var feederwork in works) { if (feederwork.ConfigIndex < 0) { continue; } if (feederwork.ConfigIndex == 0) { if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken); } else { ((AfagFeeder)feeder).LoadConfiguration(feederwork.ConfigIndex); ((AfagFeeder)feeder).SetIntensity(feederwork.Intensity); ((AfagFeeder)feeder).SetDirection(feederwork.Direction); if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken); if (cancellationToken != null && cancellationToken.IsCancellationRequested) { return; } ((AfagFeeder)feeder).SetIntensity(0); } if (cancellationToken != null && cancellationToken.IsCancellationRequested) { return; } } } else { //执行配置的Feeder振动任务 foreach (var feederwork in works) { if (feederwork.Function == VibrationFunction.Delay) { if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken); } else { if (feederwork.SingleAction != null && isUpdateParame) { await feeder.SetShakeParametersAsync((int)feederwork.Function, feederwork.SingleAction); } await feeder.StartAction((int)feederwork.Function, feederwork.Duration); if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken); } if (cancellationToken != null && cancellationToken.IsCancellationRequested) { return; } } } } /// /// 执行Feeder振动集合 /// /// /// /// /// /// public async Task ExecuteFeederWorks(IVoiceCoilMotorFeeder feeder, FeederWorks works, CancellationToken cancellationToken, bool isUpdateParame = true) { //执行配置的Feeder振动任务 if (feeder.FeederBrand == FeederBrand.AFAG) { foreach (var feederwork in works.FeederWorkList) { if (feederwork.ConfigIndex < 0) { continue; } if (feederwork.ConfigIndex == 0) { await Task.Delay(feederwork.Duration, cancellationToken); } else { ((AfagFeeder)feeder).LoadConfiguration(feederwork.ConfigIndex); ((AfagFeeder)feeder).SetIntensity(feederwork.Intensity); ((AfagFeeder)feeder).SetDirection(feederwork.Direction); await Task.Delay(feederwork.Duration, cancellationToken); if (cancellationToken != null && cancellationToken.IsCancellationRequested) { return; } ((AfagFeeder)feeder).SetIntensity(0); } if (cancellationToken != null && cancellationToken.IsCancellationRequested) { return; } } } else { foreach (var feederwork in works.FeederWorkList) { if (feederwork.Function == VibrationFunction.Delay) { if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken); } else { if (feederwork.SingleAction != null && isUpdateParame) { await feeder.SetShakeParametersAsync((int)feederwork.Function, feederwork.SingleAction); } await feeder.StartAction((int)feederwork.Function, feederwork.Duration); if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken); } if (cancellationToken != null && cancellationToken.IsCancellationRequested) { return; } } } } #endregion } }