RemoteCommandService.cs 114 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473
  1. using Cognex.VisionPro;
  2. using Cognex.VisionPro.ToolBlock;
  3. using MathNet.Numerics.LinearAlgebra;
  4. using Microsoft.CodeAnalysis.Scripting;
  5. using NPOI.SS.Formula.Functions;
  6. using Org.BouncyCastle.Tls;
  7. using Prism.Events;
  8. using Prism.Ioc;
  9. using Prism.Regions;
  10. using System;
  11. using System.Collections.Concurrent;
  12. using System.Collections.Generic;
  13. using System.ComponentModel;
  14. using System.IO;
  15. using System.Linq;
  16. using System.Reflection;
  17. using System.Text;
  18. using System.Threading;
  19. using System.Threading.Tasks;
  20. using System.Windows.Shapes;
  21. using Team.FFFeederService;
  22. using Team.FFFeederService.Interfaces;
  23. using TeamAAS_VP.Core;
  24. using TeamAAS_VP.Data;
  25. using TeamAAS_VP.Enums;
  26. using TeamAAS_VP.Events;
  27. using TeamAAS_VP.Interfaces;
  28. using TeamAAS_VP.Models;
  29. using TeamAAS_VP.Models.Calibration;
  30. using TeamAAS_VP.Models.Feeder;
  31. using TeamAAS_VP.Models.Product;
  32. using TeamAAS_VP.Resources.Languages;
  33. namespace TeamAAS_VP.Services
  34. {
  35. /// <summary>
  36. /// 远程命令服务:
  37. /// 负责解析并执行外部传入的命令字符串(例如 LoadProduct、视觉流程触发、清料任务等)。
  38. /// 该类封装了原 Management.ExecuteRemoteCommand 的精简迁移实现,依赖于领域服务(产品、配置、校准、Feeder、相机、机器人、系统数据库等)。
  39. /// 线程安全:通过内部计数器和 ConcurrentDictionary 跟踪正在运行的任务。
  40. /// </summary>
  41. public class RemoteCommandService : IRemoteCommandService, INotifyPropertyChanged
  42. {
  43. // 依赖服务,由构造函数注入
  44. private readonly IEventAggregator _eventAggregator;
  45. private readonly IProductService _productService;
  46. private readonly IConfigService _configService;
  47. private readonly ICalibrationService _calibrationService;
  48. private readonly IFeederService _feederService;
  49. private readonly ICameraService _cameraService;
  50. private readonly IRobotService _robotService;
  51. private readonly IContainerProvider _container;
  52. private readonly IRegionManager _regionManager;
  53. private readonly ISystemDatabaseService _systemDatabaseService;
  54. private readonly ILightManagerService _lightManagerService;
  55. /// <summary>
  56. /// 节拍计时任务的取消令牌,用于 StartCycleTiming/StopCycleTiming。
  57. /// </summary>
  58. private CancellationTokenSource _cycleTimingCts;
  59. /// <summary>
  60. /// 清料任务的取消令牌字典,Key 为任务编号(TaskCode)。
  61. /// 当需要取消特定清料任务时,通过该字典查找并调用 Cancel。
  62. /// </summary>
  63. private readonly ConcurrentDictionary<int, CancellationTokenSource> _clearMaterialCtsDict = new ConcurrentDictionary<int, CancellationTokenSource>();
  64. // 内部执行状态计数器和任务跟踪集合
  65. private int _activeCount;
  66. private int _visionActiveCount;
  67. private readonly ConcurrentDictionary<Guid, Task> _runningTasks = new ConcurrentDictionary<Guid, Task>();
  68. // INotifyPropertyChanged 实现
  69. public event PropertyChangedEventHandler PropertyChanged;
  70. private void OnPropertyChanged(string name) => PropertyChanged?.Invoke(this, new PropertyChangedEventArgs(name));
  71. /// <summary>
  72. /// 标识是否存在任意正在执行的命令(非视觉与视觉命令)。
  73. /// 由 TrackExecutionAsync 自动维护。
  74. /// </summary>
  75. public bool IsExecuting => Volatile.Read(ref _activeCount) > 0;
  76. /// <summary>
  77. /// 标识是否存在正在执行的视觉指令。
  78. /// 由 TrackExecutionAsync 在 isVision 参数为 true 时自动维护。
  79. /// </summary>
  80. public bool IsExecutingVisionCommand => Volatile.Read(ref _visionActiveCount) > 0;
  81. /// <summary>
  82. /// 当执行状态发生变化(开始/结束)时触发(便于传统事件订阅)。
  83. /// </summary>
  84. public event EventHandler ExecutionStateChanged;
  85. /// <summary>
  86. /// 节拍计时的定时回调事件,通知订阅者当前已用时。
  87. /// </summary>
  88. public event EventHandler<TimeSpan> CycleTimingTicked;
  89. /// <summary>
  90. /// 构造函数,注入必要的系统服务。
  91. /// </summary>
  92. /// <param name="eventAggregator">事件聚合器,用于发布 UI 渲染/消息等事件。</param>
  93. /// <param name="regionManager">区域管理器,用于 UI 区域导航(在脚本中可能使用)。</param>
  94. /// <param name="productService">产品服务,用于加载/查询产品信息。</param>
  95. /// <param name="configService">配置服务,用于读取机器人/任务/Feeder 等配置。</param>
  96. /// <param name="calibrationService">校准服务,用于像素到机器人坐标的转换。</param>
  97. /// <param name="feederService">Feeder 服务,控制料仓/振动等。</param>
  98. /// <param name="cameraService">相机服务,用于图像采集。</param>
  99. /// <param name="robotService">机器人服务,提供机器人状态码/调试模式等信息。</param>
  100. /// <param name="container">IOC 容器提供者,用于脚本执行时解析依赖。</param>
  101. /// <param name="systemDatabaseService">系统数据库服务,用于记录产量/报警等。</param>
  102. public RemoteCommandService(IEventAggregator eventAggregator, IRegionManager regionManager, IProductService productService, IConfigService configService, ICalibrationService calibrationService,
  103. IFeederService feederService, ICameraService cameraService, IRobotService robotService, IContainerProvider container, ISystemDatabaseService systemDatabaseService, ILightManagerService lightManagerService)
  104. {
  105. _eventAggregator = eventAggregator;
  106. _regionManager = regionManager;
  107. _productService = productService;
  108. _configService = configService;
  109. _calibrationService = calibrationService;
  110. _feederService = feederService;
  111. _cameraService = cameraService;
  112. _robotService = robotService;
  113. _container = container;
  114. _systemDatabaseService = systemDatabaseService;
  115. _lightManagerService = lightManagerService;
  116. }
  117. /// <summary>
  118. /// 占位 Dispose 方法(当前无资源释放逻辑)。
  119. /// </summary>
  120. public void Dispose() { }
  121. /// <summary>
  122. /// 通用的异步执行包装器。该方法:
  123. /// - 为每次执行生成唯一 id 并加入运行任务集合以便跟踪
  124. /// - 维护 _activeCount 和 _visionActiveCount
  125. /// - 在任务开始/结束时触发属性变化和 ExecutionStateChanged 事件
  126. /// - 返回工作 delegate 的结果
  127. /// </summary>
  128. /// <typeparam name="T">工作返回类型</typeparam>
  129. /// <param name="work">以 CancellationToken 为参数的异步工作委托</param>
  130. /// <param name="isVision">指示该工作是否为视觉命令(影响视觉计数器)</param>
  131. /// <param name="ct">外部取消令牌,传递给工作委托</param>
  132. /// <returns>工作委托的返回值</returns>
  133. private async Task<T> TrackExecutionAsync<T>(Func<CancellationToken, Task<T>> work, bool isVision, CancellationToken ct)
  134. {
  135. var id = Guid.NewGuid();
  136. Interlocked.Increment(ref _activeCount);
  137. if (isVision) Interlocked.Increment(ref _visionActiveCount);
  138. OnPropertyChanged(nameof(IsExecuting));
  139. OnPropertyChanged(nameof(IsExecutingVisionCommand));
  140. ExecutionStateChanged?.Invoke(this, EventArgs.Empty);
  141. try
  142. {
  143. var task = work(ct);
  144. _runningTasks.TryAdd(id, task);
  145. var result = await task.ConfigureAwait(false);
  146. return result;
  147. }
  148. finally
  149. {
  150. Interlocked.Decrement(ref _activeCount);
  151. if (isVision) Interlocked.Decrement(ref _visionActiveCount);
  152. _runningTasks.TryRemove(id, out _);
  153. OnPropertyChanged(nameof(IsExecuting));
  154. OnPropertyChanged(nameof(IsExecutingVisionCommand));
  155. ExecutionStateChanged?.Invoke(this, EventArgs.Empty);
  156. }
  157. }
  158. /// <summary>
  159. /// 解析并执行传入的命令字符串。命令以逗号分隔,第一个字段为命令名称,后续为参数。
  160. /// 支持多种内建命令(示例:LoadProduct、GetProductName、CycleTime、Record、StartClearMaterial 等),以及映射到产品 CameraProcedures 的自定义视觉触发命令。
  161. /// </summary>
  162. /// <param name="command">原始命令字符串</param>
  163. /// <param name="cancellationToken">外部取消令牌</param>
  164. /// <param name="callback">用于将执行结果回传(比如发送到调用方)的回调,参数为单行响应字符串</param>
  165. /// <returns>完成任务</returns>
  166. public async Task ExecuteAsync(string command, CancellationToken cancellationToken, Action<string> callback)
  167. {
  168. var items = (command ?? string.Empty).Split(new[] { ',' }, StringSplitOptions.None).Select(s => s.Trim()).ToArray();
  169. if (items.Length == 0) return;
  170. string triggerCommand = items[0];
  171. string[] commandParams = items.Skip(1).ToArray();
  172. string response = string.Empty;
  173. switch (triggerCommand)
  174. {
  175. case "LoadProduct":
  176. if (commandParams.Length < 1)
  177. {
  178. callback?.Invoke("InvalidParameters");
  179. return;
  180. }
  181. response = await TrackExecutionAsync(async ct =>
  182. {
  183. var ok = await LoadProductAsync(commandParams[0], ct);
  184. return ok ? "OK" : "NG";
  185. }, isVision: false, cancellationToken);
  186. callback?.Invoke($"LoadProduct,{response}");
  187. break;
  188. case "GetProductName":
  189. if (commandParams.Length < 1)
  190. {
  191. response = await TrackExecutionAsync(async ct =>
  192. {
  193. return await GetCurrentProductNameAsync(ct);
  194. }, isVision: false, cancellationToken);
  195. if (string.IsNullOrEmpty(response))
  196. {
  197. callback?.Invoke("GetProductName,NG");
  198. }
  199. else
  200. {
  201. callback?.Invoke($"GetProductName,{response}");
  202. }
  203. break;
  204. }
  205. else if (commandParams.Length == 1)
  206. {
  207. if (!int.TryParse(commandParams[0], out int productNumber))
  208. {
  209. callback?.Invoke("InvalidParameters");
  210. return;
  211. }
  212. response = await TrackExecutionAsync(async ct =>
  213. {
  214. return await GetProductNameByNumberAsync(productNumber, ct);
  215. }, isVision: false, cancellationToken);
  216. if (string.IsNullOrEmpty(response))
  217. {
  218. callback?.Invoke($"GetProductName,NG");
  219. }
  220. else
  221. {
  222. callback?.Invoke($"GetProductName,{response}");
  223. }
  224. break;
  225. }
  226. else
  227. {
  228. callback?.Invoke("InvalidParameters");
  229. return;
  230. }
  231. case "GetProductID":
  232. if (commandParams.Length < 1)
  233. {
  234. response = await TrackExecutionAsync(async ct =>
  235. {
  236. int productNum = await GetCurrentProductNumberAsync(ct);
  237. return productNum.ToString();
  238. }, isVision: false, cancellationToken);
  239. if (response == "-1")
  240. {
  241. callback?.Invoke("GetProductID,NG");
  242. }
  243. else
  244. {
  245. callback?.Invoke($"GetProductID,{response}");
  246. }
  247. break;
  248. }
  249. else if (commandParams.Length == 1)
  250. {
  251. response = await TrackExecutionAsync(async ct =>
  252. {
  253. int productNum = await GetProductNumberByNameAsync(commandParams[0], ct);
  254. return productNum.ToString();
  255. }, isVision: false, cancellationToken);
  256. if (response == "-1")
  257. {
  258. callback?.Invoke($"GetProductID,NG");
  259. }
  260. else
  261. {
  262. callback?.Invoke($"GetProductID,{response}");
  263. }
  264. break;
  265. }
  266. else
  267. {
  268. callback?.Invoke("InvalidParameters");
  269. return;
  270. }
  271. case "GetRobotPointsCountById":
  272. if (commandParams.Length < 2 || !int.TryParse(commandParams[0], out int robotNumber) || !int.TryParse(commandParams[1], out int pointNumber))
  273. {
  274. callback?.Invoke("InvalidParameters");
  275. return;
  276. }
  277. response = await TrackExecutionAsync(async ct =>
  278. {
  279. return await GetRobotPointInfoAsync(robotNumber, pointNumber, ct);
  280. }, isVision: false, cancellationToken);
  281. if (string.IsNullOrEmpty(response))
  282. {
  283. callback?.Invoke($"GetRobotPointsCountById,NG");
  284. }
  285. else
  286. {
  287. callback?.Invoke($"GetRobotPointsCountById,{response}");
  288. }
  289. break;
  290. case "GetPalletPoint":
  291. 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))
  292. {
  293. callback?.Invoke("InvalidParameters");
  294. return;
  295. }
  296. response = await TrackExecutionAsync(async ct =>
  297. {
  298. return await GetRobotPalletPointInfoAsync(robotNumber1, palletNumber1, pointNumber1, ct);
  299. }, isVision: false, cancellationToken);
  300. if (string.IsNullOrEmpty(response))
  301. {
  302. callback?.Invoke($"GetPalletPoint,NG");
  303. }
  304. else
  305. callback?.Invoke($"GetPalletPoint,{response}");
  306. break;
  307. case "CycleTime":
  308. if (commandParams.Length < 1)
  309. {
  310. callback?.Invoke("InvalidParameters");
  311. return;
  312. }
  313. if (int.Parse(commandParams[0]) == 1)
  314. {
  315. response = await TrackExecutionAsync(async ct =>
  316. {
  317. bool cycleResult = await StartCycleTimingAsync(ct);
  318. return cycleResult ? "OK" : "NG";
  319. }, isVision: false, cancellationToken);
  320. callback?.Invoke($"CycleTime,{response}");
  321. break;
  322. }
  323. else
  324. {
  325. response = await TrackExecutionAsync(async ct =>
  326. {
  327. bool cycleResult = await StopCycleTimingAsync(ct);
  328. return cycleResult ? "OK" : "NG";
  329. }, isVision: false, cancellationToken);
  330. callback?.Invoke($"CycleTime,{response}");
  331. break;
  332. }
  333. case "Record":
  334. if (commandParams.Length < 1)
  335. {
  336. callback?.Invoke("InvalidParameters");
  337. return;
  338. }
  339. response = await TrackExecutionAsync(async ct =>
  340. {
  341. bool recordResult = await CreateProductionCountAsync(commandParams[0].Trim(), ct);
  342. return recordResult ? "OK" : "NG";
  343. }, isVision: false, cancellationToken);
  344. callback?.Invoke($"Record,{response}");
  345. break;
  346. case "RecordQuery":
  347. if (commandParams.Length < 1)
  348. {
  349. callback?.Invoke("InvalidParameters");
  350. return;
  351. }
  352. response = await TrackExecutionAsync(async ct =>
  353. {
  354. int recordCount = await GetCurrentProductionCountAsync(commandParams[0].Trim(), ct);
  355. return recordCount.ToString();
  356. }, isVision: false, cancellationToken);
  357. callback?.Invoke($"RecordQuery,{response}");
  358. break;
  359. case "RecordReset":
  360. if (commandParams.Length < 1)
  361. {
  362. callback?.Invoke("InvalidParameters");
  363. return;
  364. }
  365. response = await TrackExecutionAsync(async ct =>
  366. {
  367. bool recordResetResult = await ResetProductionCountAsync(commandParams[0].Trim(), ct);
  368. return recordResetResult ? "OK" : "NG";
  369. }, isVision: false, cancellationToken);
  370. callback?.Invoke($"RecordReset,{response}");
  371. break;
  372. case "Err":
  373. if (commandParams.Length < 2)
  374. {
  375. callback?.Invoke("InvalidParameters");
  376. return;
  377. }
  378. response = await TrackExecutionAsync(async ct =>
  379. {
  380. bool errResult = await CreateAlarmRecordAsync(commandParams[0].Trim(), commandParams[1].Trim(), ct);
  381. return errResult ? "OK" : "NG";
  382. }, isVision: false, cancellationToken);
  383. callback?.Invoke($"Err,{response}");
  384. break;
  385. case "Info":
  386. if (commandParams.Length < 1)
  387. {
  388. callback?.Invoke("InvalidParameters");
  389. return;
  390. }
  391. response = await TrackExecutionAsync(async ct =>
  392. {
  393. bool infoResult = await CreateOperationLogAsync(commandParams[0].Trim(), ct);
  394. return infoResult ? "OK" : "NG";
  395. }, isVision: false, cancellationToken);
  396. callback?.Invoke($"Info,{response}");
  397. break;
  398. case "GetGlobalParam":
  399. if (commandParams.Length == 1)
  400. {
  401. response = await TrackExecutionAsync(async ct =>
  402. {
  403. return await GetGlobalParameterAsync(int.Parse(commandParams[0]), -1, ct);
  404. }, isVision: false, cancellationToken);
  405. if (string.IsNullOrEmpty(response))
  406. {
  407. callback?.Invoke("GetGlobalParam,NG");
  408. }
  409. else
  410. {
  411. callback?.Invoke($"GetGlobalParam,{response}");
  412. }
  413. break;
  414. }
  415. else if (commandParams.Length == 2)
  416. {
  417. response = await TrackExecutionAsync(async ct =>
  418. {
  419. return await GetGlobalParameterAsync(int.Parse(commandParams[0]), int.Parse(commandParams[1]), ct);
  420. }, isVision: false, cancellationToken);
  421. if (string.IsNullOrEmpty(response))
  422. {
  423. callback?.Invoke("GetGlobalParam,NG");
  424. }
  425. else
  426. {
  427. callback?.Invoke($"GetGlobalParam,{response}");
  428. }
  429. break;
  430. }
  431. else
  432. {
  433. callback?.Invoke("InvalidParameters");
  434. return;
  435. }
  436. case "GetSpeed":
  437. response = await TrackExecutionAsync(async ct =>
  438. {
  439. return await GetOperationSpeedAsync(ct);
  440. }, isVision: false, cancellationToken);
  441. if (string.IsNullOrEmpty(response))
  442. {
  443. callback?.Invoke("GetSpeed,NG");
  444. return;
  445. }
  446. else
  447. callback?.Invoke($"GetSpeed,{response}");
  448. break;
  449. case "GetToolParam":
  450. if (commandParams.Length < 2)
  451. {
  452. callback?.Invoke("InvalidParameters");
  453. return;
  454. }
  455. response = await TrackExecutionAsync(async ct =>
  456. {
  457. return await GetToolParamAsync(commandParams[0], int.Parse(commandParams[1]), ct);
  458. }, isVision: false, cancellationToken);
  459. if (string.IsNullOrEmpty(response))
  460. {
  461. callback?.Invoke("GetToolParam,NG");
  462. return;
  463. }
  464. else
  465. callback?.Invoke($"GetToolParam,{response}");
  466. break;
  467. case "GetProcedureParam":
  468. if (commandParams.Length < 1)
  469. {
  470. callback?.Invoke("InvalidParameters");
  471. return;
  472. }
  473. response = await TrackExecutionAsync(async ct =>
  474. {
  475. return await GetProcessParamAsync(commandParams[0], ct);
  476. }, isVision: false, cancellationToken);
  477. if (string.IsNullOrEmpty(response))
  478. {
  479. callback?.Invoke("GetProcedureParam,NG");
  480. return;
  481. }
  482. else
  483. callback?.Invoke($"GetProcedureParam,{response}");
  484. break;
  485. case "StartClearMaterial":
  486. if (commandParams.Length < 1)
  487. {
  488. callback?.Invoke("InvalidParameters");
  489. return;
  490. }
  491. response = await TrackExecutionAsync(async ct =>
  492. {
  493. bool startClearResult = await ExecuteClearMaterialTaskAsync(int.Parse(commandParams[0]), ct);
  494. return startClearResult ? "OK" : "NG";
  495. }, isVision: false, cancellationToken);
  496. callback?.Invoke($"StartClearMaterial,{response}");
  497. break;
  498. case "StopClearMaterial":
  499. if (commandParams.Length < 1)
  500. {
  501. callback?.Invoke("InvalidParameters");
  502. return;
  503. }
  504. response = await TrackExecutionAsync(async ct =>
  505. {
  506. bool stopClearResult = await StopClearMaterialTaskAsync(int.Parse(commandParams[0]), ct);
  507. return stopClearResult ? "OK" : "NG";
  508. }, isVision: false, cancellationToken);
  509. callback?.Invoke($"StopClearMaterial,{response}");
  510. break;
  511. case "RobotIsDebugMode":
  512. if (commandParams.Length < 1)
  513. {
  514. callback?.Invoke("InvalidParameters");
  515. return;
  516. }
  517. response = await TrackExecutionAsync(async ct =>
  518. {
  519. bool isDebugMode = await IsRobotInDebugModeAsync(int.Parse(commandParams[0]), ct);
  520. return isDebugMode ? "1" : "0";
  521. }, isVision: false, cancellationToken);
  522. callback?.Invoke($"RobotIsDebugMode,{response}");
  523. break;
  524. default:
  525. var currentProduct = _productService.GetCurrentProduct();
  526. if (currentProduct == null) return;
  527. var procedure = currentProduct.CameraProcedures
  528. .SelectMany(cp => cp.ProcedureModels)
  529. .FirstOrDefault(p => p.TriggerCommand == triggerCommand);
  530. if (procedure == null) return;
  531. var visionResult = await TrackExecutionAsync(async ct =>
  532. {
  533. ImageParameters imgPara = new ImageParameters();
  534. imgPara.SNCode = "SN";
  535. var r = await ExecuteVisionTaskAsync(procedure, commandParams, ct, imgPara);
  536. return Tuple.Create(r.IsSucceed, r.Response);
  537. }, isVision: true, cancellationToken);
  538. if (visionResult.Item1)
  539. {
  540. foreach (var item in visionResult.Item2)
  541. {
  542. callback?.Invoke($"{triggerCommand},OK,{item}");
  543. }
  544. }
  545. else
  546. {
  547. string msg = string.Empty;
  548. if (visionResult.Item2 != null && visionResult.Item2.Length > 0)
  549. {
  550. msg = visionResult.Item2[0];
  551. }
  552. callback?.Invoke($"{triggerCommand},NG,{msg}");
  553. }
  554. break;
  555. }
  556. }
  557. /// <summary>
  558. /// 根据产品名称或编号加载并设置当前产品。
  559. /// 若传入字符串可解析为 int,则先按编号查找产品,否则按名称查找。
  560. /// </summary>
  561. /// <param name="productName">产品名称或编号字符串</param>
  562. /// <param name="cancellationToken">取消令牌</param>
  563. /// <returns>加载成功返回 true,否则 false</returns>
  564. public async Task<bool> LoadProductAsync(string productName, CancellationToken cancellationToken)
  565. {
  566. bool exists = _productService.ContainsProductByName(productName);
  567. if (exists)
  568. {
  569. var product = _productService.GetAllProducts().FirstOrDefault(p => p.Name == productName);
  570. await _productService.LoadProductAsync(product.ID);
  571. _productService.SetCurrentProduct(product.ID);
  572. return true;
  573. }
  574. if (int.TryParse(productName, out int productNumber))
  575. {
  576. var product = _productService.GetAllProducts().FirstOrDefault(p => p.NumberCode == productNumber);
  577. if (product != null)
  578. {
  579. await _productService.LoadProductAsync(product.ID);
  580. _productService.SetCurrentProduct(product.ID);
  581. return true;
  582. }
  583. }
  584. return false;
  585. }
  586. /// <summary>
  587. /// 通过产品编号获取产品名称。
  588. /// </summary>
  589. public Task<string> GetProductNameByNumberAsync(int productNumber, CancellationToken cancellationToken)
  590. {
  591. var product = _productService.GetAllProducts().FirstOrDefault(p => p.NumberCode == productNumber);
  592. if (product != null)
  593. {
  594. return Task.FromResult(product.Name);
  595. }
  596. return Task.FromResult(string.Empty);
  597. }
  598. /// <summary>
  599. /// 获取当前被设置为活动的产品名称。如果没有则返回空字符串。
  600. /// </summary>
  601. public Task<string> GetCurrentProductNameAsync(CancellationToken cancellationToken)
  602. {
  603. var currentProduct = _productService.GetCurrentProduct();
  604. if (currentProduct != null)
  605. {
  606. return Task.FromResult(currentProduct.Name);
  607. }
  608. return Task.FromResult(string.Empty);
  609. }
  610. /// <summary>
  611. /// 通过产品名称获取其编号(NumberCode)。找不到则返回 -1。
  612. /// </summary>
  613. public Task<int> GetProductNumberByNameAsync(string productName, CancellationToken cancellationToken)
  614. {
  615. bool exists = _productService.ContainsProductByName(productName);
  616. if (exists)
  617. {
  618. var product = _productService.GetAllProducts().FirstOrDefault(p => p.Name == productName);
  619. return Task.FromResult(product.NumberCode);
  620. }
  621. return Task.FromResult(-1);
  622. }
  623. /// <summary>
  624. /// 获取当前产品编号(NumberCode)。找不到则返回 -1。
  625. /// </summary>
  626. public Task<int> GetCurrentProductNumberAsync(CancellationToken cancellationToken)
  627. {
  628. var currentProduct = _productService.GetCurrentProduct();
  629. if (currentProduct != null)
  630. {
  631. return Task.FromResult(currentProduct.NumberCode);
  632. }
  633. return Task.FromResult(-1);
  634. }
  635. /// <summary>
  636. /// 根据机器人编号和点位编号获取点位信息(字符串表示),查找逻辑基于当前产品的 RobotPoint 配置。
  637. /// </summary>
  638. public Task<string> GetRobotPointInfoAsync(int robotNumber, int pointNumber, CancellationToken cancellationToken)
  639. {
  640. var currentProduct = _productService.GetCurrentProduct();
  641. if (currentProduct == null) return Task.FromResult(string.Empty);
  642. var robot = _configService.GetAllRobots().FirstOrDefault(r => r.RobotNo == robotNumber);
  643. if (robot == null) return Task.FromResult(string.Empty);
  644. var robotPoint = currentProduct.RobotPoint.Robots.FirstOrDefault(rp => rp.Id == robot.Id);
  645. if (robotPoint == null) return Task.FromResult(string.Empty);
  646. var point = robotPoint.Points.FirstOrDefault(p => p.Number == pointNumber);
  647. if (point == null) return Task.FromResult(string.Empty);
  648. return Task.FromResult(point.ToString());
  649. }
  650. /// <summary>
  651. /// 通过机器人编号、托盘编号和点编号获取托盘点位信息,返回格式化字符串。
  652. /// </summary>
  653. public Task<string> GetRobotPalletPointInfoAsync(int robotNumber, int palletNumber, int pointNumber, CancellationToken cancellationToken)
  654. {
  655. var currentProduct = _productService.GetCurrentProduct();
  656. if (currentProduct == null) return Task.FromResult(string.Empty);
  657. var robot = _configService.GetAllRobots().FirstOrDefault(r => r.RobotNo == robotNumber);
  658. if (robot == null) return Task.FromResult(string.Empty);
  659. var robotPoint = currentProduct.RobotPoint.Robots.FirstOrDefault(rp => rp.Id == robot.Id);
  660. if (robotPoint == null) return Task.FromResult(string.Empty);
  661. var pallet = robotPoint.Pallets.FirstOrDefault(p => p.PalletNo == palletNumber);
  662. if (pallet == null) return Task.FromResult(string.Empty);
  663. PalletTool palletTool = new PalletTool(pallet);
  664. if (pointNumber > palletTool.Points.Length || pointNumber < 1) return Task.FromResult(string.Empty);
  665. var pos = palletTool.Points[pointNumber - 1];
  666. 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}";
  667. return Task.FromResult(response);
  668. }
  669. /// <summary>
  670. /// 开始节拍计时。返回是否成功(始终 true)。
  671. /// 会启动后台定时任务并周期性触发 CycleTimingTicked 事件。
  672. /// </summary>
  673. public Task<bool> StartCycleTimingAsync(CancellationToken cancellationToken)
  674. {
  675. if (_cycleTimingCts != null)
  676. {
  677. _cycleTimingCts.Cancel();
  678. _cycleTimingCts.Dispose();
  679. }
  680. _cycleTimingCts = new CancellationTokenSource();
  681. var token = _cycleTimingCts.Token;
  682. Task.Run(async () =>
  683. {
  684. var startTime = DateTime.UtcNow;
  685. while (!token.IsCancellationRequested)
  686. {
  687. var elapsed = DateTime.UtcNow - startTime;
  688. OnCycleTimingTicked(elapsed);
  689. await Task.Delay(100, token);
  690. }
  691. }, token);
  692. return Task.FromResult(true);
  693. }
  694. /// <summary>
  695. /// 停止节拍计时并清理取消令牌。
  696. /// </summary>
  697. public Task<bool> StopCycleTimingAsync(CancellationToken cancellationToken)
  698. {
  699. if (_cycleTimingCts != null)
  700. {
  701. _cycleTimingCts.Cancel();
  702. _cycleTimingCts.Dispose();
  703. _cycleTimingCts = null;
  704. }
  705. return Task.FromResult(true);
  706. }
  707. /// <summary>
  708. /// 新增一条生产计数记录,数量固定为 1。
  709. /// </summary>
  710. public Task<bool> CreateProductionCountAsync(string countItem, CancellationToken cancellationToken)
  711. {
  712. _systemDatabaseService.RecordProductionAsync(new ProductionRecord
  713. {
  714. Category = countItem,
  715. ProductName = _productService.GetCurrentProduct()?.Name ?? "Unknown",
  716. Quantity = 1,
  717. Timestamp = DateTime.UtcNow
  718. });
  719. return Task.FromResult(true);
  720. }
  721. /// <summary>
  722. /// 查询当前产品在指定分类下的累计产量。
  723. /// </summary>
  724. public async Task<int> GetCurrentProductionCountAsync(string countItem, CancellationToken cancellationToken)
  725. {
  726. var currentProduct = _productService.GetCurrentProduct();
  727. if (currentProduct == null) return 0;
  728. var records = _systemDatabaseService.GetProductCategoriesAsync(currentProduct.Name);
  729. int totalCount = await _systemDatabaseService.GetTotalProductionAsync(currentProduct.Name, new List<string> { countItem });
  730. return totalCount;
  731. }
  732. /// <summary>
  733. /// 重置当前产品的生产统计(通过系统 DB 服务)。
  734. /// </summary>
  735. public async Task<bool> ResetProductionCountAsync(string countItem, CancellationToken cancellationToken)
  736. {
  737. var currentProduct = _productService.GetCurrentProduct();
  738. if (currentProduct == null) return false;
  739. await _systemDatabaseService.ResetProductionAsync(currentProduct.Name);
  740. return true;
  741. }
  742. /// <summary>
  743. /// 记录一条报警信息到系统数据库,并通过事件发布错误级别的任务消息。
  744. /// </summary>
  745. public Task<bool> CreateAlarmRecordAsync(string alarmCode, string alarmDescription, CancellationToken cancellationToken)
  746. {
  747. SendTaskMessage(alarmDescription, MessageLevel.Error);
  748. _systemDatabaseService.RecordAlarmAsync(new AlarmRecord
  749. {
  750. Code = alarmCode,
  751. Message = alarmDescription,
  752. Source = "Unknown",
  753. Time = DateTime.UtcNow
  754. });
  755. return Task.FromResult(true);
  756. }
  757. /// <summary>
  758. /// 发布运行信息日志(仅消息推送,不持久化)。
  759. /// </summary>
  760. public Task<bool> CreateOperationLogAsync(string logMessage, CancellationToken cancellationToken)
  761. {
  762. SendTaskMessage(logMessage, MessageLevel.Info);
  763. return Task.FromResult(true);
  764. }
  765. /// <summary>
  766. /// 获取当前产品的全局参数,支持按索引(1-4)返回指定子项,或返回完整 ToString。
  767. /// </summary>
  768. public Task<string> GetGlobalParameterAsync(int parameterNumber, int itemIndex, CancellationToken cancellationToken)
  769. {
  770. var currentProduct = _productService.GetCurrentProduct();
  771. if (currentProduct == null) return Task.FromResult(string.Empty);
  772. if (currentProduct.GlobalParamListCollection == null) return Task.FromResult(string.Empty);
  773. var globalParam = currentProduct.GlobalParamListCollection.FirstOrDefault(p => p.Number == parameterNumber);
  774. if (globalParam == null) return Task.FromResult(string.Empty);
  775. string response = string.Empty;
  776. if (itemIndex == 1)
  777. {
  778. response = $"{globalParam.Number},{globalParam.Name},{globalParam.Param1}";
  779. }
  780. else if (itemIndex == 2)
  781. {
  782. response = $"{globalParam.Number},{globalParam.Name},{globalParam.Param2}";
  783. }
  784. else if (itemIndex == 3)
  785. {
  786. response = $"{globalParam.Number},{globalParam.Name},{globalParam.Param3}";
  787. }
  788. else if (itemIndex == 4)
  789. {
  790. response = $"{globalParam.Number},{globalParam.Name},{globalParam.Param4}";
  791. }
  792. else
  793. {
  794. response = globalParam.ToString();
  795. }
  796. return Task.FromResult(response);
  797. }
  798. /// <summary>
  799. /// 返回当前产品的速度/加速度等运行参数的格式化字符串。
  800. /// </summary>
  801. public Task<string> GetOperationSpeedAsync(CancellationToken cancellationToken)
  802. {
  803. var currentProduct = _productService.GetCurrentProduct();
  804. if (currentProduct == null) return Task.FromResult(string.Empty);
  805. string response = $"{currentProduct.Speed},{currentProduct.Accel},{currentProduct.Speeds},{currentProduct.Accels},{Convert.ToInt16(currentProduct.Power)},{Convert.ToInt16(currentProduct.IsUserUpCamera)}";
  806. return Task.FromResult(response);
  807. }
  808. /// <summary>
  809. /// 获取某流程指定工具编号的工具参数(格式化字符串),找不到返回空字符串。
  810. /// </summary>
  811. public Task<string> GetToolParamAsync(string triggerCommand, int toolNumber, CancellationToken cancellationToken)
  812. {
  813. var currentProduct = _productService.GetCurrentProduct();
  814. if (currentProduct == null) return Task.FromResult(string.Empty);
  815. ProcedureModel procedure = currentProduct.CameraProcedures
  816. .SelectMany(cp => cp.ProcedureModels)
  817. .FirstOrDefault(p => p.TriggerCommand == triggerCommand);
  818. if (procedure == null || procedure.ToolInfo == null) return Task.FromResult(string.Empty);
  819. var tool = procedure.ToolInfo.FirstOrDefault(t => t.Number == toolNumber);
  820. if (tool == null) return Task.FromResult(string.Empty);
  821. if (tool.Tool == null) return Task.FromResult(string.Empty);
  822. 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}";
  823. return Task.FromResult(response);
  824. }
  825. /// <summary>
  826. /// 获取流程参数(例如 WaitPhoto 与用户自定义参数等),以逗号分隔的字符串返回。
  827. /// </summary>
  828. public Task<string> GetProcessParamAsync(string triggerCommand, CancellationToken cancellationToken)
  829. {
  830. var currentProduct = _productService.GetCurrentProduct();
  831. if (currentProduct == null) return Task.FromResult(string.Empty);
  832. ProcedureModel procedure = currentProduct.CameraProcedures
  833. .SelectMany(cp => cp.ProcedureModels)
  834. .FirstOrDefault(p => p.TriggerCommand == triggerCommand);
  835. if (procedure == null || procedure.ToolInfo == null) return Task.FromResult(string.Empty);
  836. StringBuilder response = new StringBuilder();
  837. response.Append($"{procedure.WaitPhoto}");
  838. if (procedure.UserDefineParameters != null)
  839. {
  840. foreach (var param in procedure.UserDefineParameters)
  841. {
  842. response.Append("," + param.ToString());
  843. }
  844. }
  845. return Task.FromResult(response.ToString());
  846. }
  847. /// <summary>
  848. /// 执行指定编号的清料任务(异步)。流程:
  849. /// - 根据配置获取任务
  850. /// - 检查 Feeder 连接性
  851. /// - 使用专用 CancellationTokenSource 跟踪任务并支持停止
  852. /// - 循环执行开挡板、振动、关闭挡板等步骤,检查取消状态
  853. /// </summary>
  854. public async Task<bool> ExecuteClearMaterialTaskAsync(int taskNumber, CancellationToken cancellationToken)
  855. {
  856. var feederClearWork = _configService.GetClearanceTaskByNumber(taskNumber);
  857. if (feederClearWork == null)
  858. {
  859. return false;
  860. }
  861. IVoiceCoilMotorFeeder Feeder = _feederService.GetFeeder(feederClearWork.FeederId);
  862. if (!Feeder.IsConnected)
  863. {
  864. return false;
  865. }
  866. if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode))
  867. {
  868. return false;
  869. }
  870. _clearMaterialCtsDict[feederClearWork.TaskCode] = new CancellationTokenSource();
  871. if (cancellationToken != null)
  872. {
  873. cancellationToken.Register(() =>
  874. {
  875. if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode))
  876. {
  877. _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel();
  878. }
  879. });
  880. }
  881. var token = _clearMaterialCtsDict[feederClearWork.TaskCode].Token;
  882. for (int i = 0; i < feederClearWork.ClearCount; i++)
  883. {
  884. await Feeder.OutputAsync((int)feederClearWork.BeforeOutput + 1, 0);
  885. await Task.Delay(200, token);
  886. if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested))
  887. {
  888. await Feeder.StopOutputAsync();
  889. if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode))
  890. {
  891. _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel();
  892. _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _);
  893. }
  894. return false;
  895. }
  896. for (int j = 0; j < feederClearWork.VibrationCount; j++)
  897. {
  898. await ExecuteFeederWorks(Feeder, feederClearWork.FeederWorks, token, true);
  899. if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested))
  900. {
  901. await Feeder.StopOutputAsync();
  902. if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode))
  903. {
  904. _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel();
  905. _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _);
  906. }
  907. return false;
  908. }
  909. if (!await Feeder.GetOutputStatusAsync())
  910. {
  911. await Feeder.OutputAsync((int)feederClearWork.BeforeOutput + 1, 0);
  912. }
  913. if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested))
  914. {
  915. await Feeder.StopOutputAsync();
  916. if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode))
  917. {
  918. _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel();
  919. _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _);
  920. }
  921. return false;
  922. }
  923. }
  924. if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested))
  925. {
  926. await Feeder.StopOutputAsync();
  927. if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode))
  928. {
  929. _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel();
  930. _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _);
  931. }
  932. return false;
  933. }
  934. await Feeder.StopOutputAsync();
  935. await Task.Delay(300, token);
  936. if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested))
  937. {
  938. await Feeder.StopOutputAsync();
  939. if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode))
  940. {
  941. _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel();
  942. _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _);
  943. }
  944. return false;
  945. }
  946. }
  947. await Feeder.StopOutputAsync();
  948. await Task.Delay(300, token);
  949. if ((cancellationToken != null && cancellationToken.IsCancellationRequested) || (token != null && token.IsCancellationRequested))
  950. {
  951. await Feeder.StopOutputAsync();
  952. if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode))
  953. {
  954. _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel();
  955. _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _);
  956. }
  957. return false;
  958. }
  959. if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode))
  960. {
  961. _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel();
  962. _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _);
  963. }
  964. return true;
  965. }
  966. /// <summary>
  967. /// 停止指定编号的清料任务(如果正在运行)。
  968. /// </summary>
  969. public Task<bool> StopClearMaterialTaskAsync(int taskNumber, CancellationToken cancellationToken)
  970. {
  971. var feederClearWork = _configService.GetClearanceTaskByNumber(taskNumber);
  972. if (feederClearWork == null)
  973. {
  974. return Task.FromResult(false);
  975. }
  976. if (_clearMaterialCtsDict.ContainsKey(feederClearWork.TaskCode))
  977. {
  978. _clearMaterialCtsDict[feederClearWork.TaskCode].Cancel();
  979. _clearMaterialCtsDict.TryRemove(feederClearWork.TaskCode, out _);
  980. }
  981. return Task.FromResult(true);
  982. }
  983. /// <summary>
  984. /// 判断指定编号的机器人是否处于调试模式。
  985. /// </summary>
  986. public Task<bool> IsRobotInDebugModeAsync(int robotNumber, CancellationToken cancellationToken)
  987. {
  988. var robotInfo = _configService.GetAllRobots().FirstOrDefault(r => r.RobotNo == robotNumber);
  989. if (robotInfo == null)
  990. {
  991. return Task.FromResult(false);
  992. }
  993. var robot = _robotService.GetRobot(robotInfo.Id);
  994. if (robot != null) return Task.FromResult(robot.EnterDebugMode);
  995. return Task.FromResult(false);
  996. }
  997. /// <summary>
  998. /// 执行视觉任务的统一入口:
  999. /// - 如果为产品局部脚本存在,则调用脚本
  1000. /// - 否则根据 procedure.FeederId 调用 Feeder 引导的视觉任务或普通视觉任务
  1001. /// 返回是否成功以及字符串数组形式的响应(用于发送多条结果)。
  1002. /// </summary>
  1003. public async Task<(bool IsSucceed, string[] Response)> ExecuteVisionTaskAsync(ProcedureModel procedure, string[] items, CancellationToken cancellationToken, ImageParameters imgPara)
  1004. {
  1005. var currentProduct = _productService.GetCurrentProduct();
  1006. string scriptFilePath = FilePath.ProductsPath + "//" + currentProduct.Name + "//" + procedure.CameraName + "//" + procedure.Name + ".cs";
  1007. if (File.Exists(scriptFilePath))
  1008. {
  1009. try
  1010. {
  1011. string script = FileHelper.ReadFile(scriptFilePath);
  1012. SendTaskMessage(Lang.执行视觉处理脚本, MessageLevel.Debug);
  1013. Tuple<bool, string[]> rstn = null;
  1014. var rst1 = await ScriptHelper.ExecuteVisionScriptingAsync(script, _regionManager, _eventAggregator, _container, procedure, items, rst =>
  1015. {
  1016. rstn = rst;
  1017. });
  1018. if (!rst1.Item1)
  1019. {
  1020. SendTaskMessage(Lang.视觉处理脚本出错, MessageLevel.Error);
  1021. foreach (var item in rst1.Item2)
  1022. {
  1023. SendTaskMessage(item, MessageLevel.Error);
  1024. }
  1025. return (false, new string[] { "ScriptError" });
  1026. }
  1027. return (rstn.Item1, rstn.Item2);
  1028. }
  1029. catch (Exception ex)
  1030. {
  1031. SendTaskMessage(ex.Message, MessageLevel.Error);
  1032. LogHelper.WriteLogError(Lang.执行视觉处理脚本时出错, ex);
  1033. return (false, new string[] { "ScriptException" });
  1034. }
  1035. }
  1036. else
  1037. {
  1038. IVoiceCoilMotorFeeder Feeder = null;
  1039. if (procedure.FeederId != Guid.Empty)
  1040. {
  1041. Feeder = _feederService.GetFeeder(procedure.FeederId);
  1042. return await ExecuteFeederVisionTaskAsync(Feeder, procedure, items, cancellationToken, imgPara);
  1043. }
  1044. else
  1045. {
  1046. var result = await ExecuteNormalVisionTaskAsync(procedure, items, cancellationToken, imgPara);
  1047. return (result.IsSucceed, new string[] { result.Response });
  1048. }
  1049. }
  1050. }
  1051. /// <summary>
  1052. /// 内部:触发节拍计时回调。
  1053. /// </summary>
  1054. private void OnCycleTimingTicked(TimeSpan elapsed)
  1055. {
  1056. CycleTimingTicked?.Invoke(this, elapsed);
  1057. }
  1058. /// <summary>
  1059. /// 发布任务消息到事件聚合器(通过 UI Dispatcher 保证线程安全)。
  1060. /// </summary>
  1061. private void SendTaskMessage(string msg, MessageLevel level)
  1062. {
  1063. App.Current.Dispatcher.Invoke(() =>
  1064. {
  1065. _eventAggregator.GetEvent<TaskMessageNotification>().Publish(new Models.MessageStruct() { Message = msg, level = level });
  1066. });
  1067. }
  1068. #region 执行视觉任务辅助方法
  1069. /// <summary>
  1070. /// 执行 Feeder 引导的视觉任务。负责:
  1071. /// - 解析输入命令(是否先振动/先拍照、SetInputs)
  1072. /// - 在拍照前后执行对应的 Feeder 操作(开灯、振动、供料等)
  1073. /// - 多次尝试拍照并运行视觉工具,直到成功或达到失败次数上限
  1074. /// - 返回布尔成功标记及字符串数组形式的响应项
  1075. /// </summary>
  1076. public async Task<(bool IsSucceed, string[] Response)> ExecuteFeederVisionTaskAsync(IVoiceCoilMotorFeeder feeder, ProcedureModel procedure, string[] items, CancellationToken cancellationToken, ImageParameters imgPara)
  1077. {
  1078. // 如果输入的items中是否包含Vibration和NoVibration,这两个分别对应是否先振动和是否先拍照
  1079. bool doVibrateFirst = items != null && items.Contains("VibrateFirst");
  1080. bool doCaptureFirst = items != null && items.Contains("CaptureFirst");
  1081. if (doVibrateFirst && doCaptureFirst) doCaptureFirst = false; // 如果两个都包含,则以振动优先为准
  1082. // 触发命令传入的输入终端
  1083. Dictionary<string, string> InputTerminal = null;
  1084. // 解析触发命令传入的输入终端参数
  1085. //判断传入参数中是否存在“SetInputs”
  1086. if (items != null && items.Length > 1 && items[0] == "SetInputs")
  1087. {
  1088. //依次从索引1开始解析参数,格式为 key=value,直到遇到非key=value格式的参数为止
  1089. InputTerminal = new Dictionary<string, string>();
  1090. for (int i = 1; i < items.Length; i++)
  1091. {
  1092. var pair = items[i].Split('=');
  1093. if (pair.Length == 2)
  1094. {
  1095. InputTerminal[pair[0]] = pair[1];
  1096. }
  1097. else
  1098. {
  1099. break; // 遇到非key=value格式的参数,停止解析
  1100. }
  1101. }
  1102. }
  1103. await SetLightBeforePhoto(procedure);
  1104. //执行Feeder相机拍照前的任务
  1105. await ExecuteFeederForPhotoBefore(feeder, procedure, doVibrateFirst, doCaptureFirst, cancellationToken);
  1106. // 如果遇到取消令牌,则直接返回失败
  1107. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  1108. {
  1109. await feeder.CloseLightAsync();
  1110. return (false, new string[] { "FeederTaskCancelled" });
  1111. }
  1112. DateTime nowtime = DateTime.Now;
  1113. //拍照失败时,需要多次拍照
  1114. for (int i = 0; i < procedure.FeederFailLimit; i++)
  1115. {
  1116. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  1117. {
  1118. await feeder.CloseLightAsync();
  1119. await TurnOffLightAfterPhoto(procedure);
  1120. return (false, new string[] { "VisionTaskCancelled" });
  1121. }
  1122. SendTaskMessage(Lang.开始执行视觉流程.Replace("{0}", $"{i + 1}").Replace("{1}", procedure.Name), MessageLevel.Info);
  1123. // 1. 执行相机拍照并运行视觉工具
  1124. bool visionSucceed = ExecutePhoto(procedure, InputTerminal, out CogToolBlockTerminalCollection outputCollection, imgPara);
  1125. if (!visionSucceed)
  1126. {
  1127. SendTaskMessage(Lang.视觉任务执行失败, MessageLevel.Error);
  1128. continue;
  1129. }
  1130. if (!outputCollection.Contains("Found"))
  1131. {
  1132. SendTaskMessage(Lang.未找到视觉输出结果, MessageLevel.Error);
  1133. return (false, new string[] { "NoFoundOutput" });
  1134. }
  1135. procedure.LastBlobArea = Convert.ToDouble(outputCollection["BlobTotalArea"].Value);
  1136. // 2. 获取视觉输出结果
  1137. bool Found = (bool)(outputCollection["Found"].Value);
  1138. if (!Found)
  1139. {
  1140. SendTaskMessage(Lang.拍照NG, MessageLevel.Debug);
  1141. await TurnOffLightAfterPhoto(procedure);
  1142. await ExecuteFeederForPhotoLater(feeder, procedure, cancellationToken);
  1143. continue;
  1144. }
  1145. SendTaskMessage(Lang.拍照OK, MessageLevel.Debug);
  1146. if (procedure.ProcedureOutputs == null)
  1147. {
  1148. SendTaskMessage(Lang.视觉流程未配置输出项, MessageLevel.Alarm);
  1149. return (false, new string[] { "NoOutputConfigured" });
  1150. }
  1151. // 3. 获取视觉输出结果
  1152. LogHelper.WriteLogInfo(Lang.开始获取视觉输出结果);
  1153. var (IsSucceed, ErrMsg, Output) = GetVisionOutput(procedure, outputCollection, null);
  1154. if (!IsSucceed)
  1155. {
  1156. SendTaskMessage(Lang.获取视觉输出结果失败, MessageLevel.Error);
  1157. return (false, new string[] { ErrMsg });
  1158. }
  1159. // 4. 组织返回结果
  1160. int outputPointCount = 0;//输出点的数量
  1161. List<double[]> currentPoints = new List<double[]>(); //点位数据
  1162. List<string> outputItems = new List<string>(); //多项输出结果集合
  1163. foreach (var output in procedure.ProcedureOutputs)
  1164. {
  1165. if (Output.ContainsKey(output.Name))
  1166. {
  1167. var (IsPoint, Value) = Output[output.Name];
  1168. if (IsPoint)
  1169. {
  1170. //Value是点位数据,类型:List<string[]>,string[]是一个点位,里面是X、Y,U等数据
  1171. //将所有点位数据和单个点位数据中的坐标之间都用逗号分隔,多个点位之间用逗号分隔
  1172. List<string[]> points = Value as List<string[]>;
  1173. List<string> allpoints = new List<string>();
  1174. for (int j = 0; j < points.Count; j++)
  1175. {
  1176. //如果当前流程开启了剔除重复点功能,则进行剔除
  1177. if (procedure.IsExcludeNearPoint && procedure.LastRunPoints != null && procedure.LastRunPoints.Count > 0)
  1178. {
  1179. //当前点的坐标数据
  1180. double px = double.Parse(points[j][0]);
  1181. double py = double.Parse(points[j][1]);
  1182. double pu = double.Parse(points[j][2]);
  1183. //检查当前点是否与上次运行的点过于接近
  1184. //使用linq来检测上一次的点位集合中,是否存在某个点与当前点的x,y,u的差值小于设定的阈值
  1185. bool isNear = procedure.LastRunPoints.Any(lp =>
  1186. Math.Abs(lp[0] - px) < procedure.ExcludeNearPointThreshol &&
  1187. Math.Abs(lp[1] - py) < procedure.ExcludeNearPointThreshol &&
  1188. Math.Abs(lp[2] - pu) < procedure.ExcludeNearPointThreshol);
  1189. if (isNear) continue; //如果存在接近的点,则跳过当前点,不进行添加
  1190. }
  1191. //单个点位内坐标之间逗号分隔
  1192. allpoints.Add(string.Join(",", points[j]));
  1193. //如果输出模式是AllAtOnce或者BatchedUntilTerminator,则需要检查是否达到最大点位数量限制
  1194. if (procedure.OutputPointMode == OutputPointMode.AllAtOnce || procedure.OutputPointMode == OutputPointMode.BatchedUntilTerminator)
  1195. {
  1196. //如果当前总点位数量已经达到最大限制,则停止添加更多点位
  1197. if (allpoints.Count >= procedure.OutputPointCountMax)
  1198. {
  1199. break;
  1200. }
  1201. }
  1202. currentPoints.Add(new double[] { double.Parse(points[j][0]), double.Parse(points[j][1]), double.Parse(points[j][2]) });
  1203. }
  1204. //多个点位之间逗号分隔
  1205. string pointstr = allpoints.Count + "," + string.Join(",", allpoints);
  1206. if (procedure.OutputPointMode == OutputPointMode.UntilTerminator || procedure.OutputPointMode == OutputPointMode.BatchedUntilTerminator)
  1207. {
  1208. outputItems.AddRange(allpoints);
  1209. }
  1210. else
  1211. {
  1212. outputItems.Add(pointstr);
  1213. }
  1214. outputPointCount += allpoints.Count;
  1215. }
  1216. else
  1217. {
  1218. string itemstr = Value != null ? Value.ToString() : string.Empty;
  1219. outputItems.Add(itemstr);
  1220. }
  1221. }
  1222. }
  1223. procedure.LastRunPoints = currentPoints;
  1224. //关闭Feeder灯光
  1225. if (feeder.IsConnected)
  1226. {
  1227. await feeder.CloseLightAsync();
  1228. }
  1229. await TurnOffLightAfterPhoto(procedure);
  1230. //如果输出模式是AllAtOnce或者BatchedUntilTerminator,则分次发送数据
  1231. if (procedure.OutputPointMode == OutputPointMode.UntilTerminator || procedure.OutputPointMode == OutputPointMode.BatchedUntilTerminator)
  1232. {
  1233. //将outputItems按照procedure.OutputSeparator进行拼接,得到最终返回结果
  1234. string finalResponse = string.Join(procedure.OutputSeparator, outputItems);
  1235. return (true, outputItems.ToArray());
  1236. }
  1237. else
  1238. {
  1239. //否则,一次发送所有数据
  1240. //将outputItems按照procedure.OutputSeparator进行拼接,得到最终返回结果
  1241. string finalResponse = string.Join(procedure.OutputSeparator, outputItems);
  1242. return (true, new string[] { finalResponse });
  1243. }
  1244. }
  1245. //关闭Feeder灯光
  1246. if (feeder.IsConnected)
  1247. {
  1248. await feeder.CloseLightAsync();
  1249. }
  1250. await TurnOffLightAfterPhoto(procedure);
  1251. SendTaskMessage(Lang.多次拍照失败, MessageLevel.Alarm);
  1252. return (false, new string[] { "VisionFailed" });
  1253. }
  1254. /// <summary>
  1255. /// 执行非 Feeder 引导的普通视觉任务,返回单字符串响应。
  1256. /// </summary>
  1257. public async Task<(bool IsSucceed, string Response)> ExecuteNormalVisionTaskAsync(ProcedureModel procedure, string[] items, CancellationToken cancellationToken, ImageParameters imgPara)
  1258. {
  1259. // 开始执行前的时间点
  1260. DateTime startTime = DateTime.Now;
  1261. try
  1262. {
  1263. await SetLightBeforePhoto(procedure);
  1264. // 触发命令传入的输入终端
  1265. Dictionary<string, string> InputTerminal = null;
  1266. // 解析触发命令传入的输入终端参数
  1267. //判断传入参数中是否存在“SetInputs”
  1268. if (items != null && items.Length > 1 && items[0] == "SetInputs")
  1269. {
  1270. InputTerminal = items.Skip(1)
  1271. .Select(x => x.Split('='))
  1272. .Where(y => y.Length == 2)
  1273. .ToDictionary(z => z[0], z => z[1]);
  1274. }
  1275. // 机器人当前坐标
  1276. double[] currentpos = null;
  1277. // 判断传入参数长度是否3,并且是否都是double
  1278. 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))
  1279. {
  1280. currentpos = new double[] { _x, _y, _u };
  1281. }
  1282. //拍照失败时,需要多次拍照
  1283. for (int i = 0; i < procedure.FeederFailLimit; i++)
  1284. {
  1285. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  1286. {
  1287. return (false, "VisionTaskCancelled");
  1288. }
  1289. // 1. 执行相机拍照并运行视觉工具
  1290. LogHelper.WriteLogInfo(Lang.开始执行相机拍照并运行视觉工具);
  1291. bool visionSucceed = ExecutePhoto(procedure, InputTerminal, out CogToolBlockTerminalCollection outputCollection, imgPara);
  1292. if (!visionSucceed)
  1293. {
  1294. SendTaskMessage(Lang.视觉任务执行失败, MessageLevel.Error);
  1295. continue;
  1296. }
  1297. if (!outputCollection.Contains("Found"))
  1298. {
  1299. SendTaskMessage(Lang.未找到视觉输出结果, MessageLevel.Error);
  1300. return (false, "NoFoundOutput");
  1301. }
  1302. bool Found = (bool)(outputCollection["Found"].Value);
  1303. if (!Found)
  1304. {
  1305. SendTaskMessage(Lang.拍照NG, MessageLevel.Debug);
  1306. continue;
  1307. }
  1308. SendTaskMessage(Lang.拍照OK, MessageLevel.Debug);
  1309. // 2. 获取视觉输出结果
  1310. LogHelper.WriteLogInfo(Lang.开始获取视觉输出结果);
  1311. var (IsSucceed, ErrMsg, Output) = GetVisionOutput(procedure, outputCollection, currentpos);
  1312. if (!IsSucceed)
  1313. {
  1314. SendTaskMessage(Lang.获取视觉输出结果失败, MessageLevel.Error);
  1315. return (false, ErrMsg);
  1316. }
  1317. // 3. 组织返回结果
  1318. List<string> outputItems = new List<string>(); //多项输出结果集合
  1319. foreach (var output in procedure.ProcedureOutputs)
  1320. {
  1321. if (Output.ContainsKey(output.Name))
  1322. {
  1323. var (IsPoint, Value) = Output[output.Name];
  1324. if (IsPoint)
  1325. {
  1326. List<string[]> points = Value as List<string[]>;
  1327. List<string> allpoints = new List<string>();
  1328. for (int j = 0; j < points.Count; j++)
  1329. {
  1330. allpoints.Add(string.Join(",", points[j]));
  1331. }
  1332. //多个点位之间逗号分隔
  1333. string pointstr = allpoints.Count + "," + string.Join(",", allpoints);
  1334. outputItems.Add(pointstr);
  1335. }
  1336. else
  1337. {
  1338. string itemstr = Value != null ? Value.ToString() : string.Empty;
  1339. outputItems.Add(itemstr);
  1340. }
  1341. }
  1342. }
  1343. //将outputItems按照procedure.OutputSeparator进行拼接,得到最终返回结果
  1344. string finalResponse = string.Join(procedure.OutputSeparator, outputItems);
  1345. return (true, finalResponse);
  1346. }
  1347. return (false, "VisionFailed");
  1348. }
  1349. catch (Exception ex)
  1350. {
  1351. SendTaskMessage(ex.Message, MessageLevel.Error);
  1352. LogHelper.WriteLogError(Lang.执行普通视觉任务时出错, ex);
  1353. return (false, "Exception");
  1354. }
  1355. finally
  1356. {
  1357. await TurnOffLightAfterPhoto(procedure);
  1358. }
  1359. }
  1360. /// <summary>
  1361. /// 执行相机拍照并运行 ToolBlock,返回是否成功并通过 out 参数返回 Outputs。
  1362. /// 该方法会发布 RenderUpdateNotification 以更新 UI。
  1363. /// </summary>
  1364. public bool ExecutePhoto(ProcedureModel procedure, Dictionary<string, string> InputTerminal, out CogToolBlockTerminalCollection outputCollection, ImageParameters imgPara)
  1365. {
  1366. try
  1367. {
  1368. // 1. 采集图像
  1369. var camera = _cameraService.GetCamera(procedure.CameraId);
  1370. bool succed = camera.SetExposureTime(procedure.ExposureTime);
  1371. if (!succed)
  1372. {
  1373. SendTaskMessage(Lang.相机曝光设置失败, MessageLevel.Error);
  1374. }
  1375. succed = camera.SetGain(procedure.Gain);
  1376. if (!succed)
  1377. {
  1378. SendTaskMessage(Lang.相机增益设置失败, MessageLevel.Error);
  1379. }
  1380. DateTime nowtime = DateTime.Now;
  1381. LogHelper.WriteLogInfo(Lang.开始采集图像);
  1382. var image = camera.Grab();
  1383. if (image == null)
  1384. {
  1385. SendTaskMessage(Lang.图像采集失败, MessageLevel.Error);
  1386. outputCollection = null;
  1387. return false;
  1388. }
  1389. procedure.ToolBlock.Inputs["InputImage"].Value = image;
  1390. LogHelper.WriteLogInfo(string.Format(Lang.采集图像完成用时0ms, (DateTime.Now - nowtime).Milliseconds));
  1391. // 2. 为ToolBlock传入其他输入终端
  1392. if (InputTerminal != null)
  1393. {
  1394. LogHelper.WriteLogInfo(Lang.为ToolBlock传入输入终端);
  1395. foreach (var item in InputTerminal)
  1396. {
  1397. if (procedure.ToolBlock.Inputs.Contains(item.Key))
  1398. {
  1399. LogHelper.WriteLogInfo(string.Format(Lang.传入01, item.Key, item.Value));
  1400. procedure.ToolBlock.Inputs[item.Key].Value = item.Value;
  1401. }
  1402. else
  1403. {
  1404. LogHelper.WriteLogInfo(string.Format(Lang.创建并传入01, item.Key, item.Value));
  1405. procedure.ToolBlock.Inputs.Add(new CogToolBlockTerminal(item.Key, item.Value));
  1406. }
  1407. }
  1408. }
  1409. // 3. 运行视觉工具
  1410. LogHelper.WriteLogInfo(Lang.开始运行视觉工具);
  1411. procedure.ToolBlock.Run(); //运行ToolBlock
  1412. if (procedure.ToolBlock.RunStatus.Result == CogToolResultConstants.Accept)
  1413. {
  1414. SendTaskMessage(Lang.视觉流程执行耗时.Replace("{0}", procedure.Name).Replace("{1}", $"{procedure.ToolBlock.RunStatus.ProcessingTime:F1}"), MessageLevel.Info);
  1415. outputCollection = procedure.ToolBlock.Outputs; //获取输出终端集合
  1416. DatabaseHelper.AddCameraRecords(_productService.GetCurrentProduct().Name, procedure.Name, outputCollection);
  1417. ICogRecord record = null;
  1418. foreach (CogToolBlockTerminal item in outputCollection)
  1419. {
  1420. if (item.Value is ICogRecord)
  1421. record = item.Value as ICogRecord;
  1422. }
  1423. _eventAggregator.GetEvent<RenderUpdateNotification>().Publish(new ShowRender()
  1424. {
  1425. Id = procedure.Id,
  1426. Image = (ICogImage)procedure.ToolBlock.Inputs["InputImage"].Value,
  1427. Graphic = outputCollection["Graphic"].Value as CogGraphicCollection,
  1428. Record = record,
  1429. Result = (bool)(outputCollection["Found"].Value),
  1430. IsShow = true,
  1431. IsSaveImage = procedure.IsSaveImage,
  1432. SaveImageModel = procedure.SaveImageModel,
  1433. SaveImagePathModel = procedure.SaveImagePathModel,
  1434. SavePath = procedure.SavePath,
  1435. IsCompress = procedure.IsCompress,
  1436. ImgPara = imgPara,
  1437. });
  1438. SendTaskMessage($"{procedure.CameraName},{procedure.CameraId}", MessageLevel.Info);
  1439. return true;
  1440. }
  1441. else
  1442. {
  1443. SendTaskMessage(Lang.视觉流程执行出错耗时.Replace("{0}", procedure.Name).Replace("{1}", $"{procedure.ToolBlock.RunStatus.ProcessingTime:F1}"), MessageLevel.Error);
  1444. SendTaskMessage(procedure.ToolBlock.RunStatus.Message, MessageLevel.Error);
  1445. outputCollection = null;
  1446. _eventAggregator.GetEvent<RenderUpdateNotification>().Publish(new ShowRender()
  1447. {
  1448. Id = procedure.Id,
  1449. Image = (ICogImage)procedure.ToolBlock.Inputs["InputImage"].Value,
  1450. Graphic = new CogGraphicCollection(),
  1451. Result = false,
  1452. IsShow = true,
  1453. IsSaveImage = procedure.IsSaveImage,
  1454. SaveImageModel = procedure.SaveImageModel,
  1455. SaveImagePathModel = procedure.SaveImagePathModel,
  1456. SavePath = procedure.SavePath,
  1457. ProceductName = procedure.Name,
  1458. });
  1459. return false;
  1460. }
  1461. }
  1462. catch (Exception ex)
  1463. {
  1464. SendTaskMessage(ex.Message, MessageLevel.Error);
  1465. LogHelper.WriteLogError(Lang.执行相机取图并执行视觉工具组时出错, ex);
  1466. outputCollection = null;
  1467. return false;
  1468. }
  1469. }
  1470. /// <summary>
  1471. /// 执行拍照二维码流程运行
  1472. /// </summary>
  1473. /// <param name="procedure"></param>
  1474. /// <param name="outputCollection"></param>
  1475. /// <returns></returns>
  1476. public bool ExecutePhoto(ProcedureModel procedure, out CogToolBlockTerminalCollection outputCollection)
  1477. {
  1478. try
  1479. {
  1480. SetLightBeforePhoto(procedure);
  1481. // 1. 采集图像
  1482. var camera = _cameraService.GetCamera(procedure.CameraId);
  1483. bool succed = camera.SetExposureTime(procedure.ExposureTime);
  1484. if (!succed)
  1485. {
  1486. SendTaskMessage(Lang.相机曝光设置失败, MessageLevel.Error);
  1487. }
  1488. succed = camera.SetGain(procedure.Gain);
  1489. if (!succed)
  1490. {
  1491. SendTaskMessage(Lang.相机增益设置失败, MessageLevel.Error);
  1492. }
  1493. DateTime nowtime = DateTime.Now;
  1494. LogHelper.WriteLogInfo(Lang.开始采集图像);
  1495. var image = camera.Grab();
  1496. if (image == null)
  1497. {
  1498. SendTaskMessage(Lang.图像采集失败, MessageLevel.Error);
  1499. outputCollection = null;
  1500. return false;
  1501. }
  1502. procedure.ToolBlock.Inputs["InputImage"].Value = image;
  1503. LogHelper.WriteLogInfo(string.Format(Lang.采集图像完成用时0ms, (DateTime.Now - nowtime).Milliseconds));
  1504. // 3. 运行视觉工具
  1505. LogHelper.WriteLogInfo(Lang.开始运行视觉工具);
  1506. procedure.ToolBlock.Run(); //运行ToolBlock
  1507. if (procedure.ToolBlock.RunStatus.Result == CogToolResultConstants.Accept)
  1508. {
  1509. SendTaskMessage(Lang.视觉流程执行耗时.Replace("{0}", procedure.Name).Replace("{1}", $"{procedure.ToolBlock.RunStatus.ProcessingTime:F1}"), MessageLevel.Info);
  1510. outputCollection = procedure.ToolBlock.Outputs; //获取输出终端集合
  1511. DatabaseHelper.AddCameraRecords(_productService.GetCurrentProduct().Name, procedure.Name, outputCollection);
  1512. ICogRecord record = null;
  1513. foreach (CogToolBlockTerminal item in outputCollection)
  1514. {
  1515. if (item.Value is ICogRecord)
  1516. record = item.Value as ICogRecord;
  1517. }
  1518. _eventAggregator.GetEvent<RenderUpdateNotification>().Publish(new ShowRender()
  1519. {
  1520. Id = procedure.Id,
  1521. Image = (ICogImage)procedure.ToolBlock.Inputs["InputImage"].Value,
  1522. Graphic = outputCollection["Graphic"].Value as CogGraphicCollection,
  1523. Record = record,
  1524. Result = (bool)(outputCollection["Found"].Value),
  1525. IsShow = true,
  1526. IsSaveImage = procedure.IsSaveImage,
  1527. SaveImageModel = procedure.SaveImageModel,
  1528. SaveImagePathModel = procedure.SaveImagePathModel,
  1529. SavePath = procedure.SavePath,
  1530. IsCompress = procedure.IsCompress,
  1531. ProceductName = procedure.Name
  1532. });
  1533. SendTaskMessage($"{procedure.CameraName},{procedure.CameraId}", MessageLevel.Info);
  1534. return true;
  1535. }
  1536. else
  1537. {
  1538. SendTaskMessage(Lang.视觉流程执行出错耗时.Replace("{0}", procedure.Name).Replace("{1}", $"{procedure.ToolBlock.RunStatus.ProcessingTime:F1}"), MessageLevel.Error);
  1539. SendTaskMessage(procedure.ToolBlock.RunStatus.Message, MessageLevel.Error);
  1540. outputCollection = null;
  1541. _eventAggregator.GetEvent<RenderUpdateNotification>().Publish(new ShowRender()
  1542. {
  1543. Id = procedure.Id,
  1544. Image = (ICogImage)procedure.ToolBlock.Inputs["InputImage"].Value,
  1545. Graphic = new CogGraphicCollection(),
  1546. Result = false,
  1547. IsShow = true,
  1548. IsSaveImage = procedure.IsSaveImage,
  1549. SaveImageModel = procedure.SaveImageModel,
  1550. SaveImagePathModel = procedure.SaveImagePathModel,
  1551. SavePath = procedure.SavePath,
  1552. ProceductName = procedure.Name,
  1553. });
  1554. return false;
  1555. }
  1556. }
  1557. catch (Exception ex)
  1558. {
  1559. SendTaskMessage(ex.Message, MessageLevel.Error);
  1560. LogHelper.WriteLogError(Lang.执行相机取图并执行视觉工具组时出错, ex);
  1561. outputCollection = null;
  1562. return false;
  1563. }
  1564. }
  1565. /// <summary>
  1566. /// 执行相机拍照并运行 ToolBlock,返回是否成功并通过 out 参数返回 Outputs、图像和图形集合。
  1567. /// </summary>
  1568. /// <param name="procedure"></param>
  1569. /// <param name="InputTerminal"></param>
  1570. /// <param name="outputCollection"></param>
  1571. /// <param name="outImage"></param>
  1572. /// <param name="outGraphicCollection"></param>
  1573. /// <returns></returns>
  1574. public bool ExecutePhotoEx(ProcedureModel procedure, Dictionary<string, string> InputTerminal, out CogToolBlockTerminalCollection outputCollection, out ICogImage outImage, out CogGraphicCollection outGraphicCollection)
  1575. {
  1576. outImage = null;
  1577. outGraphicCollection = null;
  1578. try
  1579. {
  1580. // 1. 采集图像
  1581. var camera = _cameraService.GetCamera(procedure.CameraId);
  1582. bool succed = camera.SetExposureTime(procedure.ExposureTime);
  1583. if (!succed)
  1584. {
  1585. SendTaskMessage(Lang.相机曝光设置失败, MessageLevel.Error);
  1586. }
  1587. succed = camera.SetGain(procedure.Gain);
  1588. if (!succed)
  1589. {
  1590. SendTaskMessage(Lang.相机增益设置失败, MessageLevel.Error);
  1591. }
  1592. DateTime nowtime = DateTime.Now;
  1593. LogHelper.WriteLogInfo(Lang.开始采集图像);
  1594. var image = camera.Grab();
  1595. if (image == null)
  1596. {
  1597. SendTaskMessage(Lang.图像采集失败, MessageLevel.Error);
  1598. outputCollection = null;
  1599. return false;
  1600. }
  1601. outImage = image;
  1602. procedure.ToolBlock.Inputs["InputImage"].Value = image;
  1603. LogHelper.WriteLogInfo(string.Format(Lang.采集图像完成用时0ms, (DateTime.Now - nowtime).Milliseconds));
  1604. // 2. 为ToolBlock传入其他输入终端
  1605. if (InputTerminal != null)
  1606. {
  1607. LogHelper.WriteLogInfo(Lang.为ToolBlock传入输入终端);
  1608. foreach (var item in InputTerminal)
  1609. {
  1610. if (procedure.ToolBlock.Inputs.Contains(item.Key))
  1611. {
  1612. LogHelper.WriteLogInfo($"传入[{item.Key}]={item.Value}");
  1613. procedure.ToolBlock.Inputs[item.Key].Value = item.Value;
  1614. }
  1615. else
  1616. {
  1617. LogHelper.WriteLogInfo($"创建并传入[{item.Key}]={item.Value}");
  1618. procedure.ToolBlock.Inputs.Add(new CogToolBlockTerminal(item.Key, item.Value));
  1619. }
  1620. }
  1621. }
  1622. // 3. 运行视觉工具
  1623. LogHelper.WriteLogInfo(Lang.开始运行视觉工具);
  1624. procedure.ToolBlock.Run(); //运行ToolBlock
  1625. if (procedure.ToolBlock.RunStatus.Result == CogToolResultConstants.Accept)
  1626. {
  1627. SendTaskMessage(Lang.视觉流程执行耗时.Replace("{0}", procedure.Name).Replace("{1}", $"{procedure.ToolBlock.RunStatus.ProcessingTime:F1}"), MessageLevel.Info);
  1628. outputCollection = procedure.ToolBlock.Outputs; //获取输出终端集合
  1629. DatabaseHelper.AddCameraRecords(_productService.GetCurrentProduct().Name, procedure.Name, outputCollection);
  1630. ICogRecord record = null;
  1631. foreach (CogToolBlockTerminal item in outputCollection)
  1632. {
  1633. if (item.Value is ICogRecord)
  1634. record = item.Value as ICogRecord;
  1635. }
  1636. outGraphicCollection = outputCollection["Graphic"].Value as CogGraphicCollection;
  1637. return true;
  1638. }
  1639. else
  1640. {
  1641. SendTaskMessage(Lang.视觉流程执行出错耗时.Replace("{0}", procedure.Name).Replace("{1}", $"{procedure.ToolBlock.RunStatus.ProcessingTime:F1}"), MessageLevel.Error);
  1642. SendTaskMessage(procedure.ToolBlock.RunStatus.Message, MessageLevel.Error);
  1643. outputCollection = null;
  1644. outGraphicCollection = outputCollection["Graphic"].Value as CogGraphicCollection;
  1645. return false;
  1646. }
  1647. }
  1648. catch (Exception ex)
  1649. {
  1650. SendTaskMessage(ex.Message, MessageLevel.Error);
  1651. LogHelper.WriteLogError(Lang.执行相机取图并执行视觉工具组时出错, ex);
  1652. outputCollection = null;
  1653. return false;
  1654. }
  1655. }
  1656. /// <summary>
  1657. /// 执行相机拍照获取单个点位结果
  1658. /// </summary>
  1659. /// <param name="procedure"></param>
  1660. /// <param name="InputTerminal"></param>
  1661. /// <param name="robotCoord"></param>
  1662. /// <param name="cancellationToken"></param>
  1663. /// <param name="positionIndex"></param>
  1664. /// <param name="remark"></param>
  1665. /// <returns></returns>
  1666. public async Task<(bool IsSucceed, double X, double Y, double U)> ExecutePhotoGetSinglePoint(ProcedureModel procedure, Dictionary<string, string> InputTerminal, double[] robotCoord, CancellationToken cancellationToken, int positionIndex, string remark, ImageParameters imgPara)
  1667. {
  1668. DateTime nowtime = DateTime.Now;
  1669. await SetLightBeforePhoto(procedure);
  1670. try
  1671. {
  1672. //拍照失败时,需要多次拍照
  1673. for (int i = 0; i < procedure.FeederFailLimit; i++)
  1674. {
  1675. SendTaskMessage(Lang.开始执行视觉流程.Replace("{0}", $"{i + 1}").Replace("{1}", procedure.Name), MessageLevel.Info);
  1676. // 1. 执行相机拍照并运行视觉工具
  1677. bool visionSucceed = ExecutePhoto(procedure, InputTerminal, out CogToolBlockTerminalCollection outputCollection, imgPara);
  1678. if (!visionSucceed)
  1679. {
  1680. SendTaskMessage(Lang.视觉任务执行失败, MessageLevel.Error);
  1681. continue;
  1682. }
  1683. if (!outputCollection.Contains("Found"))
  1684. {
  1685. SendTaskMessage(Lang.未找到视觉输出结果, MessageLevel.Error);
  1686. await RecordPhotoCaptureAsync(procedure, robotCoord, false, new double[] { 0, 0, 0 }, new double[] { 0, 0, 0 }, string.Empty, positionIndex, remark);
  1687. return (false, 0, 0, 0);
  1688. }
  1689. // 2. 获取视觉输出结果
  1690. bool Found = (bool)(outputCollection["Found"].Value);
  1691. if (!Found)
  1692. {
  1693. SendTaskMessage(Lang.拍照NG, MessageLevel.Debug);
  1694. continue;
  1695. }
  1696. SendTaskMessage(Lang.拍照OK, MessageLevel.Debug);
  1697. if (procedure.CalibrationId== Guid.Empty)
  1698. {
  1699. //没有关联校准时,则执行检测任务
  1700. await RecordPhotoCaptureAsync(procedure, robotCoord, true, new double[] { 0, 0, 0 }, new double[] { 0, 0, 0 }, string.Empty, positionIndex, remark);
  1701. return (true, 0, 0, 0);
  1702. }
  1703. // 3. 获取视觉输出结果
  1704. LogHelper.WriteLogInfo(Lang.开始获取视觉输出结果);
  1705. //获取相机校准
  1706. var calib = _calibrationService.GetCalibration(procedure.CalibrationId);
  1707. string points = (string)(outputCollection["Point"].Value);
  1708. string[] strpoints = points.Split(';');
  1709. //先将pos按照逗号进行分隔,拿到数组
  1710. var posParts = strpoints[0].Split(',');
  1711. double _pixel_x = double.Parse(posParts[0]);
  1712. double _pixel_y = double.Parse(posParts[1]);
  1713. double _pixel_u = double.Parse(posParts[2]);
  1714. //转换点位-像素转换成机器人绝对坐标
  1715. var calibResult = _calibrationService.ConvertPixelToPosition((_pixel_x, _pixel_y, _pixel_u), robotCoord, calib, RobotBrand.XYZ_Platform);
  1716. if (!calibResult.IsSucceed)
  1717. {
  1718. await RecordPhotoCaptureAsync(procedure, robotCoord, false, new double[] { _pixel_x, _pixel_y, _pixel_u }, new double[] { 0, 0, 0 }, string.Empty, positionIndex, remark);
  1719. return (false, 0, 0, 0);
  1720. }
  1721. await RecordPhotoCaptureAsync(procedure, robotCoord,true, new double[] { _pixel_x, _pixel_y, _pixel_u }, new double[] { calibResult.X, calibResult.Y, calibResult.U }, string.Empty, positionIndex, remark);
  1722. return (true, calibResult.X, calibResult.Y, calibResult.U);
  1723. }
  1724. SendTaskMessage(Lang.多次拍照失败, MessageLevel.Alarm);
  1725. await RecordPhotoCaptureAsync(procedure, robotCoord, false, new double[] { 0, 0, 0 }, new double[] { 0, 0, 0 }, string.Empty, positionIndex, remark);
  1726. return (false, 0, 0, 0);
  1727. }
  1728. catch (Exception ex)
  1729. {
  1730. LogHelper.WriteLogError(Lang.执行相机取图并获取单点位时出错, ex);
  1731. await RecordPhotoCaptureAsync(procedure, robotCoord, false, new double[] { 0, 0, 0 }, new double[] { 0, 0, 0 }, string.Empty, positionIndex, remark);
  1732. return (false, 0, 0, 0);
  1733. }
  1734. finally
  1735. {
  1736. await TurnOffLightAfterPhoto(procedure);
  1737. }
  1738. }
  1739. /// <summary>
  1740. /// 记录拍照结果数据至数据库
  1741. /// </summary>
  1742. /// <param name="procedure"></param>
  1743. /// <param name="robotCoord"></param>
  1744. /// <param name="isSuccess"></param>
  1745. /// <param name="pixelPosition"></param>
  1746. /// <param name="absolutePosition"></param>
  1747. /// <param name="imagePath"></param>
  1748. /// <param name="positionIndex"></param>
  1749. /// <param name="emarks"></param>
  1750. /// <returns></returns>
  1751. private async Task RecordPhotoCaptureAsync(ProcedureModel procedure, double[] robotCoord, bool isSuccess, double[] pixelPosition, double[] absolutePosition, string imagePath, int positionIndex, string emarks)
  1752. {
  1753. try
  1754. {
  1755. //当前的产品配方名
  1756. string formulaName = _productService.GetCurrentProduct().Name;
  1757. //如果当前产品名称存在非法字符,则替换为下划线
  1758. foreach (char c in System.IO.Path.GetInvalidFileNameChars())
  1759. {
  1760. formulaName = formulaName.Replace(c, '_');
  1761. }
  1762. //获取当前的产品SN
  1763. string productSN = _productService.CurrentProductCode;
  1764. //如果产品SN存在非法字符,则替换为下划线
  1765. foreach (char c in System.IO.Path.GetInvalidFileNameChars())
  1766. {
  1767. productSN = productSN.Replace(c, '_');
  1768. }
  1769. //当前用户
  1770. string currentUser = _systemDatabaseService.GetCurrentUser()?.UserName;
  1771. //相机名称
  1772. string cameraName = procedure.CameraName;
  1773. //视觉流程名称
  1774. string procedureName = procedure.Name;
  1775. //如果机器人坐标为空,则获取当前机器人坐标
  1776. if (robotCoord == null)
  1777. {
  1778. var robot = _robotService.GetAllRobots().FirstOrDefault();
  1779. if (robot != null)
  1780. {
  1781. var pos = await robot.GetRobotPosAsync();
  1782. robotCoord = new double[] { pos.X, pos.Y, pos.Z };
  1783. }
  1784. else
  1785. {
  1786. robotCoord = new double[] { 0, 0, 0 };
  1787. }
  1788. }
  1789. PhotoCaptureRecord photoCaptureRecord = new PhotoCaptureRecord();
  1790. photoCaptureRecord.RecipeName = formulaName;
  1791. photoCaptureRecord.ProductSN = productSN;
  1792. photoCaptureRecord.CameraName = cameraName;
  1793. photoCaptureRecord.ProcessName = procedureName;
  1794. photoCaptureRecord.RobotPosition=string.Join(",", robotCoord);
  1795. photoCaptureRecord.IsSuccess = isSuccess;
  1796. photoCaptureRecord.PixelPosition = string.Join(",", pixelPosition);
  1797. photoCaptureRecord.AbsolutePosition = string.Join(",", absolutePosition);
  1798. photoCaptureRecord.ImagePath = imagePath;
  1799. photoCaptureRecord.Remarks = emarks;
  1800. photoCaptureRecord.OperatorName = currentUser;
  1801. await _systemDatabaseService.RecordPhotoCaptureAsync(photoCaptureRecord);
  1802. }
  1803. catch (Exception ex)
  1804. {
  1805. LogHelper.WriteLogError("记录拍照结果数据至数据库时出错", ex);
  1806. }
  1807. }
  1808. /// <summary>
  1809. /// 执行相机拍照获取单个点位结果,并且返回图像和图形
  1810. /// </summary>
  1811. /// <param name="procedure"></param>
  1812. /// <param name="InputTerminal"></param>
  1813. /// <param name="robotCoord"></param>
  1814. /// <param name="cancellationToken"></param>
  1815. /// <returns></returns>
  1816. public async Task<(bool IsSucceed, double X, double Y, double U, ICogImage Image, CogGraphicCollection Graphic)> ExecutePhotoGetSinglePointWithImage(ProcedureModel procedure, Dictionary<string, string> InputTerminal, double[] robotCoord, CancellationToken cancellationToken)
  1817. {
  1818. DateTime nowtime = DateTime.Now;
  1819. await SetLightBeforePhoto(procedure);
  1820. ICogImage outImage = null;
  1821. CogGraphicCollection outGraphicCollection = null;
  1822. try
  1823. {
  1824. //拍照失败时,需要多次拍照
  1825. for (int i = 0; i < procedure.FeederFailLimit; i++)
  1826. {
  1827. SendTaskMessage(Lang.开始执行视觉流程.Replace("{0}", $"{i + 1}").Replace("{1}", procedure.Name), MessageLevel.Info);
  1828. // 1. 执行相机拍照并运行视觉工具
  1829. bool visionSucceed = ExecutePhotoEx(procedure, InputTerminal, out CogToolBlockTerminalCollection outputCollection, out outImage, out outGraphicCollection);
  1830. if (!visionSucceed)
  1831. {
  1832. SendTaskMessage(Lang.视觉任务执行失败, MessageLevel.Error);
  1833. continue;
  1834. }
  1835. if (!outputCollection.Contains("Found"))
  1836. {
  1837. SendTaskMessage(Lang.未找到视觉输出结果, MessageLevel.Error);
  1838. return (false, 0, 0, 0, outImage, outGraphicCollection);
  1839. }
  1840. // 2. 获取视觉输出结果
  1841. bool Found = (bool)(outputCollection["Found"].Value);
  1842. if (!Found)
  1843. {
  1844. SendTaskMessage(Lang.拍照NG, MessageLevel.Debug);
  1845. continue;
  1846. }
  1847. SendTaskMessage(Lang.拍照OK, MessageLevel.Debug);
  1848. // 3. 获取视觉输出结果
  1849. LogHelper.WriteLogInfo(Lang.开始获取视觉输出结果);
  1850. //获取相机校准
  1851. var calib = _calibrationService.GetCalibration(procedure.CalibrationId);
  1852. string points = (string)(outputCollection["Point"].Value);
  1853. string[] strpoints = points.Split(';');
  1854. //先将pos按照逗号进行分隔,拿到数组
  1855. var posParts = strpoints[0].Split(',');
  1856. double _pixel_x = double.Parse(posParts[0]);
  1857. double _pixel_y = double.Parse(posParts[1]);
  1858. double _pixel_u = double.Parse(posParts[2]);
  1859. //转换点位-像素转换成机器人绝对坐标
  1860. var calibResult = _calibrationService.ConvertPixelToPosition((_pixel_x, _pixel_y, _pixel_u), robotCoord, calib, RobotBrand.XYZ_Platform);
  1861. if (!calibResult.IsSucceed)
  1862. {
  1863. return (false, 0, 0, 0, outImage, outGraphicCollection);
  1864. }
  1865. return (true, calibResult.X, calibResult.Y, calibResult.U, outImage, outGraphicCollection);
  1866. }
  1867. SendTaskMessage(Lang.多次拍照失败, MessageLevel.Alarm);
  1868. return (false, 0, 0, 0, outImage, outGraphicCollection);
  1869. }
  1870. catch (Exception ex)
  1871. {
  1872. LogHelper.WriteLogError(Lang.执行相机取图并获取单点位时出错, ex);
  1873. return (false, 0, 0, 0, outImage, outGraphicCollection);
  1874. }
  1875. finally
  1876. {
  1877. await TurnOffLightAfterPhoto(procedure);
  1878. }
  1879. }
  1880. /// <summary>
  1881. /// 从 ToolBlock 的输出集合中根据 Procedure 配置提取需要发送的输出项并做必要的坐标转换。
  1882. /// 返回元组:是否成功、错误信息(失败时)和名称->(是否点位, 值) 的字典。
  1883. /// </summary>
  1884. public (bool IsSucceed, string ErrMsg, Dictionary<string, (bool IsPoint, object Value)> Output) GetVisionOutput(ProcedureModel procedure, CogToolBlockTerminalCollection outputCollection, double[] robotPos)
  1885. {
  1886. RobotBrand robotBrand = RobotBrand.Default;
  1887. var robot = _configService.GetRobot(procedure.RobotId);
  1888. if (robot != null)
  1889. {
  1890. robotBrand = robot.RobotBrand;
  1891. }
  1892. List<string> SendResults = new List<string>();
  1893. Dictionary<string, (bool IsPoint, object Value)> ResultCollection = new Dictionary<string, (bool IsPoint, object Value)>();
  1894. foreach (var output in procedure.ProcedureOutputs)
  1895. {
  1896. //根据输出类型进行区分输出
  1897. if (output.ValueType == typeof(string))
  1898. {
  1899. //需要点位转换时,进行点位提取
  1900. if (output.IsPointTran)
  1901. {
  1902. if (outputCollection[output.Name].Value == null || string.IsNullOrEmpty(outputCollection[output.Name].Value.ToString()))
  1903. {
  1904. //如果需要输出的项的值为空,即点位数据为空,则输出点位的个数为0
  1905. ResultCollection.Add(output.Name, (true, null));
  1906. continue;
  1907. }
  1908. string[] strpoints = outputCollection[output.Name].Value.ToString().Split(';');
  1909. //存储当前输出点位集合
  1910. List<string[]> currentPointsForFeeder = new List<string[]>();
  1911. //获取相机校准
  1912. var calib = _calibrationService.GetCalibration(procedure.CalibrationId);
  1913. if (calib == null)
  1914. {
  1915. SendTaskMessage(Lang.没有相机校准信息, MessageLevel.Alarm);
  1916. return (false, "NotCalibrations", null);
  1917. }
  1918. // 判断相机安装方式,如果是J4移动相机或者XYZ平台时,则需要判断robotPos不能为null
  1919. if ((calib.CameraMount == CameraMount.MobileJ4 || calib.CameraMount == CameraMount.MobileDown_XYPlatform) && robotPos == null)
  1920. {
  1921. SendTaskMessage(Lang.机器人当前位置不能为空, MessageLevel.Alarm);
  1922. return (false, "RobotPositionNull", null);
  1923. }
  1924. List<string> SendDtat = new List<string>();
  1925. List<string> points = new List<string>();
  1926. //遍历所有的输出点位
  1927. foreach (var pos in strpoints)
  1928. {
  1929. //先将pos按照逗号进行分隔,拿到数组,判断是否至少包含3个元素,并且前三个元素可以转换为double,确保是有效的点位数据
  1930. if (string.IsNullOrEmpty(pos))
  1931. {
  1932. continue;
  1933. }
  1934. //先将pos按照逗号进行分隔,拿到数组
  1935. var posParts = pos.Split(',');
  1936. if (posParts.Length < 3 ||
  1937. !double.TryParse(posParts[0], out double _pixel_x) ||
  1938. !double.TryParse(posParts[1], out double _pixel_y) ||
  1939. !double.TryParse(posParts[2], out double _pixel_u))
  1940. {
  1941. SendTaskMessage(string.Format(Lang.点位数据格式错误, pos), MessageLevel.Alarm);
  1942. return (false, "PointDataFormatError", null);
  1943. }
  1944. //转换点位-像素转换成机器人绝对坐标
  1945. var calibResult = _calibrationService.ConvertPixelToPosition((_pixel_x, _pixel_y, _pixel_u), robotPos, calib, robotBrand);
  1946. if (!calibResult.IsSucceed)
  1947. {
  1948. return (false, "CalibrationFailed", null);
  1949. }
  1950. //截取posParts数组从索引3开始到结尾的所有元素,得到新新的数组extraInfoArray
  1951. string[] extraInfoArray = posParts.Skip(3).ToArray();
  1952. //将rpos转换为字符串数组,保留3位小数
  1953. string[] strings = new string[] { $"{calibResult.X:F3}", $"{calibResult.Y:F3}", $"{calibResult.U:F3}" };
  1954. List<string> rposString = new List<string>(strings);
  1955. if (extraInfoArray.Length > 0)
  1956. {
  1957. rposString.AddRange(extraInfoArray);
  1958. }
  1959. currentPointsForFeeder.Add(rposString.ToArray());
  1960. }
  1961. ResultCollection[output.Name] = (true, currentPointsForFeeder);
  1962. }
  1963. //直接输出字符串
  1964. else
  1965. {
  1966. if (outputCollection[output.Name].Value == null || string.IsNullOrEmpty(outputCollection[output.Name].Value.ToString()))
  1967. {
  1968. ResultCollection.Add(output.Name, (false, null));
  1969. continue;
  1970. }
  1971. ResultCollection[output.Name] = (false, outputCollection[output.Name].Value.ToString());
  1972. }
  1973. }
  1974. else
  1975. {
  1976. if (outputCollection[output.Name].Value == null)
  1977. {
  1978. ResultCollection.Add(output.Name, (false, null));
  1979. }
  1980. else
  1981. {
  1982. ResultCollection[output.Name] = (false, outputCollection[output.Name].Value.ToString());
  1983. }
  1984. }
  1985. }
  1986. return (true, string.Empty, ResultCollection);
  1987. }
  1988. /// <summary>
  1989. /// 拍照前针对 Feeder 的准备动作:设置灯、必要时供料或振动等。
  1990. /// </summary>
  1991. public async Task ExecuteFeederForPhotoBefore(IVoiceCoilMotorFeeder Feeder, ProcedureModel procedure, bool doVibrateFirst, bool doCaptureFirst, CancellationToken cancellationToken)
  1992. {
  1993. // 1. 设置Feeder光源亮度、打开光源
  1994. if (Feeder.FeederBrand == FeederBrand.AFAG)
  1995. {
  1996. await Feeder.SetLightValueAsync((ushort)procedure.LightValue);
  1997. }
  1998. else
  1999. {
  2000. //Feeder光源亮度设置
  2001. if (procedure.LightValue > 3)
  2002. {
  2003. var light = await Feeder.GetLightBrightnessAsync();
  2004. if (procedure.LightValue != light)
  2005. {
  2006. await Feeder.SetLightValueAsync((ushort)procedure.LightValue);
  2007. }
  2008. //获取光源的超时时间
  2009. int lightTimeout = await Feeder.GetLightTimeoutAsync();
  2010. if (lightTimeout < 10000)
  2011. {
  2012. await Feeder.SetLightTimeOutAsync(10000);
  2013. }
  2014. //打开光源
  2015. await Feeder.OpenLightAsync();
  2016. }
  2017. }
  2018. if (doCaptureFirst)//如果不振动,等待光源稳定时间
  2019. {
  2020. if (procedure.WaitPhoto > 0) await Task.Delay(procedure.WaitPhoto);
  2021. return;
  2022. }
  2023. //先振后拍时
  2024. if (procedure.VibrationModel == VibrationModel.VibrationPhoto || doVibrateFirst)
  2025. {
  2026. if (procedure.FeederWorks != null && procedure.FeederWorks.FeederWorkList != null)
  2027. {
  2028. bool flog = false;
  2029. //如果上次的Blob面积小于设定的最小值,则触发供料
  2030. if (procedure.LastBlobArea <= procedure.MinArea)
  2031. {
  2032. flog = true;
  2033. SendTaskMessage(Lang.执行料仓供料, MessageLevel.Info);
  2034. await ExecuteFeederStockWorks(Feeder, procedure.FeederStockWorks, cancellationToken);
  2035. if (procedure.WaitFeederStop > 0) await Task.Delay(procedure.WaitFeederStop);
  2036. SendTaskMessage(Lang.料仓供料结束, MessageLevel.Info);
  2037. }
  2038. if (!flog)
  2039. {
  2040. //执行配置的Feeder振动任务
  2041. await ExecuteFeederWorks(Feeder, procedure.FeederWorks, cancellationToken, false);
  2042. if (procedure.WaitFeederStop > 0) await Task.Delay(procedure.WaitFeederStop);
  2043. }
  2044. }
  2045. }
  2046. else
  2047. {
  2048. if (procedure.LightValue > 3)
  2049. {
  2050. if (procedure.WaitPhoto > 0) await Task.Delay(procedure.WaitPhoto);
  2051. }
  2052. //如果上次的Blob面积小于设定的最小值,则触发供料
  2053. if (procedure.LastBlobArea <= procedure.MinArea)
  2054. {
  2055. SendTaskMessage(Lang.执行料仓供料, MessageLevel.Info);
  2056. await ExecuteFeederStockWorks(Feeder, procedure.FeederStockWorks, cancellationToken);
  2057. if (procedure.WaitFeederStop > 0) await Task.Delay(procedure.WaitFeederStop);
  2058. SendTaskMessage(Lang.料仓供料结束, MessageLevel.Info);
  2059. }
  2060. }
  2061. }
  2062. /// <summary>
  2063. /// 拍照后在 NG 情况下的 Feeder 后处理,例如供料或振动。
  2064. /// </summary>
  2065. public async Task ExecuteFeederForPhotoLater(IVoiceCoilMotorFeeder Feeder, ProcedureModel procedure, CancellationToken cancellationToken)
  2066. {
  2067. //根据斑点面积决定是否料仓供料
  2068. if (procedure.LastBlobArea <= procedure.MinArea)
  2069. {
  2070. SendTaskMessage(Lang.执行料仓供料, MessageLevel.Info);
  2071. await ExecuteFeederStockWorks(Feeder, procedure.FeederStockWorks, cancellationToken);
  2072. if (cancellationToken != null && cancellationToken.IsCancellationRequested) return;
  2073. if (procedure.WaitFeederStop > 0) await Task.Delay(procedure.WaitFeederStop, cancellationToken);
  2074. SendTaskMessage(Lang.料仓供料结束, MessageLevel.Info);
  2075. }
  2076. else
  2077. {
  2078. if (procedure.FeederWorks != null && procedure.FeederWorks.FeederWorkList != null)
  2079. {
  2080. SendTaskMessage(Lang.执行Feeder振动, MessageLevel.Info);
  2081. //执行配置的Feeder振动任务
  2082. await ExecuteFeederWorks(Feeder, procedure.FeederWorks, cancellationToken);
  2083. if (cancellationToken != null && cancellationToken.IsCancellationRequested) return;
  2084. if (procedure.WaitFeederStop > 0) await Task.Delay(procedure.WaitFeederStop, cancellationToken);
  2085. SendTaskMessage(Lang.Feeder振动结束, MessageLevel.Info);
  2086. }
  2087. }
  2088. }
  2089. /// <summary>
  2090. /// 并行执行料仓供料和振动任务。
  2091. /// </summary>
  2092. public async Task ExecuteFeederStockWorks(IVoiceCoilMotorFeeder feeder, FeederStockWorks works, CancellationToken cancellationToken, bool isUpdateParame = true)
  2093. {
  2094. //同时执行料仓供料和Feeder振动任务
  2095. var stockTask = ExecuteFeederStockWorksOnly(feeder, works.FeederStockWorkList.ToArray(), cancellationToken);
  2096. var vibrationTask = ExecuteFeederWorkOnly(feeder, works.FeederWorkList.ToArray(), cancellationToken);
  2097. await Task.WhenAll(stockTask, vibrationTask);
  2098. }
  2099. /// <summary>
  2100. /// 执行料仓振动任务序列(仅料仓相关动作)。
  2101. /// </summary>
  2102. public async Task ExecuteFeederStockWorksOnly(IVoiceCoilMotorFeeder feeder, FeederStockWork[] works, CancellationToken cancellationToken)
  2103. {
  2104. //执行配置的料仓振动任务
  2105. if (feeder.FeederBrand == FeederBrand.AFAG)
  2106. {
  2107. foreach (var stockwork in works)
  2108. {
  2109. if (stockwork.RegisterIndex == 0)
  2110. {
  2111. if (stockwork.Duration > 0) await Task.Delay(stockwork.Duration, cancellationToken);
  2112. }
  2113. else if (stockwork.RegisterIndex == 1)
  2114. {
  2115. // 保留原注释的位置给 Modbus 操作
  2116. }
  2117. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  2118. {
  2119. return;
  2120. }
  2121. }
  2122. }
  2123. else
  2124. {
  2125. foreach (var stockwork in works)
  2126. {
  2127. if (stockwork.Function == VibrationFunction.Delay)
  2128. {
  2129. if (stockwork.Duration > 0) await Task.Delay(stockwork.Duration, cancellationToken);
  2130. }
  2131. else
  2132. {
  2133. await feeder.OutputAsync(((int)stockwork.Function) + 1, stockwork.Duration);
  2134. if (stockwork.Duration > 0) await Task.Delay(stockwork.Duration, cancellationToken);
  2135. }
  2136. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  2137. {
  2138. return;
  2139. }
  2140. }
  2141. }
  2142. }
  2143. /// <summary>
  2144. /// 执行单独的 Feeder 振动动作序列(仅振动相关)。
  2145. /// </summary>
  2146. public async Task ExecuteFeederWorkOnly(IVoiceCoilMotorFeeder feeder, FeederWork[] works, CancellationToken cancellationToken, bool isUpdateParame = true)
  2147. {
  2148. if (works == null)
  2149. {
  2150. return;
  2151. }
  2152. if (feeder.FeederBrand == FeederBrand.AFAG)
  2153. {
  2154. //执行配置的Feeder振动任务
  2155. foreach (var feederwork in works)
  2156. {
  2157. if (feederwork.ConfigIndex < 0)
  2158. {
  2159. continue;
  2160. }
  2161. if (feederwork.ConfigIndex == 0)
  2162. {
  2163. if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken);
  2164. }
  2165. else
  2166. {
  2167. ((AfagFeeder)feeder).LoadConfiguration(feederwork.ConfigIndex);
  2168. ((AfagFeeder)feeder).SetIntensity(feederwork.Intensity);
  2169. ((AfagFeeder)feeder).SetDirection(feederwork.Direction);
  2170. if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken);
  2171. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  2172. {
  2173. return;
  2174. }
  2175. ((AfagFeeder)feeder).SetIntensity(0);
  2176. }
  2177. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  2178. {
  2179. return;
  2180. }
  2181. }
  2182. }
  2183. else
  2184. {
  2185. //执行配置的Feeder振动任务
  2186. foreach (var feederwork in works)
  2187. {
  2188. if (feederwork.Function == VibrationFunction.Delay)
  2189. {
  2190. if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken);
  2191. }
  2192. else
  2193. {
  2194. if (feederwork.SingleAction != null && isUpdateParame)
  2195. {
  2196. await feeder.SetShakeParametersAsync((int)feederwork.Function, feederwork.SingleAction);
  2197. }
  2198. await feeder.StartAction((int)feederwork.Function, feederwork.Duration);
  2199. if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken);
  2200. }
  2201. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  2202. {
  2203. return;
  2204. }
  2205. }
  2206. }
  2207. }
  2208. /// <summary>
  2209. /// 执行 Feeder 振动集合(逐个执行 FeederWorkList 中的动作)。
  2210. /// </summary>
  2211. public async Task ExecuteFeederWorks(IVoiceCoilMotorFeeder feeder, FeederWorks works, CancellationToken cancellationToken, bool isUpdateParame = true)
  2212. {
  2213. if (feeder.FeederBrand == FeederBrand.AFAG)
  2214. {
  2215. foreach (var feederwork in works.FeederWorkList)
  2216. {
  2217. if (feederwork.ConfigIndex < 0)
  2218. {
  2219. continue;
  2220. }
  2221. if (feederwork.ConfigIndex == 0)
  2222. {
  2223. await Task.Delay(feederwork.Duration, cancellationToken);
  2224. }
  2225. else
  2226. {
  2227. ((AfagFeeder)feeder).LoadConfiguration(feederwork.ConfigIndex);
  2228. ((AfagFeeder)feeder).SetIntensity(feederwork.Intensity);
  2229. ((AfagFeeder)feeder).SetDirection(feederwork.Direction);
  2230. await Task.Delay(feederwork.Duration, cancellationToken);
  2231. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  2232. {
  2233. return;
  2234. }
  2235. ((AfagFeeder)feeder).SetIntensity(0);
  2236. }
  2237. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  2238. {
  2239. return;
  2240. }
  2241. }
  2242. }
  2243. else
  2244. {
  2245. foreach (var feederwork in works.FeederWorkList)
  2246. {
  2247. if (feederwork.Function == VibrationFunction.Delay)
  2248. {
  2249. if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken);
  2250. }
  2251. else
  2252. {
  2253. if (feederwork.SingleAction != null && isUpdateParame)
  2254. {
  2255. await feeder.SetShakeParametersAsync((int)feederwork.Function, feederwork.SingleAction);
  2256. }
  2257. await feeder.StartAction((int)feederwork.Function, feederwork.Duration);
  2258. if (feederwork.Duration > 0) await Task.Delay(feederwork.Duration, cancellationToken);
  2259. }
  2260. if (cancellationToken != null && cancellationToken.IsCancellationRequested)
  2261. {
  2262. return;
  2263. }
  2264. }
  2265. }
  2266. }
  2267. /// <summary>
  2268. /// 在拍照前设置光源亮度和打开光源
  2269. /// </summary>
  2270. /// <param name="procedure">流程模型</param>
  2271. /// <returns></returns>
  2272. public async Task SetLightBeforePhoto(ProcedureModel procedure)
  2273. {
  2274. //判断当前流程是否启用光源控制
  2275. if (procedure.IsControlLightChannels)
  2276. {
  2277. //打开所有需要控制的光源通道
  2278. foreach (var lightChannel in procedure.LightChannels)
  2279. {
  2280. bool isSucceed = false;
  2281. isSucceed = await _lightManagerService.TurnOnGlobalChannelAsync(lightChannel.GlobalIndex);
  2282. if (!isSucceed)
  2283. {
  2284. LogHelper.WriteLogInfo(string.Format(Lang.设置光源通道0打开失败, lightChannel.GlobalIndex));
  2285. //"设置光源通道{lightChannel.GlobalIndex}打开失败!");
  2286. }
  2287. isSucceed = await _lightManagerService.SetGlobalChannelBrightnessAsync(lightChannel.GlobalIndex, lightChannel.DefaultBrightness);
  2288. if (!isSucceed)
  2289. {
  2290. LogHelper.WriteLogInfo(string.Format(Lang.设置光源通道0亮度1失败, lightChannel.GlobalIndex, lightChannel.DefaultBrightness));
  2291. }
  2292. }
  2293. if (procedure.LightChannels.Count > 0)
  2294. {
  2295. await Task.Delay(50);
  2296. }
  2297. }
  2298. }
  2299. /// <summary>
  2300. /// 在拍照后关闭光源
  2301. /// </summary>
  2302. /// <param name="procedure">流程模型</param>
  2303. /// <returns></returns>
  2304. public async Task TurnOffLightAfterPhoto(ProcedureModel procedure)
  2305. {
  2306. //判断当前流程是否启用光源控制
  2307. if (procedure.IsControlLightChannels)
  2308. {
  2309. //关闭所有需要控制的光源通道
  2310. foreach (var lightChannel in procedure.LightChannels)
  2311. {
  2312. bool isSucceed = false;
  2313. isSucceed = await _lightManagerService.TurnOffGlobalChannelAsync(lightChannel.GlobalIndex);
  2314. if (!isSucceed)
  2315. {
  2316. LogHelper.WriteLogInfo(string.Format(Lang.设置光源通道0关闭失败, lightChannel.GlobalIndex));
  2317. }
  2318. }
  2319. }
  2320. }
  2321. #endregion
  2322. }
  2323. }