Management.cs 125 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525
  1. using Basler.Pylon;
  2. using Cognex.VisionPro;
  3. using Cognex.VisionPro.ToolBlock;
  4. using CSScripting;
  5. using iTextSharp.testutils;
  6. using MathNet.Numerics.Distributions;
  7. using MathNet.Numerics.LinearAlgebra;
  8. using MathNet.Numerics.RootFinding;
  9. using NPOI.SS.Formula.Functions;
  10. using NPOI.Util;
  11. using Opc.Ua;
  12. using OpenCvSharp;
  13. using OpenCvSharp.Flann;
  14. using Prism.Events;
  15. using Prism.Ioc;
  16. using Prism.Mvvm;
  17. using Prism.Regions;
  18. using Prism.Services.Dialogs;
  19. using System;
  20. using System.Collections;
  21. using System.Collections.Generic;
  22. using System.Collections.ObjectModel;
  23. using System.ComponentModel;
  24. using System.Drawing;
  25. using System.IO;
  26. using System.Linq;
  27. using System.Net.Sockets;
  28. using System.Reflection.Metadata;
  29. using System.Security.Cryptography;
  30. using System.Text;
  31. using System.Threading;
  32. using System.Threading.Tasks;
  33. using System.Windows;
  34. using System.Windows.Documents;
  35. using System.Windows.Interop;
  36. using System.Windows.Media;
  37. using System.Windows.Media.Media3D;
  38. using Team.FFFeederService;
  39. using Team.FFFeederService.Interfaces;
  40. using TeamAAS_VP;
  41. using TeamAAS_VP.Core.PLCs;
  42. using TeamAAS_VP.Core.Robots;
  43. using TeamAAS_VP.Core.ScrewDriver;
  44. using TeamAAS_VP.Data;
  45. using TeamAAS_VP.Enums;
  46. using TeamAAS_VP.Events;
  47. using TeamAAS_VP.Interfaces;
  48. using TeamAAS_VP.Models;
  49. using TeamAAS_VP.Models.Calibration;
  50. using TeamAAS_VP.Models.Feeder;
  51. using TeamAAS_VP.Models.Product;
  52. using TeamAAS_VP.Resources.Languages;
  53. using TeamAAS_VP.Services;
  54. using TeamAAS_VP.ViewModels.Home;
  55. using TouchSocket.Core;
  56. using TouchSocket.Sockets;
  57. using static MaterialDesignThemes.Wpf.Theme.ToolBar;
  58. using static Org.BouncyCastle.Math.EC.ECCurve;
  59. using static System.Windows.Forms.AxHost;
  60. namespace TeamAAS_VP.Core
  61. {
  62. public class Management : BindableBase
  63. {
  64. #region 字段
  65. IRegionManager _regionManager;
  66. IEventAggregator _eventAggregator;
  67. IContainerProvider _container;
  68. IConfigService _configService;
  69. IRobotService _robotService;
  70. ICameraService _cameraService;
  71. IFeederService _feederService;
  72. IPlcService _plcService;
  73. ILightManagerService _lightManagerService;
  74. IProductService _productService;
  75. ICalibrationService _calibrationService;
  76. IRemoteCommandService _remoteCommandService;
  77. ISystemDatabaseService _systemDatabaseService;
  78. IMesService _mesService;
  79. Timer yieldtimer;
  80. private DateTime StartTime = DateTime.Now;
  81. // Pressure collection
  82. /// <summary>
  83. /// 压力采集信号控制CTS
  84. /// </summary>
  85. private CancellationTokenSource[] _pressureCts = new CancellationTokenSource[10];
  86. /// <summary>
  87. /// 压力采集超时CTS
  88. /// </summary>
  89. private CancellationTokenSource[] _pressureTimeoutCts = new CancellationTokenSource[10];
  90. /// <summary>
  91. /// 压力采集CTS
  92. /// </summary>
  93. private CancellationTokenSource[] _pressureLinkedCts = new CancellationTokenSource[10];
  94. /// <summary>
  95. /// 压力数据集合
  96. /// </summary>
  97. private List<(DateTime Timestamp, float Value)>[] _pressureSamples = new List<(DateTime, float)>[10];
  98. /// <summary>
  99. /// 采样间隔毫秒
  100. /// </summary>
  101. private int _pressureSampleIntervalMs = 50; //采样间隔毫秒
  102. /// <summary>
  103. /// 超时自动停止秒数
  104. /// </summary>
  105. private int _pressureMaxDurationSeconds = 30; //超时自动停止秒数
  106. #endregion
  107. #region 属性
  108. private ObservableCollection<ShowRender> _Renders;
  109. /// <summary>
  110. /// 显示界面
  111. /// </summary>
  112. public ObservableCollection<ShowRender> Renders
  113. {
  114. get { return _Renders; }
  115. set { SetProperty(ref _Renders, value); }
  116. }
  117. public BgCommunicate BgCommunicate { get; private set; }
  118. public BgModbusTcpCommunicate BgModbusTcpCommunicate { get; private set; }
  119. private ObservableCollection<StatusInfo> _Status = new ObservableCollection<StatusInfo>();
  120. /// <summary>
  121. /// 状态栏集合
  122. /// </summary>
  123. public ObservableCollection<StatusInfo> Status
  124. {
  125. get { return _Status; }
  126. set { SetProperty(ref _Status, value); }
  127. }
  128. private Int64 _TotalQuantity;
  129. /// <summary>
  130. /// 总产量
  131. /// </summary>
  132. public Int64 TotalQuantity
  133. {
  134. get { return _TotalQuantity; }
  135. set { SetProperty(ref _TotalQuantity, value); }
  136. }
  137. private Int64 _TotalQuantityToday;
  138. /// <summary>
  139. /// 当天的总产量
  140. /// </summary>
  141. public Int64 TotalQuantityToday
  142. {
  143. get { return _TotalQuantityToday; }
  144. set { SetProperty(ref _TotalQuantityToday, value); }
  145. }
  146. private Int64 _CurrentUPH;
  147. /// <summary>
  148. /// 当前的UPH
  149. /// </summary>
  150. public Int64 CurrentUPH
  151. {
  152. get { return _CurrentUPH; }
  153. set { SetProperty(ref _CurrentUPH, value); }
  154. }
  155. private XYD_ScrewDriver _ScrewDriver;
  156. public XYD_ScrewDriver ScrewDriver
  157. {
  158. get { return _ScrewDriver; }
  159. set { SetProperty(ref _ScrewDriver, value); }
  160. }
  161. public Dictionary<string, object> BackupObject { get; set; } = new Dictionary<string, object>();
  162. private double _CTtime;
  163. /// <summary>
  164. /// ct
  165. /// </summary>
  166. public double CTtime
  167. {
  168. get { return _CTtime; }
  169. set { SetProperty(ref _CTtime, value); }
  170. }
  171. #endregion
  172. #region 命令
  173. #endregion
  174. #region 事件
  175. #endregion
  176. public Management(IRegionManager regionManager, IEventAggregator ea, IContainerProvider container, IConfigService configService,
  177. IRobotService robotService, ICameraService cameraService, IFeederService feederService, IPlcService plcService, IProductService productService,
  178. ICalibrationService calibrationService, IRemoteCommandService remoteCommandService, ISystemDatabaseService systemDatabaseService, ILightManagerService lightManagerService,
  179. IMesService mesService)
  180. {
  181. _regionManager = regionManager;
  182. _eventAggregator = ea;
  183. _container = container;
  184. _configService = configService;
  185. _robotService = robotService;
  186. _cameraService = cameraService;
  187. _feederService = feederService;
  188. _plcService = plcService;
  189. _calibrationService = calibrationService;
  190. yieldtimer = new Timer(DoYieldTime, null, 10000, 1000);
  191. Renders = new ObservableCollection<ShowRender>();
  192. _configService = configService;
  193. _productService = productService;
  194. _remoteCommandService = remoteCommandService;
  195. _systemDatabaseService = systemDatabaseService;
  196. _lightManagerService = lightManagerService;
  197. _mesService = mesService;
  198. }
  199. #region 初始化硬件模块
  200. /// <summary>
  201. /// 初始化Feeder
  202. /// </summary>
  203. /// <returns></returns>
  204. public async Task<(bool IsSucceed, string Msg)> InitFeeders()
  205. {
  206. var feeders = _configService.GetAllFeeders();
  207. StringBuilder sb = new StringBuilder();
  208. foreach (var item in feeders)
  209. {
  210. _feederService.CreateFeeder(item.Id, item.FeederNo, item.FeederName, item.IP, item.Port, item.FeederBrand);
  211. var feeder = _feederService.GetFeeder(item.Id);
  212. Status.Add(new StatusInfo(item.Id, item.FeederName + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
  213. try
  214. {
  215. feeder.FeederConnectionStatusChanged += Management_FeederConnectionStatusChanged;
  216. await feeder.ConnectAsync(); //连接Feeder
  217. //SendTaskMessage($"{item.FeederName}已连接!", MessageLevel.Debug);
  218. }
  219. catch (Exception ex)
  220. {
  221. sb.AppendLine($"{item.FeederName}:{Lang.断开连接}![{ex.Message}]");
  222. SendTaskMessage($"{item.FeederName}{Lang.断开连接}!", MessageLevel.Alarm);
  223. }
  224. }
  225. if (sb.Length == 0)
  226. {
  227. return (true, "");
  228. }
  229. else
  230. {
  231. return (false, sb.ToString());
  232. }
  233. }
  234. /// <summary>
  235. /// 初始化机器人
  236. /// </summary>
  237. /// <returns></returns>
  238. public async Task<(bool IsSucceed, string Msg)> InitRobots()
  239. {
  240. var robots = _configService.GetAllRobots();
  241. StringBuilder sb = new StringBuilder();
  242. foreach (var item in robots)
  243. {
  244. _robotService.CreateRobot(item.Id, item);
  245. try
  246. {
  247. Status.Add(new StatusInfo(item.Id, item.RobotName + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
  248. var robot = _robotService.GetRobot(item.Id);
  249. robot.ReceivedEvent += Management_ReceivedEvent;
  250. robot.SendEvent += Management_SendEvent;
  251. robot.ConnectedEvent += Management_ConnectedEvent;
  252. robot.DisconnectedEvent += Management_DisconnectedEvent;
  253. await robot.ConnectAsync(); //连接Robot
  254. SendTaskMessage($"{item.RobotName}{Lang.已连接}!", MessageLevel.Debug);
  255. }
  256. catch (Exception ex)
  257. {
  258. sb.AppendLine($"{item.RobotName}:{Lang.断开连接}![{ex.Message}]");
  259. SendTaskMessage($"{item.RobotName}{Lang.断开连接}!", MessageLevel.Alarm);
  260. }
  261. }
  262. if (sb.Length == 0)
  263. {
  264. return (true, "");
  265. }
  266. else
  267. {
  268. return (false, sb.ToString());
  269. }
  270. }
  271. /// <summary>
  272. /// 初始化PLC
  273. /// </summary>
  274. /// <returns></returns>
  275. public async Task<(bool IsSucceed, string Msg)> InitPlc()
  276. {
  277. var plcs = _configService.GetAllPlcs();
  278. StringBuilder sb = new StringBuilder();
  279. foreach (var item in plcs)
  280. {
  281. try
  282. {
  283. _plcService.CreatePlc(item.Id, item);
  284. var plc = _plcService.GetPlc(item.Id);
  285. Status.Add(new StatusInfo(item.Id, item.Name + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
  286. plc.ConnectChangedEvent += Management_PlcConnectChangedEvent;
  287. await plc.ConnectAsync(); //连接PLC
  288. //SendTaskMessage($"{item.Name}{Lang.已连接}!", MessageLevel.Debug);
  289. }
  290. catch (Exception ex)
  291. {
  292. sb.AppendLine($"{item.Name}:{Lang.断开连接}![{ex.Message}]");
  293. SendTaskMessage($"{item.Name}{Lang.断开连接}!", MessageLevel.Alarm);
  294. }
  295. }
  296. try
  297. {
  298. await WriteSystemParameterToPlcAsync(_configService.GetSystemConfiguration());
  299. RegisterPlcMonitorAddress();
  300. }
  301. catch (Exception ex)
  302. {
  303. LogHelper.WriteLogError("为PLC写入系统参数和订阅变量时出错", ex);
  304. }
  305. if (sb.Length == 0)
  306. {
  307. return (true, "");
  308. }
  309. else
  310. {
  311. return (false, sb.ToString());
  312. }
  313. }
  314. /// <summary>
  315. /// 初始化相机
  316. /// </summary>
  317. /// <returns></returns>
  318. public async Task<(bool IsSucceed, string Msg)> InitCameras()
  319. {
  320. var cameras = _configService.GetAllCameras();
  321. StringBuilder sb = new StringBuilder();
  322. foreach (var item in cameras)
  323. {
  324. try
  325. {
  326. Renders.Add(new ShowRender() { Id = item.Id, CameraName = item.CameraName });
  327. _cameraService.CreateCamera(item.Id, item);
  328. var camera = _cameraService.GetCamera(item.Id);
  329. Status.Add(new StatusInfo(item.Id, item.CameraName + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
  330. camera.CameraConnectChangedEvent += Management_CameraConnectChangedEvent;
  331. try
  332. {
  333. if (await camera.OpenDeviceAsync())
  334. {
  335. SendTaskMessage($"{item.CameraName}{Lang.已连接}!", MessageLevel.Debug);
  336. }
  337. else
  338. {
  339. SendTaskMessage($"{item.CameraName}{Lang.连接失败}!", MessageLevel.Alarm);
  340. sb.AppendLine($"{item.CameraName}:{Lang.连接失败}!");
  341. }
  342. }
  343. catch (Exception ex)
  344. {
  345. SendTaskMessage($"{item.CameraName}{ex.Message}!", MessageLevel.Alarm);
  346. sb.AppendLine($"{item.CameraName}:{ex.Message}!");
  347. }
  348. }
  349. catch (Exception ex)
  350. {
  351. SendTaskMessage($"{item.CameraName}{Lang.连接失败}!", MessageLevel.Alarm);
  352. sb.AppendLine($"{item.CameraName}:{Lang.连接失败}!:{ex.Message}");
  353. }
  354. }
  355. _container.Resolve<ShowVisionRenderViewModel>().Renders = Renders;
  356. if (sb.Length == 0)
  357. {
  358. return (true, "");
  359. }
  360. else
  361. {
  362. return (false, sb.ToString());
  363. }
  364. }
  365. /// <summary>
  366. /// 初始化光源控制器
  367. /// </summary>
  368. /// <returns></returns>
  369. public async Task<(bool IsSucceed, string Msg)> InitLightControllers()
  370. {
  371. var lightcontrollers = _configService.GetAllLightControllers();
  372. StringBuilder sb = new StringBuilder();
  373. foreach (var item in lightcontrollers)
  374. {
  375. try
  376. {
  377. var lishtCtr = await _lightManagerService.RegisterControllerAsync(item.Id, item);
  378. //var lightcontroller = _cameraService.GetLightController(item.Id);
  379. //await lightcontroller.ConnectAsync(); //连接光源控制器
  380. //SendTaskMessage($"{item.LightControllerName}{Lang.已连接}!", MessageLevel.Debug);
  381. }
  382. catch (Exception ex)
  383. {
  384. //sb.AppendLine($"{item.LightControllerName}:{Lang.断开连接}![{ex.Message}]");
  385. //SendTaskMessage($"{item.LightControllerName}{Lang.断开连接}!", MessageLevel.Alarm);
  386. }
  387. }
  388. if (lightcontrollers.Count > 0)
  389. {
  390. var result = await _lightManagerService.ConnectAllAsync();
  391. if (result)
  392. {
  393. return (true, "");
  394. }
  395. else
  396. {
  397. return (false, "Light Controller Connect Failed!");
  398. }
  399. }
  400. return (true, "");
  401. //if (sb.Length == 0)
  402. //{
  403. // return (true, "");
  404. //}
  405. //else
  406. //{
  407. // return (false, sb.ToString());
  408. //}
  409. }
  410. /// <summary>
  411. /// 初始化后台TCP服务器通讯
  412. /// </summary>
  413. public void InitBgTcp()
  414. {
  415. var config = _configService.GetBgTcp();
  416. try
  417. {
  418. BgCommunicate = new BgCommunicate(config);
  419. BgCommunicate.ConnectedEvent += BgCommunicate_ConnectedEvent;
  420. BgCommunicate.DisconnectedEvent += BgCommunicate_DisconnectedEvent;
  421. BgCommunicate.ReceivedEvent += BgCommunicate_ReceivedEvent;
  422. BgCommunicate.SendEvent += BgCommunicate_SendEvent;
  423. BgCommunicate.StartListening();
  424. SendTaskMessage($"{Lang.已开启监听端口}:{config.Port}", MessageLevel.Debug);
  425. }
  426. catch (Exception ex)
  427. {
  428. SendTaskMessage($"{Lang.未开启监听端口}:{config.Port}", MessageLevel.Error);
  429. LogHelper.WriteLogError("开启后台服务器通讯时出错!", ex);
  430. }
  431. }
  432. /// <summary>
  433. /// 初始化后台ModbusTCP从站
  434. /// </summary>
  435. public void InitModbusTcp()
  436. {
  437. try
  438. {
  439. var config = _configService.GetBgModbusTcp();
  440. BgModbusTcpCommunicate = new BgModbusTcpCommunicate(config);
  441. if (config.IsEnabled)
  442. {
  443. BgModbusTcpCommunicate.Listen();
  444. SendTaskMessage($"Start Modbus Tcp Slave:{BgModbusTcpCommunicate.IP}:{BgModbusTcpCommunicate.Port}:{BgModbusTcpCommunicate.SlaveID}", MessageLevel.Debug);
  445. }
  446. }
  447. catch (Exception ex)
  448. {
  449. SendTaskMessage($"No Start Modbus Tcp Slave:{ex.Message}", MessageLevel.Alarm);
  450. LogHelper.WriteLogError("开启后台Modbus TCP通讯时出错!", ex);
  451. }
  452. }
  453. /// <summary>
  454. /// 初始化后台脚本
  455. /// </summary>
  456. public void InitBackgroundcript()
  457. {
  458. try
  459. {
  460. if (!Directory.Exists(FilePath.BackgroundScriptPath))
  461. {
  462. Directory.CreateDirectory(FilePath.BackgroundScriptPath);
  463. }
  464. try
  465. {
  466. string[] files = Directory.GetFiles(FilePath.BackgroundScriptPath);
  467. List<string> ScriptFilesCollection = new List<string>();
  468. foreach (string file in files)
  469. {
  470. string fileName = Path.GetFileName(file);
  471. string fileExtension = Path.GetExtension(file);
  472. if (fileExtension == ".cs")
  473. {
  474. ScriptFilesCollection.Add(file);
  475. }
  476. }
  477. foreach (var item in ScriptFilesCollection)
  478. {
  479. try
  480. {
  481. string script = FileHelper.ReadFile(item);
  482. SendTaskMessage($"{Lang.执行脚本}:{item}", MessageLevel.Info);
  483. Task.Factory.StartNew(() =>
  484. {
  485. ScriptHelper.ExecuteScriptingAsync(script, _regionManager, _eventAggregator, _container, rst =>
  486. {
  487. if (!rst.Item1)
  488. {
  489. foreach (var err in rst.Item2)
  490. {
  491. SendTaskMessage($"{Lang.后台脚本出错}:{err}", MessageLevel.Error);
  492. }
  493. }
  494. });
  495. });
  496. }
  497. catch (Exception ex)
  498. {
  499. LogHelper.WriteLogError($"开启脚本时出错:{item}", ex);
  500. }
  501. }
  502. }
  503. catch (Exception ex)
  504. {
  505. LogHelper.WriteLogError("读取本地脚本文件列表时出错", ex);
  506. }
  507. }
  508. catch (Exception ex)
  509. {
  510. LogHelper.WriteLogError("开启后台脚本时出错!", ex);
  511. }
  512. }
  513. /// <summary>
  514. /// 初始化电批
  515. /// </summary>
  516. /// <returns></returns>
  517. public async Task InitScrewDriver()
  518. {
  519. try
  520. {
  521. var screwDriverConfig = _configService.GetScrewDriverConfig();
  522. ScrewDriver = new XYD_ScrewDriver(screwDriverConfig.IPAdress, screwDriverConfig.Port);
  523. Status.Add(new StatusInfo(ScrewDriver.Id, "电批未连接", new SolidColorBrush(Colors.Red)));
  524. ScrewDriver.ConnectStateChangedEvent += ScrewDriver_ConnectStateChangedEvent;
  525. ScrewDriver.SendTimeout = screwDriverConfig.SendTimeout;
  526. screwDriverConfig.ReceiveTimeout = screwDriverConfig.ReceiveTimeout;
  527. var isConnected = await ScrewDriver.ConnectAsync();
  528. if (isConnected)
  529. {
  530. SendTaskMessage($"电批已连接", MessageLevel.Debug);
  531. }
  532. else
  533. {
  534. SendTaskMessage($"电批连接失败", MessageLevel.Error);
  535. }
  536. }
  537. catch (Exception ex)
  538. {
  539. SendTaskMessage($"电批连接失败:{ex.Message}", MessageLevel.Alarm);
  540. LogHelper.WriteLogError("连接电批时出错!", ex);
  541. }
  542. }
  543. #endregion
  544. #region 机器人指令执行
  545. public Dictionary<Guid, CancellationTokenSource> RobotTCPCollection = new Dictionary<Guid, CancellationTokenSource>();
  546. /// <summary>
  547. /// 机器人TCP接收
  548. /// </summary>
  549. /// <param name="arg1"></param>
  550. /// <param name="arg2"></param>
  551. /// <param name="arg3"></param>
  552. private async void Management_ReceivedEvent(Guid robotid, object arg2, TouchSocket.Sockets.ReceivedDataEventArgs e)
  553. {
  554. try
  555. {
  556. if (!RobotTCPCollection.ContainsKey(robotid))
  557. RobotTCPCollection.Add(robotid, new CancellationTokenSource());
  558. else
  559. {
  560. if (RobotTCPCollection[robotid].IsCancellationRequested)
  561. {
  562. RobotTCPCollection[robotid] = new CancellationTokenSource();
  563. }
  564. }
  565. var robot = await _robotService.GetRobotAsync(robotid);
  566. //从服务器收到信息。但是一般byteBlock和requestInfo会根据适配器呈现不同的值。
  567. var buffer = e.ByteBlock.Span.ToString(robot.GetEncoding());
  568. SendTaskMessage($"{robot.Name}Received:{buffer}", MessageLevel.Info);
  569. var _ = _remoteCommandService.ExecuteAsync(buffer, RobotTCPCollection[robotid].Token, async msg =>
  570. {
  571. try
  572. {
  573. if (robot.ConnectType == TCPConnectType.Client)
  574. {
  575. if (robot.IsConnected)
  576. {
  577. await robot.SendAsync($"{msg}");
  578. }
  579. }
  580. else
  581. {
  582. var cient = (ITcpSessionClient)arg2;
  583. if (cient.Online)
  584. {
  585. await robot.SendAsync(cient, $"{msg}");
  586. }
  587. }
  588. }
  589. catch (Exception ex)
  590. {
  591. LogHelper.WriteLogError("TCP发送数据时出错!", ex);
  592. SendTaskMessage(ex.Message, MessageLevel.Alarm);
  593. }
  594. });
  595. }
  596. catch (Exception ex)
  597. {
  598. LogHelper.WriteLogError("处理机器人接收的命令时出错!", ex);
  599. SendTaskMessage(ex.Message, MessageLevel.Alarm);
  600. }
  601. }
  602. #endregion
  603. #region 机器人&Feeder&相机连接状态事件
  604. /// <summary>
  605. /// 机器人发送事件
  606. /// </summary>
  607. /// <param name="arg1"></param>
  608. /// <param name="arg2"></param>
  609. /// <param name="arg3"></param>
  610. /// <exception cref="NotImplementedException"></exception>
  611. private void Management_SendEvent(Guid robotid, object arg2, string arg3)
  612. {
  613. var r = _robotService.GetRobot(robotid);
  614. SendTaskMessage($"{r.Name}Send:{arg3}", MessageLevel.Info);
  615. }
  616. /// <summary>
  617. /// 机器人断开连接时
  618. /// </summary>
  619. /// <param name="arg1"></param>
  620. /// <param name="arg2"></param>
  621. /// <param name="arg3"></param>
  622. /// <exception cref="NotImplementedException"></exception>
  623. private void Management_DisconnectedEvent(Guid robotid, object arg2, ClosedEventArgs arg3)
  624. {
  625. if (RobotTCPCollection.ContainsKey(robotid))
  626. {
  627. RobotTCPCollection[robotid].Cancel();
  628. }
  629. var r = _configService.GetRobot(robotid);
  630. if (r.ConnectType == TCPConnectType.Server)
  631. {
  632. ITcpSessionClient socketClient = arg2 as ITcpSessionClient;
  633. SendTaskMessage($"{r.RobotName}[{socketClient.Id}:{socketClient.IP}]{Lang.断开连接}!", MessageLevel.Error);
  634. var robot = _robotService.GetRobot(robotid);
  635. if (robot.TcpService.Count < 1)
  636. {
  637. var sta = Status.FirstOrDefault(s => s.ID == robotid);
  638. App.Current.Dispatcher.Invoke(new
  639. Action(() =>
  640. {
  641. sta.Message = $"{r.RobotName}{Lang.未连接}";
  642. sta.Background = new SolidColorBrush(Colors.Red);
  643. }));
  644. }
  645. }
  646. else
  647. {
  648. SendTaskMessage($"{r.RobotName}{Lang.断开连接}!", MessageLevel.Error);
  649. var sta = Status.FirstOrDefault(s => s.ID == robotid);
  650. App.Current.Dispatcher.Invoke(new
  651. Action(() =>
  652. {
  653. sta.Message = $"{r.RobotName}{Lang.断开连接}";
  654. sta.Background = new SolidColorBrush(Colors.Red);
  655. }));
  656. }
  657. }
  658. /// <summary>
  659. /// 机器人连接成功时
  660. /// </summary>
  661. /// <param name="arg1"></param>
  662. /// <param name="arg2"></param>
  663. /// <param name="arg3"></param>
  664. /// <exception cref="NotImplementedException"></exception>
  665. private void Management_ConnectedEvent(Guid robotid, object arg2, ConnectedEventArgs arg3)
  666. {
  667. var r = _configService.GetRobot(robotid);
  668. if (r.ConnectType == TCPConnectType.Server)
  669. {
  670. ITcpSessionClient socketClient = arg2 as ITcpSessionClient;
  671. SendTaskMessage($"{r.RobotName}[{socketClient.Id}:{socketClient.IP}]{Lang.已连接}!", MessageLevel.Debug);
  672. var robot = _robotService.GetRobot(robotid);
  673. if (robot.TcpService.Count > 0)
  674. {
  675. var sta = Status.FirstOrDefault(s => s.ID == robotid);
  676. App.Current.Dispatcher.Invoke(new
  677. Action(() =>
  678. {
  679. sta.Message = $"{r.RobotName}{Lang.已连接}";
  680. sta.Background = new SolidColorBrush(Colors.Green);
  681. }));
  682. }
  683. }
  684. else
  685. {
  686. SendTaskMessage($"{r.RobotName}{Lang.已连接}!", MessageLevel.Debug);
  687. var sta = Status.FirstOrDefault(s => s.ID == robotid);
  688. App.Current.Dispatcher.Invoke(new
  689. Action(() =>
  690. {
  691. sta.Message = $"{r.RobotName}{Lang.已连接}";
  692. sta.Background = new SolidColorBrush(Colors.Green);
  693. }));
  694. }
  695. }
  696. /// <summary>
  697. /// Feeder连接状态改变时
  698. /// </summary>
  699. /// <param name="sender"></param>
  700. /// <param name="state"></param>
  701. private void Management_FeederConnectionStatusChanged(object sender, bool state)
  702. {
  703. IFeeder feeder = sender as IFeeder;
  704. var sta = Status.FirstOrDefault(s => s.ID == feeder.Id);
  705. if (state)
  706. {
  707. App.Current.Dispatcher.Invoke(new
  708. Action(() =>
  709. {
  710. sta.Message = $"{feeder.Name}{Lang.已连接}";
  711. sta.Background = new SolidColorBrush(Colors.Green);
  712. }));
  713. SendTaskMessage($"{feeder.Name}{Lang.已连接}!", MessageLevel.Debug);
  714. }
  715. else
  716. {
  717. App.Current.Dispatcher.Invoke(new
  718. Action(() =>
  719. {
  720. sta.Message = $"{feeder.Name}{Lang.未连接}";
  721. sta.Background = new SolidColorBrush(Colors.Red);
  722. }));
  723. SendTaskMessage($"{feeder.Name}{Lang.断开连接}!", MessageLevel.Error);
  724. }
  725. }
  726. /// <summary>
  727. /// 相机连接或者断开时
  728. /// </summary>
  729. /// <param name="id"></param>
  730. /// <param name="state"></param>
  731. private void Management_CameraConnectChangedEvent(Guid id, bool state)
  732. {
  733. var sta = Status.FirstOrDefault(s => s.ID == id);
  734. var camera = _configService.GetCamera(id);
  735. if (sta != null && camera != null)
  736. {
  737. if (state)
  738. {
  739. App.Current.Dispatcher.Invoke(new Action(() =>
  740. {
  741. sta.Message = $"{camera.CameraName}{Lang.已连接}";
  742. sta.Background = new SolidColorBrush(Colors.Green);
  743. }));
  744. }
  745. else
  746. {
  747. App.Current.Dispatcher.Invoke(new Action(() =>
  748. {
  749. sta.Message = $"{camera.CameraName}{Lang.断开连接}";
  750. sta.Background = new SolidColorBrush(Colors.Red);
  751. }));
  752. }
  753. }
  754. }
  755. /// <summary>
  756. /// PLC连接状态改变事件
  757. /// </summary>
  758. /// <param name="plc"></param>
  759. /// <param name="isconnected"></param>
  760. private async void Management_PlcConnectChangedEvent(object sender, bool isconnected)
  761. {
  762. IPlc plc = sender as IPlc;
  763. var sta = Status.FirstOrDefault(s => s.ID == plc.Id);
  764. if (plc.IsConnected)
  765. {
  766. SendTaskMessage($"{plc.Name}{Lang.已连接}!", MessageLevel.Debug);
  767. if (sta == null) return;
  768. App.Current.Dispatcher.Invoke(new
  769. Action(() =>
  770. {
  771. sta.Message = $"{plc.Name}{Lang.已连接}";
  772. sta.Background = new SolidColorBrush(Colors.Green);
  773. }));
  774. try
  775. {
  776. await WriteSystemParameterToPlcAsync(_configService.GetSystemConfiguration());
  777. await WritePositionToPlcAsync();
  778. }
  779. catch (Exception ex)
  780. {
  781. LogHelper.WriteLogError("PLC连接成功时,写入系统参数和点位信息时出错!", ex);
  782. }
  783. }
  784. else
  785. {
  786. SendTaskMessage($"{plc.Name}{Lang.断开连接}!", MessageLevel.Error);
  787. if (sta == null) return;
  788. App.Current.Dispatcher.Invoke(new
  789. Action(() =>
  790. {
  791. sta.Message = $"{plc.Name}{Lang.未连接}";
  792. sta.Background = new SolidColorBrush(Colors.Red);
  793. }));
  794. }
  795. }
  796. /// <summary>
  797. /// 电批连接状态改变时
  798. /// </summary>
  799. /// <param name="screwDevice"></param>
  800. /// <param name="state"></param>
  801. private void ScrewDriver_ConnectStateChangedEvent(object screwDevice, bool state)
  802. {
  803. try
  804. {
  805. XYD_ScrewDriver screwDriver = screwDevice as XYD_ScrewDriver;
  806. if (state)
  807. {
  808. SendTaskMessage($"电批{Lang.已连接}!", MessageLevel.Debug);
  809. var sta = Status.FirstOrDefault(s => s.ID == screwDriver.Id);
  810. App.Current.Dispatcher.Invoke(new
  811. Action(() =>
  812. {
  813. sta.Message = $"电批{Lang.已连接}";
  814. sta.Background = new SolidColorBrush(Colors.Green);
  815. }));
  816. }
  817. else
  818. {
  819. SendTaskMessage($"电批{Lang.未连接}!", MessageLevel.Error);
  820. var sta = Status.FirstOrDefault(s => s.ID == screwDriver.Id);
  821. App.Current.Dispatcher.Invoke(new
  822. Action(() =>
  823. {
  824. sta.Message = $"电批{Lang.未连接}";
  825. sta.Background = new SolidColorBrush(Colors.Red);
  826. }));
  827. }
  828. }
  829. catch (Exception ex)
  830. {
  831. LogHelper.WriteLogError("电批连接状态改变时出错了", ex);
  832. }
  833. }
  834. #endregion
  835. #region 后台服务器通讯事件
  836. private void BgCommunicate_SendEvent(ITcpSessionClient client, string msg)
  837. {
  838. SendTaskMessage($"{Lang.服务器}[{client.ServicePort}] Send To {Lang.客户端}[{client.Id}:{client.IP}]:{msg}", MessageLevel.Info);
  839. }
  840. public Dictionary<string, CancellationTokenSource> BgCommunicateollection = new Dictionary<string, CancellationTokenSource>();
  841. private async void BgCommunicate_ReceivedEvent(ITcpSessionClient client, string msg)
  842. {
  843. try
  844. {
  845. if (!BgCommunicateollection.ContainsKey(client.Id))
  846. {
  847. BgCommunicateollection.Add(client.Id, new CancellationTokenSource());
  848. }
  849. SendTaskMessage($"{Lang.服务器}[{client.ServicePort}]ReceiveFor{Lang.客户端}[{client.Id}:{client.IP}]:{msg}", MessageLevel.Info);
  850. var _ = _remoteCommandService.ExecuteAsync(msg, BgCommunicateollection[client.Id].Token, async response =>
  851. {
  852. try
  853. {
  854. if (!client.Online)
  855. {
  856. return;
  857. }
  858. await BgCommunicate.SendAsync(client, $"{response}");
  859. }
  860. catch (Exception ex)
  861. {
  862. LogHelper.WriteLogError("后台TCP发送数据时出错!", ex);
  863. SendTaskMessage(ex.Message, MessageLevel.Alarm);
  864. }
  865. });
  866. }
  867. catch (Exception ex)
  868. {
  869. LogHelper.WriteLogError("处理后台服务器接收的命令时出错!", ex);
  870. SendTaskMessage(ex.Message, MessageLevel.Alarm);
  871. }
  872. }
  873. private void BgCommunicate_DisconnectedEvent(ITcpSessionClient client, ClosedEventArgs e)
  874. {
  875. SendTaskMessage($"{Lang.服务器}[{client.ServicePort}]{Lang.客户端}[{client.Id}:{client.IP}]{Lang.断开连接}!", MessageLevel.Alarm);
  876. if (BgCommunicateollection.ContainsKey(client.Id))
  877. {
  878. BgCommunicateollection[client.Id].Cancel();
  879. }
  880. }
  881. private void BgCommunicate_ConnectedEvent(ITcpSessionClient client, ConnectedEventArgs e)
  882. {
  883. SendTaskMessage($"{Lang.服务器}[{client.ServicePort}]{Lang.客户端}[{client.Id}:{client.IP}]{Lang.连接成功}!", MessageLevel.Debug);
  884. }
  885. #endregion
  886. #region PLC
  887. /// <summary>
  888. /// 将系统参数写入PLC
  889. /// </summary>
  890. /// <param name="systemConfiguration"></param>
  891. /// <returns></returns>
  892. public async Task WriteSystemParameterToPlcAsync(SystemConfiguration systemConfiguration)
  893. {
  894. var addressConfig = _configService.GetPlcAddresses();
  895. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  896. if (plc == null || !plc.IsConnected) return;
  897. Dictionary<string, object> nodeValues = new Dictionary<string, object>();
  898. nodeValues.Add(addressConfig.Out_WorkMode.Address, (Int16)systemConfiguration.WorkMode);
  899. nodeValues.Add(addressConfig.Out_PickPointNum.Address, (Int16)systemConfiguration.PickPointNum);
  900. nodeValues.Add(addressConfig.Out_DowmCameraNum.Address, (Int16)systemConfiguration.DowmCameraNum);
  901. nodeValues.Add(addressConfig.Out_UpCameraPickNum.Address, (Int16)systemConfiguration.UpCameraPickNum);
  902. nodeValues.Add(addressConfig.Out_UpCameraPutNum.Address, (Int16)systemConfiguration.UpCameraPutNum);
  903. nodeValues.Add(addressConfig.Out_UPCameracheckNum.Address, (Int16)systemConfiguration.UPCameracheckNum);
  904. nodeValues.Add(addressConfig.Out_FixedCameraPickNum.Address, (Int16)systemConfiguration.FixedCameraPickNum);
  905. nodeValues.Add(addressConfig.Out_FixedCameraPutNum.Address, (Int16)systemConfiguration.FixedCameraPutNum);
  906. nodeValues.Add(addressConfig.Out_FixedCameracheckNum.Address, (Int16)systemConfiguration.FixedCameracheckNum);
  907. nodeValues.Add(addressConfig.Out_ScrewTeachNum.Address, (Int16)systemConfiguration.ScrewTeachNum);
  908. var res = await plc.WriteNodesAsync(nodeValues);
  909. }
  910. /// <summary>
  911. /// 注册需要监控的PLC地址
  912. /// </summary>
  913. public void RegisterPlcMonitorAddress()
  914. {
  915. var addressConfig = _configService.GetPlcAddresses();
  916. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  917. if (plc == null || !plc.IsConnected) return;
  918. //PLC地址数组
  919. List<string> monitorNodeIds = new List<string>()
  920. {
  921. addressConfig.In_DowmCameraExe.Address,
  922. addressConfig.In_UpCameraPickExe.Address,
  923. addressConfig.In_UpCameraPutExe.Address,
  924. addressConfig.In_UPCameracheckExe.Address,
  925. addressConfig.In_FixedCameraPickExe.Address,
  926. addressConfig.In_FixedCameraPutExe.Address,
  927. addressConfig.In_FixedCameracheckExe.Address,
  928. addressConfig.In_RequestPosition.Address,
  929. addressConfig.In_ScrewTeachExe.Address,
  930. addressConfig.In_PickINC.Address,
  931. };
  932. for (int i = 0; i < 10; i++)
  933. {
  934. monitorNodeIds.Add(string.Format(addressConfig.In_MesCheck.Address, i));
  935. }
  936. for (int i = 0; i < 7; i++)
  937. {
  938. monitorNodeIds.Add(string.Format(addressConfig.In_WorkStart.Address, i));
  939. monitorNodeIds.Add(string.Format(addressConfig.In_WorkDone.Address, i));
  940. }
  941. //订阅PLC地址变化
  942. plc.SubscribeNodes("AutoSensor", monitorNodeIds, PlcCommandTrigger);
  943. }
  944. /// <summary>
  945. /// 写入点位信息给PLC
  946. /// </summary>
  947. /// <returns></returns>
  948. public async Task WritePositionToPlcAsync()
  949. {
  950. var addressConfig = _configService.GetPlcAddresses();
  951. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  952. if (plc == null || !plc.IsConnected) return;
  953. var current = _productService.GetCurrentProduct();
  954. if (current == null) return;
  955. if (current.PickCameraPoints != null && current.PickCameraPoints.Count > 0)
  956. {
  957. foreach (var item in current.PickCameraPoints)
  958. {
  959. await item.WriteToPlcAddress(addressConfig.Out_PickCamera, plc);
  960. }
  961. }
  962. if (current.PickPoints != null && current.PickPoints.Count > 0)
  963. {
  964. foreach (var item in current.PickPoints)
  965. {
  966. await item.WriteToPlcAddress(addressConfig.Out_Pick, plc);
  967. }
  968. }
  969. if (current.SecPosCameraPoints != null && current.SecPosCameraPoints.Count > 0)
  970. {
  971. foreach (var item in current.SecPosCameraPoints)
  972. {
  973. await item.WriteToPlcAddress(addressConfig.Out_SecPosCamera, plc);
  974. }
  975. }
  976. if (current.ScrewCameraPoints != null && current.ScrewCameraPoints.Count > 0)
  977. {
  978. foreach (var item in current.ScrewCameraPoints)
  979. {
  980. await item.WriteToPlcAddress(addressConfig.Out_ScrewCamera, plc);
  981. }
  982. }
  983. if (current.ScrewPoints != null && current.ScrewPoints.Count > 0)
  984. {
  985. foreach (var item in current.ScrewPoints)
  986. {
  987. await item.WriteToPlcAddressEx(addressConfig.Out_Screw, plc);
  988. }
  989. await plc.WriteNodeAsync(addressConfig.Out_WorkNum.Address, (Int16)current.ScrewPoints.Count);
  990. }
  991. if (current.CheckCameraPoints != null && current.CheckCameraPoints.Count > 0)
  992. {
  993. foreach (var item in current.CheckCameraPoints)
  994. {
  995. await item.WriteToPlcAddress(addressConfig.Out_CheckCamera, plc);
  996. }
  997. }
  998. if (current.RemovePoints != null && current.RemovePoints.Count > 0)
  999. {
  1000. foreach (var item in current.RemovePoints)
  1001. {
  1002. await item.WriteToPlcAddress(addressConfig.Out_RemovePos, plc);
  1003. }
  1004. }
  1005. if (current.PressurePlacePoints != null && current.PressurePlacePoints.Count > 0)
  1006. {
  1007. foreach (var item in current.PressurePlacePoints)
  1008. {
  1009. await item.WriteToPlcAddress(addressConfig.Out_PressurePlace, plc);
  1010. }
  1011. }
  1012. if (current.IndependentCamerPoints != null && current.IndependentCamerPoints.Count > 0)
  1013. {
  1014. foreach (var item in current.IndependentCamerPoints)
  1015. {
  1016. await item.WriteToPlcAddress(addressConfig.Out_IndependentCamer, plc);
  1017. }
  1018. }
  1019. }
  1020. /// <summary>
  1021. /// 固定向上相机拍照结果
  1022. /// </summary>
  1023. OpenCvSharp.Point3f[] DowmCameraResults = new OpenCvSharp.Point3f[10];
  1024. /// <summary>
  1025. /// 移动向下相机拍照结果
  1026. /// </summary>
  1027. OpenCvSharp.Point3f[] UpCameraPutResults = new OpenCvSharp.Point3f[10];
  1028. /// <summary>
  1029. /// 取料移动相机拍照结果
  1030. /// </summary>
  1031. OpenCvSharp.Point3f UpCameraPickResult = new OpenCvSharp.Point3f();
  1032. /// <summary>
  1033. /// 最终组装位置
  1034. /// </summary>
  1035. OpenCvSharp.Point3f PlaceActualCoord = new OpenCvSharp.Point3f();
  1036. /// <summary>
  1037. /// 零件SN
  1038. /// </summary>
  1039. string PartSN = "";
  1040. /// <summary>
  1041. /// 二次定位相机的工具坐标
  1042. /// </summary>
  1043. PointF DownTool = new PointF();
  1044. double _FixedUpCameraAngle = 0;
  1045. double _MoveCameraAngle = 0;
  1046. bool _LastDowmCameraExe = false;
  1047. bool _LastScrewTeachExe = false;
  1048. bool _LastUpCameraPickExe = false;
  1049. bool _LastUpCameraPutExe = false;
  1050. bool _LastUPCameracheckExe = false;
  1051. bool _LastFixedCameraPickExe = false;
  1052. bool _LastFixedCameraPutExe = false;
  1053. bool _LastFixedCameracheckExe = false;
  1054. Int16[] _LastWorkStart = new Int16[7];
  1055. Int16[] _LastWorkDone = new Int16[7];
  1056. Int16 _LastRequestPosition = 0;
  1057. Int16 _LastPickINC = 0;
  1058. Int16[] _LastMesCheck=new Int16[10];
  1059. DateTime[] _LastMesCheckTime = new DateTime[10];
  1060. /// <summary>
  1061. /// PLC命令触发时
  1062. /// </summary>
  1063. /// <param name="tuple"></param>
  1064. private async void PlcCommandTrigger((string key, string nodeId, object value) tuple)
  1065. {
  1066. try
  1067. {
  1068. if (tuple.key != "AutoSensor")
  1069. {
  1070. return;
  1071. }
  1072. var addressConfig = _configService.GetPlcAddresses();
  1073. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  1074. if (plc == null || !plc.IsConnected) return;
  1075. // 获取当前产品
  1076. var currentProduct = _productService.GetCurrentProduct();
  1077. if (currentProduct == null)
  1078. {
  1079. return;
  1080. }
  1081. //获取产品编码
  1082. _productService.CurrentProductCode = plc.ReadNode<string>(string.Format(addressConfig.In_Code.Address, 0));
  1083. //如果产品编码为空,则以当前的时间戳作为编码
  1084. if (string.IsNullOrEmpty(_productService.CurrentProductCode))
  1085. {
  1086. _productService.CurrentProductCode = DateTime.Now.ToString("yyyyMMddHHmmssfff");
  1087. }
  1088. bool isDryMode = plc.ReadNode<bool>(addressConfig.In_DryMode.Address);
  1089. // 触发下相机拍照
  1090. if (addressConfig.In_DowmCameraExe.Address.Contains(tuple.nodeId))
  1091. {
  1092. if (tuple.value is bool state)
  1093. {
  1094. if (_LastDowmCameraExe != state)
  1095. {
  1096. _LastDowmCameraExe = state;
  1097. }
  1098. else
  1099. {
  1100. return;
  1101. }
  1102. if (state)
  1103. {
  1104. SendTaskMessage($"触发下相机拍照...", MessageLevel.Debug);
  1105. //相机的编号
  1106. Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_DowmCameraNum.Address);
  1107. SendTaskMessage($"编号:{cameraIndex}", MessageLevel.Info);
  1108. // 获取机器人当前坐标
  1109. var robot = _robotService.GetAllRobots().FirstOrDefault();
  1110. if (robot == null)
  1111. {
  1112. SendTaskMessage($"未找到机器人,无法执行上相机锁附/组装拍照视觉任务", MessageLevel.Alarm);
  1113. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1114. return;
  1115. }
  1116. var currentPosition = robot.GetRobotPos();
  1117. //如果下相机拍照的次数是1,则判断用时拍照的相机是几个
  1118. int downCameraNum = _configService.GetSystemConfiguration().DowmCameraNum;
  1119. if (downCameraNum == 1)
  1120. {
  1121. //如果下相机2的流程id为空,则表示只有一个下相机
  1122. if (currentProduct.FixedUpCamera2ProcedureId == Guid.Empty)
  1123. {
  1124. //获取固定向上相机1的流程
  1125. var process = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
  1126. if (process == null)
  1127. {
  1128. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera1ProcedureId}", MessageLevel.Alarm);
  1129. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1130. return;
  1131. }
  1132. // 执行视觉任务
  1133. var _cts = new CancellationTokenSource();
  1134. var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, cameraIndex, null);
  1135. if (isDryMode)
  1136. {
  1137. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1138. return;
  1139. }
  1140. if (visionResult.IsSucceed)
  1141. {
  1142. float toolX = (float)(visionResult.X - currentPosition.X);
  1143. float toolY = (float)(visionResult.Y - currentPosition.Y);
  1144. DowmCameraResults[cameraIndex] = new OpenCvSharp.Point3f(toolX, toolX, (float)visionResult.U);
  1145. DownTool = new PointF(toolX, toolX);
  1146. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1147. return;
  1148. }
  1149. else
  1150. {
  1151. if (isDryMode)
  1152. {
  1153. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1154. return;
  1155. }
  1156. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1157. return;
  1158. }
  1159. }
  1160. else
  1161. {
  1162. //获取固定向上相机1的流程
  1163. var process1 = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
  1164. if (process1 == null)
  1165. {
  1166. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera1ProcedureId}", MessageLevel.Alarm);
  1167. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1168. return;
  1169. }
  1170. //获取固定向上相机2的流程
  1171. var process2 = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera2ProcedureId);
  1172. if (process2 == null)
  1173. {
  1174. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera2ProcedureId}", MessageLevel.Alarm);
  1175. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1176. return;
  1177. }
  1178. // 执行视觉任务
  1179. var _cts = new CancellationTokenSource();
  1180. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 1, null);
  1181. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 2, null);
  1182. var visionResults = await Task.WhenAll(task1, task2);
  1183. if (isDryMode)
  1184. {
  1185. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1186. return;
  1187. }
  1188. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed)
  1189. {
  1190. float toolX = (float)(visionResults[0].X + visionResults[1].X) / 2;
  1191. float toolY = (float)(visionResults[0].Y + visionResults[1].Y) / 2;
  1192. _FixedUpCameraAngle = Common.CalculateAngleBetweenPointsDegrees(new PointF((float)visionResults[0].X, (float)visionResults[0].Y), new PointF((float)visionResults[1].X, (float)visionResults[1].Y));
  1193. DowmCameraResults[cameraIndex] = new OpenCvSharp.Point3f(toolX, toolX, (float)_FixedUpCameraAngle);
  1194. DownTool = new PointF(toolX, toolX);
  1195. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1196. return;
  1197. }
  1198. else
  1199. {
  1200. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1201. return;
  1202. }
  1203. }
  1204. }
  1205. else if (downCameraNum == 2)
  1206. {
  1207. if (isDryMode)
  1208. {
  1209. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1210. return;
  1211. }
  1212. //如果下相机2的流程id为空,则表示只有一个下相机
  1213. if (currentProduct.FixedUpCamera2ProcedureId == Guid.Empty)
  1214. {
  1215. //获取固定向上相机1的流程
  1216. //var process = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
  1217. //if (process == null)
  1218. //{
  1219. // SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera1ProcedureId}", MessageLevel.Alarm);
  1220. // await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1221. // return;
  1222. //}
  1223. //// 执行视觉任务
  1224. //var _cts = new CancellationTokenSource();
  1225. //var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token);
  1226. //if (visionResult.IsSucceed)
  1227. //{
  1228. // float toolX = (float)(visionResult.X - currentPosition.X);
  1229. // float toolY = (float)(visionResult.Y - currentPosition.Y);
  1230. // DowmCameraResults[cameraIndex] = new PointF(toolX, toolX);
  1231. // if (cameraIndex == downCameraNum)
  1232. // {
  1233. // //求取多个DowmCameraResults的中心点
  1234. // DownTool = new PointF(toolX, toolX);
  1235. // }
  1236. // await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1237. // return;
  1238. //}
  1239. //else
  1240. //{
  1241. // await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1242. // return;
  1243. //}
  1244. //暂时没有应用场景,不支持
  1245. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1246. return;
  1247. }
  1248. else
  1249. {
  1250. //获取固定向上相机1的流程
  1251. var process1 = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
  1252. if (process1 == null)
  1253. {
  1254. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera1ProcedureId}", MessageLevel.Alarm);
  1255. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1256. return;
  1257. }
  1258. //获取固定向上相机2的流程
  1259. var process2 = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera2ProcedureId);
  1260. if (process2 == null)
  1261. {
  1262. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera2ProcedureId}", MessageLevel.Alarm);
  1263. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1264. return;
  1265. }
  1266. // 执行视觉任务
  1267. var _cts = new CancellationTokenSource();
  1268. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 1, null);
  1269. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 2, null);
  1270. var visionResults = await Task.WhenAll(task1, task2);
  1271. if (isDryMode)
  1272. {
  1273. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1274. return;
  1275. }
  1276. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed)
  1277. {
  1278. float toolX = (float)(visionResults[0].X + visionResults[1].X) / 2;
  1279. float toolY = (float)(visionResults[0].Y + visionResults[1].Y) / 2;
  1280. _FixedUpCameraAngle = Common.CalculateAngleBetweenPointsDegrees(new PointF((float)visionResults[0].X, (float)visionResults[0].Y), new PointF((float)visionResults[1].X, (float)visionResults[1].Y));
  1281. DowmCameraResults[cameraIndex] = new OpenCvSharp.Point3f(toolX, toolX, (float)_FixedUpCameraAngle);
  1282. DownTool = new PointF(toolX, toolX);
  1283. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1284. return;
  1285. }
  1286. else
  1287. {
  1288. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1289. return;
  1290. }
  1291. }
  1292. }
  1293. else
  1294. {
  1295. //暂时没有应用场景,不支持
  1296. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1297. return;
  1298. }
  1299. }
  1300. else
  1301. {
  1302. SendTaskMessage($"触发下相机拍照信号已关闭", MessageLevel.Alarm);
  1303. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)0);
  1304. }
  1305. }
  1306. }
  1307. // 触发下相机拍照披头
  1308. if (addressConfig.In_ScrewTeachExe.Address.Contains(tuple.nodeId))
  1309. {
  1310. if (tuple.value is bool state)
  1311. {
  1312. if (_LastScrewTeachExe != state)
  1313. {
  1314. _LastScrewTeachExe = state;
  1315. }
  1316. else
  1317. {
  1318. return;
  1319. }
  1320. if (state)
  1321. {
  1322. SendTaskMessage($"触发下相机拍照...", MessageLevel.Debug);
  1323. //相机的编号
  1324. Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_DowmCameraNum.Address);
  1325. SendTaskMessage($"编号:{cameraIndex}", MessageLevel.Info);
  1326. // 获取流程
  1327. //var process = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
  1328. //if (process == null)
  1329. //{
  1330. // SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera1ProcedureId}", MessageLevel.Alarm);
  1331. // await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)2);
  1332. // return;
  1333. //}
  1334. //// 获取机器人当前坐标
  1335. //var robot = _robotService.GetAllRobots().FirstOrDefault();
  1336. //if (robot == null)
  1337. //{
  1338. // SendTaskMessage($"未找到机器人,无法执行上相机锁附/组装拍照视觉任务", MessageLevel.Alarm);
  1339. // await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)2);
  1340. // return;
  1341. //}
  1342. //var currentPosition = robot.GetRobotPos();
  1343. //// 执行视觉任务
  1344. //var _cts = new CancellationTokenSource();
  1345. //var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, null, _cts.Token);
  1346. //if (visionResult.IsSucceed)
  1347. //{
  1348. // //披头偏差
  1349. // float offsetX = (float)(visionResult.X - currentPosition.X);
  1350. // float offsetY = (float)(visionResult.Y - currentPosition.Y);
  1351. // DowmCameraResults[cameraIndex] = new PointF(offsetX, offsetY);
  1352. // await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)1);
  1353. // return;
  1354. //}
  1355. //else
  1356. //{
  1357. // await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)2);
  1358. // return;
  1359. //}
  1360. }
  1361. else
  1362. {
  1363. SendTaskMessage($"触发下相机拍照信号已关闭", MessageLevel.Alarm);
  1364. await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)0);
  1365. }
  1366. }
  1367. }
  1368. // 触发上相机取料拍照
  1369. else if (addressConfig.In_UpCameraPickExe.Address.Contains(tuple.nodeId))
  1370. {
  1371. if (tuple.value is bool state)
  1372. {
  1373. if (_LastUpCameraPickExe != state)
  1374. {
  1375. _LastUpCameraPickExe = state;
  1376. }
  1377. else
  1378. {
  1379. return;
  1380. }
  1381. if (state)
  1382. {
  1383. SendTaskMessage($"触发上相机取料拍照...", MessageLevel.Debug);
  1384. //相机的编号
  1385. Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_UpCameraPickNum.Address);
  1386. SendTaskMessage($"编号:{cameraIndex}", MessageLevel.Info);
  1387. // 获取机器人当前坐标
  1388. var robot = _robotService.GetAllRobots().FirstOrDefault();
  1389. if (robot == null)
  1390. {
  1391. SendTaskMessage($"未找到机器人,无法执行上相机锁附/组装拍照视觉任务", MessageLevel.Alarm);
  1392. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1393. return;
  1394. }
  1395. var currentPosition = robot.GetRobotPos();
  1396. //如果上相机2的流程id为空,则表示只有一个下相机
  1397. if (currentProduct.MoveDownCamer2PickPhotoProcedureId == Guid.Empty)
  1398. {
  1399. //获取移动向下相机1的流程
  1400. var process = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamer1PickPhotoProcedureId);
  1401. if (process == null)
  1402. {
  1403. SendTaskMessage($"移动向下相机1视觉流程,流程ID:{currentProduct.MoveDownCamer1PickPhotoProcedureId}", MessageLevel.Alarm);
  1404. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)2);
  1405. return;
  1406. }
  1407. // 执行视觉任务
  1408. var _cts = new CancellationTokenSource();
  1409. var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, cameraIndex, null);
  1410. if (isDryMode)
  1411. {
  1412. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)1);
  1413. return;
  1414. }
  1415. if (visionResult.IsSucceed)
  1416. {
  1417. currentProduct.PickPoints[0].X_Position = (float)visionResult.X;
  1418. currentProduct.PickPoints[0].Y_Position = (float)visionResult.Y;
  1419. //currentProduct.PickPoints[0].U_Position += (float)visionResult.U;
  1420. await currentProduct.ScrewPoints[0].WriteToPlcAddress(addressConfig.Out_Pick, plc);
  1421. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)1);
  1422. return;
  1423. }
  1424. else
  1425. {
  1426. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)2);
  1427. return;
  1428. }
  1429. }
  1430. else
  1431. {
  1432. //获取固定向上相机1的流程
  1433. var process1 = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamer1PickPhotoProcedureId);
  1434. if (process1 == null)
  1435. {
  1436. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.MoveDownCamer1PickPhotoProcedureId}", MessageLevel.Alarm);
  1437. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)2);
  1438. return;
  1439. }
  1440. //获取固定向上相机2的流程
  1441. var process2 = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamer2PickPhotoProcedureId);
  1442. if (process2 == null)
  1443. {
  1444. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.MoveDownCamer2PickPhotoProcedureId}", MessageLevel.Alarm);
  1445. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)2);
  1446. return;
  1447. }
  1448. // 执行视觉任务
  1449. var _cts = new CancellationTokenSource();
  1450. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 1, null);
  1451. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 2, null);
  1452. var visionResults = await Task.WhenAll(task1, task2);
  1453. if (isDryMode)
  1454. {
  1455. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)1);
  1456. return;
  1457. }
  1458. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed)
  1459. {
  1460. float tool1X = (float)(visionResults[0].X - visionResults[0].X);
  1461. float tool1Y = (float)(visionResults[0].Y - visionResults[0].Y);
  1462. float tool2X = (float)(visionResults[1].Y - visionResults[1].Y);
  1463. float tool2Y = (float)(visionResults[1].Y - visionResults[1].Y);
  1464. float toolX = (tool1X + tool2X) / 2;
  1465. float toolY = (tool1Y + tool2Y) / 2;
  1466. //计算两个点的线角度
  1467. currentProduct.PickPoints[0].X_Position = (float)toolX;
  1468. currentProduct.PickPoints[0].Y_Position = (float)toolY;
  1469. //currentProduct.PickPoints[0].U_Position += (float)visionResult.U;
  1470. await currentProduct.ScrewPoints[0].WriteToPlcAddress(addressConfig.Out_Pick, plc);
  1471. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)1);
  1472. return;
  1473. }
  1474. else
  1475. {
  1476. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)2);
  1477. return;
  1478. }
  1479. }
  1480. }
  1481. else
  1482. {
  1483. SendTaskMessage($"触发上相机取料拍照信号已关闭", MessageLevel.Alarm);
  1484. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)0);
  1485. }
  1486. }
  1487. }
  1488. // 上相机锁附/组装拍照
  1489. else if (addressConfig.In_UpCameraPutExe.Address.Contains(tuple.nodeId))
  1490. {
  1491. if (tuple.value is bool state)
  1492. {
  1493. if (_LastUpCameraPutExe != state)
  1494. {
  1495. _LastUpCameraPutExe = state;
  1496. }
  1497. else
  1498. {
  1499. return;
  1500. }
  1501. if (state)
  1502. {
  1503. SendTaskMessage($"触发上相机锁附/组装拍照...", MessageLevel.Debug);
  1504. //相机的编号
  1505. Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_UpCameraPutNum.Address);
  1506. SendTaskMessage($"编号:{cameraIndex}", MessageLevel.Info);
  1507. // 获取机器人当前坐标
  1508. var robot = _robotService.GetAllRobots().FirstOrDefault();
  1509. if (robot == null)
  1510. {
  1511. SendTaskMessage($"未找到机器人,无法执行上相机锁附/组装拍照视觉任务", MessageLevel.Alarm);
  1512. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1513. return;
  1514. }
  1515. var currentPosition = robot.GetRobotPos();
  1516. //如果上相机2的流程id为空,则表示只有一个上相机
  1517. if (currentProduct.MoveDownCamera2LockPhotoProcedureId == Guid.Empty)
  1518. {
  1519. //获取移动向下相机1的流程
  1520. var process = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamera1LockPhotoProcedureId);
  1521. if (process == null)
  1522. {
  1523. SendTaskMessage($"移动向下相机1视觉流程,流程ID:{currentProduct.MoveDownCamera1LockPhotoProcedureId}", MessageLevel.Alarm);
  1524. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1525. return;
  1526. }
  1527. // 执行视觉任务
  1528. var _cts = new CancellationTokenSource();
  1529. var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, cameraIndex, null);
  1530. if (isDryMode)
  1531. {
  1532. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)1);
  1533. return;
  1534. }
  1535. if (visionResult.IsSucceed)
  1536. {
  1537. UpCameraPutResults[cameraIndex] = new OpenCvSharp.Point3f((float)visionResult.X, (float)visionResult.Y, (float)visionResult.U);
  1538. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)1);
  1539. return;
  1540. }
  1541. else
  1542. {
  1543. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1544. return;
  1545. }
  1546. }
  1547. else
  1548. {
  1549. //获取移动向下相机1的流程
  1550. var process1 = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamera1LockPhotoProcedureId);
  1551. if (process1 == null)
  1552. {
  1553. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.MoveDownCamera1LockPhotoProcedureId}", MessageLevel.Alarm);
  1554. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1555. return;
  1556. }
  1557. //获取移动向下相机2的流程
  1558. var process2 = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamera2LockPhotoProcedureId);
  1559. if (process2 == null)
  1560. {
  1561. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.MoveDownCamera2LockPhotoProcedureId}", MessageLevel.Alarm);
  1562. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1563. return;
  1564. }
  1565. // 执行视觉任务
  1566. var _cts = new CancellationTokenSource();
  1567. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 1, null);
  1568. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 2, null);
  1569. var visionResults = await Task.WhenAll(task1, task2);
  1570. if (isDryMode)
  1571. {
  1572. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)1);
  1573. return;
  1574. }
  1575. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed)
  1576. {
  1577. float centerX = (float)(visionResults[0].X + visionResults[1].X) / 2;
  1578. float centerY = (float)(visionResults[0].Y + visionResults[1].Y) / 2;
  1579. _MoveCameraAngle = Common.CalculateAngleBetweenPointsDegrees(new PointF((float)visionResults[0].X, (float)visionResults[0].Y), new PointF((float)visionResults[1].X, (float)visionResults[1].Y));
  1580. UpCameraPutResults[cameraIndex] = new OpenCvSharp.Point3f(centerX, centerY, (float)_MoveCameraAngle);
  1581. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)1);
  1582. return;
  1583. }
  1584. else
  1585. {
  1586. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1587. return;
  1588. }
  1589. }
  1590. }
  1591. else
  1592. {
  1593. SendTaskMessage($"触发上相机锁附/组装拍照信号已关闭", MessageLevel.Alarm);
  1594. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)0);
  1595. }
  1596. }
  1597. }
  1598. // 上相机检测拍照
  1599. else if (addressConfig.In_UPCameracheckExe.Address.Contains(tuple.nodeId))
  1600. {
  1601. if (tuple.value is bool state)
  1602. {
  1603. if (_LastUPCameracheckExe != state)
  1604. {
  1605. _LastUPCameracheckExe = state;
  1606. }
  1607. else
  1608. {
  1609. return;
  1610. }
  1611. if (state)
  1612. {
  1613. SendTaskMessage($"触发上相机检测拍照...", MessageLevel.Debug);
  1614. //相机的编号
  1615. //Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.Out_UPCameracheckNum.Address);
  1616. if (isDryMode)
  1617. {
  1618. await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)1);
  1619. return;
  1620. }
  1621. await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)1);
  1622. }
  1623. else
  1624. {
  1625. SendTaskMessage($"触发上相机检测拍照信号已关闭", MessageLevel.Alarm);
  1626. await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)0);
  1627. }
  1628. }
  1629. }
  1630. // 固定相机取料拍照
  1631. else if (addressConfig.In_FixedCameraPickExe.Address.Contains(tuple.nodeId))
  1632. {
  1633. if (tuple.value is bool state)
  1634. {
  1635. if (_LastFixedCameraPickExe != state)
  1636. {
  1637. _LastFixedCameraPickExe = state;
  1638. }
  1639. else
  1640. {
  1641. return;
  1642. }
  1643. if (state)
  1644. {
  1645. SendTaskMessage($"触发固定相机取料拍照...", MessageLevel.Debug);
  1646. //相机的编号
  1647. //Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_FixedCameraPickNum.Address);
  1648. if (isDryMode)
  1649. {
  1650. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPickStatus.Address, (Int16)1);
  1651. return;
  1652. }
  1653. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPickStatus.Address, (Int16)1);
  1654. }
  1655. else
  1656. {
  1657. SendTaskMessage($"触发固定相机取料拍照信号已关闭", MessageLevel.Alarm);
  1658. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPickStatus.Address, (Int16)0);
  1659. }
  1660. }
  1661. }
  1662. // 固定相机锁附/组装拍照
  1663. else if (addressConfig.In_FixedCameraPutExe.Address.Contains(tuple.nodeId))
  1664. {
  1665. if (tuple.value is bool state)
  1666. {
  1667. if (_LastFixedCameraPutExe != state)
  1668. {
  1669. _LastFixedCameraPutExe = state;
  1670. }
  1671. else
  1672. {
  1673. return;
  1674. }
  1675. if (state)
  1676. {
  1677. SendTaskMessage($"触发固定相机锁附/组装拍照...", MessageLevel.Debug);
  1678. //相机的编号
  1679. //Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_FixedCameraPutNum.Address);
  1680. if (currentProduct.IndependentCamer1ProductProcedureId == Guid.Empty)
  1681. {
  1682. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)2);
  1683. return;
  1684. }
  1685. if (currentProduct.IndependentCamer2ProductProcedureId == Guid.Empty)
  1686. {
  1687. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)2);
  1688. return;
  1689. }
  1690. if (currentProduct.IndependentCamer3ProductProcedureId == Guid.Empty)
  1691. {
  1692. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)2);
  1693. return;
  1694. }
  1695. if (currentProduct.IndependentCamer4ProductProcedureId == Guid.Empty)
  1696. {
  1697. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)2);
  1698. return;
  1699. }
  1700. //获取四个独立相机的流程id
  1701. var process1 = _productService.GetCurrentProductProcedureModelById(currentProduct.IndependentCamer1ProductProcedureId);
  1702. var process2 = _productService.GetCurrentProductProcedureModelById(currentProduct.IndependentCamer2ProductProcedureId);
  1703. var process3 = _productService.GetCurrentProductProcedureModelById(currentProduct.IndependentCamer3ProductProcedureId);
  1704. var process4 = _productService.GetCurrentProductProcedureModelById(currentProduct.IndependentCamer4ProductProcedureId);
  1705. // 执行视觉任务
  1706. var _cts = new CancellationTokenSource();
  1707. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, null, _cts.Token, 1, null);
  1708. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, null, _cts.Token, 2, null);
  1709. var task3 = _remoteCommandService.ExecutePhotoGetSinglePoint(process3, null, null, _cts.Token, 3, null);
  1710. var task4 = _remoteCommandService.ExecutePhotoGetSinglePoint(process4, null, null, _cts.Token, 4, null);
  1711. var visionResults = await Task.WhenAll(task1, task2, task3, task4);
  1712. if (isDryMode)
  1713. {
  1714. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)1);
  1715. return;
  1716. }
  1717. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed && visionResults[2].IsSucceed && visionResults[3].IsSucceed)
  1718. {
  1719. Vector<double> p1=Vector<double>.Build.Dense(new double[] { visionResults[1].X, visionResults[1].Y });
  1720. Vector<double> p2=Vector<double>.Build.Dense(new double[] { visionResults[2].X, visionResults[2].Y });
  1721. Vector<double> p3=Vector<double>.Build.Dense(new double[] { visionResults[3].X, visionResults[3].Y });
  1722. Vector<double> p4 = Vector<double>.Build.Dense(new double[] { visionResults[0].X, visionResults[0].Y });
  1723. var center = RectangleCenterCalculator.CalculateByPCAWithKnownOrder(new List<Vector<double>> { p1, p2, p3, p4 });
  1724. UpCameraPutResults[0].X = (float)center.Center[0];
  1725. UpCameraPutResults[0].Y = (float)center.Center[1];
  1726. UpCameraPutResults[0].Z= (float)center.MajorAxisAngle;
  1727. SendTaskMessage($"产品拍照结果:X={UpCameraPutResults[0].X},Y={UpCameraPutResults[0].Y},Angle={UpCameraPutResults[0].Z}", MessageLevel.Info);
  1728. }
  1729. else
  1730. {
  1731. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)2);
  1732. return;
  1733. }
  1734. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)1);
  1735. }
  1736. else
  1737. {
  1738. SendTaskMessage($"触发固定相机锁附/组装拍照信号已关闭", MessageLevel.Alarm);
  1739. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)0);
  1740. }
  1741. }
  1742. }
  1743. // 固定相机检测拍照
  1744. else if (addressConfig.In_FixedCameracheckExe.Address.Contains(tuple.nodeId))
  1745. {
  1746. if (tuple.value is bool state)
  1747. {
  1748. if (_LastFixedCameracheckExe != state)
  1749. {
  1750. _LastFixedCameracheckExe = state;
  1751. }
  1752. else
  1753. {
  1754. return;
  1755. }
  1756. if (state)
  1757. {
  1758. SendTaskMessage($"触发固定相机检测拍照...", MessageLevel.Debug);
  1759. //相机的编号
  1760. //Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_FixedCameracheckNum.Address);
  1761. if (currentProduct.IndependentCamer1AuxProcedureId == Guid.Empty)
  1762. {
  1763. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)2);
  1764. return;
  1765. }
  1766. if (currentProduct.IndependentCamer2AuxProcedureId == Guid.Empty)
  1767. {
  1768. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)2);
  1769. return;
  1770. }
  1771. if (currentProduct.IndependentCamer3AuxProcedureId == Guid.Empty)
  1772. {
  1773. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)2);
  1774. return;
  1775. }
  1776. if (currentProduct.IndependentCamer4AuxProcedureId == Guid.Empty)
  1777. {
  1778. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)2);
  1779. return;
  1780. }
  1781. //获取四个独立相机的流程id
  1782. var process1 = _productService.GetCurrentProductProcedureModelById(currentProduct.IndependentCamer1AuxProcedureId);
  1783. var process2 = _productService.GetCurrentProductProcedureModelById(currentProduct.IndependentCamer2AuxProcedureId);
  1784. var process3 = _productService.GetCurrentProductProcedureModelById(currentProduct.IndependentCamer3AuxProcedureId);
  1785. var process4 = _productService.GetCurrentProductProcedureModelById(currentProduct.IndependentCamer4AuxProcedureId);
  1786. // 执行视觉任务
  1787. var _cts = new CancellationTokenSource();
  1788. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, null, _cts.Token, 1, null);
  1789. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, null, _cts.Token, 2, null);
  1790. var task3 = _remoteCommandService.ExecutePhotoGetSinglePoint(process3, null, null, _cts.Token, 3, null);
  1791. var task4 = _remoteCommandService.ExecutePhotoGetSinglePoint(process4, null, null, _cts.Token, 4, null);
  1792. var visionResults = await Task.WhenAll(task1, task2, task3, task4);
  1793. if (isDryMode)
  1794. {
  1795. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)1);
  1796. return;
  1797. }
  1798. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed && visionResults[2].IsSucceed && visionResults[3].IsSucceed)
  1799. {
  1800. Vector<double> p1 = Vector<double>.Build.Dense(new double[] { visionResults[1].X, visionResults[1].Y });
  1801. Vector<double> p2 = Vector<double>.Build.Dense(new double[] { visionResults[2].X, visionResults[2].Y });
  1802. Vector<double> p3 = Vector<double>.Build.Dense(new double[] { visionResults[3].X, visionResults[3].Y });
  1803. Vector<double> p4 = Vector<double>.Build.Dense(new double[] { visionResults[0].X, visionResults[0].Y });
  1804. var center = RectangleCenterCalculator.CalculateByPCAWithKnownOrder(new List<Vector<double>> { p1, p2, p3, p4 });
  1805. UpCameraPutResults[1].X = (float)center.Center[0];
  1806. UpCameraPutResults[1].Y = (float)center.Center[1];
  1807. UpCameraPutResults[1].Z = (float)center.MajorAxisAngle;
  1808. SendTaskMessage($"LCD拍照结果:X={UpCameraPutResults[1].X},Y={UpCameraPutResults[1].Y},Angle={UpCameraPutResults[1].Z}", MessageLevel.Info);
  1809. }
  1810. else
  1811. {
  1812. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)2);
  1813. return;
  1814. }
  1815. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)1);
  1816. }
  1817. else
  1818. {
  1819. SendTaskMessage($"触发固定相机检测拍照信号已关闭", MessageLevel.Alarm);
  1820. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)0);
  1821. }
  1822. }
  1823. }
  1824. // 多相机坐标合并
  1825. else if (addressConfig.In_RequestPosition.Address.Contains(tuple.nodeId))
  1826. {
  1827. if (tuple.value is Int16 state)
  1828. {
  1829. if (_LastRequestPosition != state)
  1830. {
  1831. _LastRequestPosition = state;
  1832. }
  1833. else
  1834. {
  1835. return;
  1836. }
  1837. if (state == 1)
  1838. {
  1839. SendTaskMessage($"收到多相机坐标合并请求,开始合并...", MessageLevel.Debug);
  1840. if (isDryMode)
  1841. {
  1842. var point1 = currentProduct.ScrewPoints[0].Clone();
  1843. SendTaskMessage($"点:1,{point1.X_Position:F3},{point1.Y_Position:F4},{point1.U_Position:F4}", MessageLevel.Info);
  1844. await point1.WriteToPlcAddress(addressConfig.Out_Screw, plc);
  1845. await plc.WriteNodeAsync(addressConfig.Out_WorkNum.Address, (Int16)1);
  1846. await plc.WriteNodeAsync(addressConfig.Out_CameraDone.Address, (Int16)1);
  1847. return;
  1848. }
  1849. // 获取机器人当前坐标
  1850. var robot = _robotService.GetAllRobots().FirstOrDefault();
  1851. if (robot == null)
  1852. {
  1853. SendTaskMessage($"未找到机器人,无法执行上相机锁附/组装拍照视觉任务", MessageLevel.Alarm);
  1854. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1855. return;
  1856. }
  1857. var currentPosition = robot.GetRobotPos();
  1858. //以LCD的中线创建工具坐标
  1859. ToolCoord toolCoord = new ToolCoord();
  1860. toolCoord.ComputeTool(currentPosition.X, currentPosition.Y, currentPosition.U, UpCameraPutResults[1].X, UpCameraPutResults[1].Y);
  1861. //计算放料角度
  1862. double angle= currentPosition.U - UpCameraPutResults[1].Z + UpCameraPutResults[0].Z;
  1863. //将产品的中心点坐标转换为Tool0下的坐标
  1864. var point = currentProduct.ScrewPoints[0].Clone();
  1865. var pn = Vector<double>.Build.Dense(new double[] { UpCameraPutResults[0].X, UpCameraPutResults[0].Y });
  1866. var p0 = toolCoord.GetTool0Coord(pn, angle);
  1867. point.X_Position = (float)p0[0];
  1868. point.Y_Position = (float)p0[1];
  1869. point.U_Position = (float)angle;
  1870. PlaceActualCoord = new OpenCvSharp.Point3f(point.X_Position, point.Y_Position, point.U_Position);
  1871. SendTaskMessage($"点:1,{point.X_Position:F3},{point.Y_Position:F4},{point.U_Position:F4}", MessageLevel.Info);
  1872. await point.WriteToPlcAddress(addressConfig.Out_Screw, plc);
  1873. await plc.WriteNodeAsync(addressConfig.Out_WorkNum.Address, (Int16)1);
  1874. await plc.WriteNodeAsync(addressConfig.Out_CameraDone.Address, (Int16)1);
  1875. }
  1876. else
  1877. {
  1878. SendTaskMessage($"多相机坐标合并请求已结束或被取消,state={state}", MessageLevel.Alarm);
  1879. await plc.WriteNodeAsync(addressConfig.Out_CameraDone.Address, (Int16)0);
  1880. }
  1881. }
  1882. }
  1883. // 螺丝供料器螺丝递减
  1884. else if (addressConfig.In_PickINC.Address.Contains(tuple.nodeId))
  1885. {
  1886. if (tuple.value is Int16 state)
  1887. {
  1888. if (_LastPickINC != state)
  1889. {
  1890. _LastPickINC = state;
  1891. }
  1892. else
  1893. {
  1894. return;
  1895. }
  1896. if (state != 0)
  1897. {
  1898. SendTaskMessage($"螺丝供料器...", MessageLevel.Info);
  1899. await plc.WriteNodeAsync(addressConfig.In_PickINC.Address, (Int16)0);
  1900. }
  1901. }
  1902. }
  1903. else
  1904. {
  1905. // 过站检查
  1906. for (int i = 0; i < 10; i++)
  1907. {
  1908. if (string.Format(addressConfig.In_MesCheck.Address, i).Contains(tuple.nodeId))
  1909. {
  1910. if (tuple.value is Int16 state)
  1911. {
  1912. if (_LastMesCheck[i] != state)
  1913. {
  1914. _LastMesCheck[i] = state;
  1915. }
  1916. else
  1917. {
  1918. return;
  1919. }
  1920. var code = plc.ReadNode<string>(string.Format(addressConfig.In_Code.Address, i));
  1921. if (state == 1)
  1922. {
  1923. //这里缺少从MES获取产品配方的内容,需要补充
  1924. _LastMesCheckTime[i] = DateTime.UtcNow;
  1925. (bool isSuccess, string response) = await _mesService.StationGetAsync(code, 2);
  1926. if (i == 0)
  1927. {
  1928. SendTaskMessage($"收到当前过站检查请求(当站是否生产)...", MessageLevel.Debug);
  1929. }
  1930. else
  1931. {
  1932. SendTaskMessage($"收到{i}过站检查请求(当站是否生产)...", MessageLevel.Debug);
  1933. }
  1934. if (isSuccess)
  1935. {
  1936. //产品发生改变并且供料器发生了变化时,需要通知PLC进行取料更改
  1937. await plc.WriteNodeAsync(addressConfig.Out_ScrewFeederIsChanged.Address, (Int16)1); //不发生改变
  1938. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)1);
  1939. return;
  1940. }
  1941. else
  1942. {
  1943. //产品发生改变并且供料器发生了变化时,需要通知PLC进行取料更改
  1944. await plc.WriteNodeAsync(addressConfig.Out_ScrewFeederIsChanged.Address, (Int16)1); //不发生改变
  1945. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)0);
  1946. return;
  1947. }
  1948. }
  1949. // 上传本站数据
  1950. else if (state == 2)
  1951. {
  1952. SendTaskMessage($"收到{i}上传本站数据请求...", MessageLevel.Debug);
  1953. //这里缺少上传MES的本站数据结果及开始和结束时间,需要补充
  1954. double ct = DateTime.UtcNow.Subtract(_LastMesCheckTime[i]).TotalSeconds;
  1955. if (i == 0)
  1956. {
  1957. CTtime = ct;
  1958. }
  1959. //读取产品结果
  1960. Int16 resultIndex = plc.ReadNode<Int16>(string.Format(addressConfig.In_Result.Address,i));
  1961. //读取压力值
  1962. float pressure = plc.ReadNode<float>(string.Format(addressConfig.In_PressureValue.Address, i));
  1963. AssemblyRecord assemblyRecord = new AssemblyRecord();
  1964. assemblyRecord.ProductSN = code;
  1965. assemblyRecord.RecipeName = currentProduct.Name;
  1966. assemblyRecord.PartSN = PartSN;
  1967. assemblyRecord.AssemblyDurationSeconds = ct;
  1968. assemblyRecord.AssemblyPressure = pressure;
  1969. assemblyRecord.DeviceId = i;
  1970. assemblyRecord.DeviceName = $"";
  1971. assemblyRecord.OperatorName = _systemDatabaseService.GetCurrentUser().UserName;
  1972. assemblyRecord.Success = resultIndex == 1 ? true : false;
  1973. assemblyRecord.DownCameraCoord1 = "";
  1974. assemblyRecord.DownCameraCoord2 = "";
  1975. assemblyRecord.DownCameraCoord3 = "";
  1976. assemblyRecord.DownCameraCoord4 = "";
  1977. assemblyRecord.PickMoveCameraCoord = "";
  1978. assemblyRecord.PlaceMoveCameraCoord1 = "";
  1979. assemblyRecord.PlaceMoveCameraCoord2 = "";
  1980. assemblyRecord.PlaceMoveCameraCoord3 = "";
  1981. assemblyRecord.PlaceMoveCameraCoord4 = "";
  1982. assemblyRecord.PlaceActualCoord = "";
  1983. //目前只记录当前站
  1984. if (i == 0)
  1985. {
  1986. await _systemDatabaseService.RecordProductionAsync(new ProductionRecord()
  1987. {
  1988. ProductName = currentProduct.Name,
  1989. ProductCode = code,
  1990. DeviceId = i,
  1991. DeviceName = "",
  1992. Category = resultIndex == 1 ? "OK" : "NG",
  1993. Quantity = 1,
  1994. Remark = $"TotalSeconds:{ct.ToString("F2")}",
  1995. UserName = _systemDatabaseService.GetCurrentUser().UserName,
  1996. });
  1997. assemblyRecord.PlaceMoveCameraCoord1 = $"{UpCameraPutResults[0].X:F3},{UpCameraPutResults[0].Y:F3},{UpCameraPutResults[0].Z:F3}";
  1998. assemblyRecord.PlaceMoveCameraCoord2 = $"{UpCameraPutResults[1].X:F3},{UpCameraPutResults[1].Y:F3},{UpCameraPutResults[1].Z:F3}";
  1999. assemblyRecord.PlaceActualCoord = $"{PlaceActualCoord.X:F3},{PlaceActualCoord.Y:F3},{PlaceActualCoord.Z:F3}";
  2000. App.Current.Dispatcher.Invoke(() =>
  2001. {
  2002. _eventAggregator.GetEvent<AssemblyFinishNotification>().Publish(assemblyRecord);
  2003. });
  2004. }
  2005. await _systemDatabaseService.RecordAssemblyAsync(assemblyRecord);
  2006. (bool isSuccess, string response) = await _mesService.SubmitGetAsync(code, resultIndex == 1 ? true : false, _LastMesCheckTime[i], DateTime.UtcNow);
  2007. //假设上传成功,这里缺少上传失败的处理
  2008. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)3);
  2009. return;
  2010. }
  2011. else
  2012. {
  2013. SendTaskMessage($"{i}过站检查信号:state={state},处理为默认状态", MessageLevel.Alarm);
  2014. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)0);
  2015. return;
  2016. }
  2017. }
  2018. }
  2019. }
  2020. //开始/停止 组装/锁附
  2021. for (int i = 0; i < 7; i++)
  2022. {
  2023. //开始组装
  2024. if (string.Format(addressConfig.In_WorkStart.Address, i).Contains(tuple.nodeId))
  2025. {
  2026. if (tuple.value is Int16 state)
  2027. {
  2028. if (_LastWorkStart[i] != state)
  2029. {
  2030. _LastWorkStart[i] = state;
  2031. }
  2032. else
  2033. {
  2034. return;
  2035. }
  2036. if (state == 1)
  2037. {
  2038. SendTaskMessage($"收到开始组装信号[{i}]...", MessageLevel.Debug);
  2039. var code = plc.ReadNode<string>(string.Format(addressConfig.In_Code.Address, i));
  2040. // 开始采集压力值
  2041. StartPressureCollection(currentProduct.Name, code, i);
  2042. }
  2043. else
  2044. {
  2045. SendTaskMessage($"开始锁付信号[{i}]已关闭", MessageLevel.Alarm);
  2046. // 关闭时的处理(如需)可放在这里
  2047. }
  2048. }
  2049. }
  2050. //停止组装
  2051. else if (string.Format(addressConfig.In_WorkStart.Address, i).Contains(tuple.nodeId))
  2052. {
  2053. if (tuple.value is Int16 state)
  2054. {
  2055. if (_LastWorkDone[i] != state)
  2056. {
  2057. _LastWorkDone[i] = state;
  2058. }
  2059. else
  2060. {
  2061. return;
  2062. }
  2063. if (state == 1 || state == 2)
  2064. {
  2065. SendTaskMessage($"收到停止锁付信号[{i}]...", MessageLevel.Debug);
  2066. //获取当前锁付点
  2067. //var screwPoint = currentProduct.ScrewPoints.FirstOrDefault(p => p.Number == positionIndex);
  2068. ////获取当前的机器人点位
  2069. //var robot = _robotService.GetAllRobots().FirstOrDefault();
  2070. //var currentPosition = robot.GetRobotPos();
  2071. ////读取压力值
  2072. //float pressure = plc.ReadNode<float>(addressConfig.In_PressureValue.Address);
  2073. //await Task.Delay(60);
  2074. ////获取电批结果
  2075. //bool isSucced = ScrewDriver.GetData();
  2076. //LockResult lockResult = new LockResult();
  2077. //lockResult.ScrewdriverGetDataSucceed = isSucced;
  2078. //lockResult.Number = positionIndex;
  2079. //lockResult.LockPassed = ScrewDriver.Success;
  2080. //lockResult.ProductNumber = _productService.CurrentProductCode;
  2081. //lockResult.LockTurns = (float)ScrewDriver.Truns;
  2082. //lockResult.LockTorque = (float)ScrewDriver.TorqueValue;
  2083. //lockResult.LockDuration = (float)ScrewDriver.FinalTime;
  2084. //lockResult.ScrewdriverProgramNumber = ScrewDriver.ProgramNumber;
  2085. //lockResult.ResultDetails = ScrewDriver.ErrorInfo;
  2086. //lockResult.Pressure = pressure;
  2087. //lockResult.TargetTorque = ScrewDriver.TargetTorque;
  2088. //lockResult.TargetTurnsUpperLimit = ScrewDriver.TargetTurnsUpperLimit;
  2089. //lockResult.TargetTurnsLowerLimit = ScrewDriver.TargetTurnsLowerLimit;
  2090. //lockResult.TargetLockSpeed = ScrewDriver.TargetLockSpeed;
  2091. //lockResult.StartPositionX = currentPosition.X;
  2092. //lockResult.StartPositionY = currentPosition.Y;
  2093. //lockResult.StartPositionZ = screwPoint.Z_Position_Start;
  2094. //lockResult.EndPositionZ = currentPosition.Z;
  2095. //lockResult.LockDescentSpeed = screwPoint.Z_Velocity_Stop;
  2096. //lockResult.FeederNumber = screwPoint != null ? screwPoint.Feeder : 0;
  2097. //lockResult.NozzleNumber = "";
  2098. //lockResult.OperatorName = _systemDatabaseService.GetCurrentUser().UserName;
  2099. //lockResult.ProductImagePath = "";
  2100. //lockResult.WaveDatas = ScrewDriver.WaveDatas;
  2101. //App.Current.Dispatcher.Invoke(() =>
  2102. //{
  2103. // _eventAggregator.GetEvent<LockFinishNotification>().Publish(lockResult);
  2104. //});
  2105. //await _systemDatabaseService.RecordLockResultAsync(lockResult);
  2106. await plc.WriteNodeAsync(addressConfig.In_WorkDone.Address, (Int16)0);
  2107. var code = plc.ReadNode<string>(string.Format(addressConfig.In_Code.Address, i));
  2108. // 停止采集压力并保存
  2109. await StopAndSavePressureCollectionAsync(currentProduct.Name, code, i);
  2110. }
  2111. else
  2112. {
  2113. SendTaskMessage($"停止锁付信号[{i}]已关闭", MessageLevel.Alarm);
  2114. }
  2115. }
  2116. }
  2117. }
  2118. }
  2119. }
  2120. catch (Exception ex)
  2121. {
  2122. SendTaskMessage(ex.Message, MessageLevel.Error);
  2123. }
  2124. }
  2125. #endregion
  2126. #region 方法
  2127. private void SendTaskMessage(string msg, MessageLevel level)
  2128. {
  2129. App.Current.Dispatcher.Invoke(() =>
  2130. {
  2131. _eventAggregator.GetEvent<TaskMessageNotification>().Publish(new Models.MessageStruct() { Message = msg, level = level });
  2132. });
  2133. }
  2134. #region Pressure collection helpers
  2135. /// <summary>
  2136. /// 开始采集压力值
  2137. /// </summary>
  2138. /// <param name="productName">配方名称</param>
  2139. /// <param name="productCode">产品编号</param>
  2140. /// <param name="Index">编号</param>
  2141. private void StartPressureCollection(string productName, string productCode, int Index)
  2142. {
  2143. try
  2144. {
  2145. // cancel existing if any
  2146. _pressureCts[Index]?.Cancel();
  2147. _pressureTimeoutCts[Index]?.Cancel();
  2148. _pressureLinkedCts[Index]?.Dispose();
  2149. _pressureSamples[Index]?.Clear();
  2150. _pressureCts[Index] = new CancellationTokenSource();
  2151. _pressureTimeoutCts[Index] = new CancellationTokenSource();
  2152. // timeout after configured seconds
  2153. _pressureTimeoutCts[Index].CancelAfter(TimeSpan.FromSeconds(_pressureMaxDurationSeconds));
  2154. // link tokens so either stop or timeout cancels
  2155. _pressureLinkedCts[Index] = CancellationTokenSource.CreateLinkedTokenSource(_pressureCts[Index].Token, _pressureTimeoutCts[Index].Token);
  2156. var token = _pressureLinkedCts[Index].Token;
  2157. var addressConfig = _configService.GetPlcAddresses();
  2158. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  2159. if (plc == null || !plc.IsConnected) return;
  2160. Task.Run(async () =>
  2161. {
  2162. SendTaskMessage($"Pressure collection started for position {Index}", MessageLevel.Debug);
  2163. while (!token.IsCancellationRequested)
  2164. {
  2165. try
  2166. {
  2167. float pressure = plc.ReadNode<float>(string.Format(addressConfig.In_PressureValue.Address, Index));
  2168. lock (_pressureSamples[Index])
  2169. {
  2170. _pressureSamples[Index].Add((DateTime.Now, pressure));
  2171. }
  2172. }
  2173. catch (Exception ex)
  2174. {
  2175. LogHelper.WriteLogError("采集压力值时出错", ex);
  2176. }
  2177. await Task.Delay(_pressureSampleIntervalMs);
  2178. }
  2179. // if cancelled due to timeout
  2180. if (_pressureTimeoutCts[Index].IsCancellationRequested && !_pressureCts[Index].IsCancellationRequested)
  2181. {
  2182. SendTaskMessage("Pressure collection timed out, saving collected data.", MessageLevel.Alarm);
  2183. await StopAndSavePressureCollectionAsync(productName, productCode, Index);
  2184. }
  2185. }, token);
  2186. }
  2187. catch (Exception ex)
  2188. {
  2189. LogHelper.WriteLogError("StartPressureCollection error", ex);
  2190. }
  2191. }
  2192. /// <summary>
  2193. /// 停止采集并保存压力数据
  2194. /// </summary>
  2195. /// <param name="productName"></param>
  2196. /// <param name="productCode"></param>
  2197. /// <param name="positionIndex"></param>
  2198. /// <returns></returns>
  2199. private async Task StopAndSavePressureCollectionAsync(string productName, string productCode, int Index)
  2200. {
  2201. try
  2202. {
  2203. // cancel sampling
  2204. _pressureCts[Index]?.Cancel();
  2205. // allow worker to observe cancel
  2206. await Task.Delay(50);
  2207. List<(DateTime Timestamp, float Value)> snapshot;
  2208. lock (_pressureSamples[Index])
  2209. {
  2210. snapshot = new List<(DateTime, float)>(_pressureSamples[Index]);
  2211. }
  2212. if (snapshot.Count == 0)
  2213. {
  2214. SendTaskMessage("No pressure samples collected.", MessageLevel.Info);
  2215. return;
  2216. }
  2217. // save to file under configured path
  2218. try
  2219. {
  2220. //获取系统参数
  2221. var systemConfig = _configService.GetSystemConfiguration();
  2222. if (systemConfig.PressureSensorConfig == null || systemConfig.PressureSensorConfig.Count <= 0)
  2223. {
  2224. SendTaskMessage("当前没有配置任何压力传感器!", MessageLevel.Alarm);
  2225. return;
  2226. }
  2227. //获取当前压力传感器配置
  2228. var pressureSensorConfig = systemConfig.PressureSensorConfig.FirstOrDefault(p => p.SensorId == Index);
  2229. if (pressureSensorConfig == null)
  2230. {
  2231. SendTaskMessage($"当前压力传感器配置不存在!- {Index}", MessageLevel.Alarm);
  2232. return;
  2233. }
  2234. //PressureFinishNotification : Prism.Events.PubSubEvent<(bool IsSuccess, int Index, (DateTime Timestamp, float Value)[] values,string SavePath )>
  2235. string basePath = pressureSensorConfig?.PressureCurvePath ?? Environment.GetFolderPath(Environment.SpecialFolder.MyDocuments);
  2236. string datePath = DateTime.Now.ToString("yyyy-MM") + "\\" + DateTime.Now.ToString("yyyy-MM-dd") + "\\";
  2237. string dirPath = Path.Combine(basePath, datePath, productName ?? "UnknownProduct", productCode ?? DateTime.Now.ToString("yyyyMMddHHmmssfff"));
  2238. if (!Directory.Exists(dirPath)) Directory.CreateDirectory(dirPath);
  2239. string csvfileName = $"pressure-{productCode}-{Index}-{DateTime.Now.ToString("HHmmss")}.csv";
  2240. string csvPath = Path.Combine(dirPath, csvfileName);
  2241. string pngfileName = $"pressure-{productCode}-{Index}-{DateTime.Now.ToString("HHmmss")}.png";
  2242. string pngPath = Path.Combine(dirPath, pngfileName);
  2243. if (!pressureSensorConfig.IsSavePressureCurve)
  2244. {
  2245. csvPath = string.Empty;
  2246. pngPath = string.Empty;
  2247. }
  2248. App.Current.Dispatcher.Invoke(() =>
  2249. {
  2250. _eventAggregator.GetEvent<PressureFinishNotification>().Publish((true, Index, snapshot.ToArray(), pngPath));
  2251. });
  2252. //判断是否保存锁付曲线
  2253. if (pressureSensorConfig.IsSavePressureCurve)
  2254. {
  2255. if (!string.IsNullOrEmpty(csvPath))
  2256. {
  2257. var sb = new StringBuilder();
  2258. sb.AppendLine("Timestamp,Value");
  2259. foreach (var s in snapshot)
  2260. {
  2261. sb.AppendLine($"{s.Timestamp:O},{s.Value}");
  2262. }
  2263. File.WriteAllText(csvPath, sb.ToString());
  2264. SendTaskMessage($"Pressure samples saved to {csvPath}", MessageLevel.Debug);
  2265. }
  2266. }
  2267. }
  2268. catch (Exception ex)
  2269. {
  2270. LogHelper.WriteLogError("保存压力采样文件时出错", ex);
  2271. SendTaskMessage("保存压力采样文件时出错: " + ex.Message, MessageLevel.Error);
  2272. }
  2273. }
  2274. catch (Exception ex)
  2275. {
  2276. LogHelper.WriteLogError("StopAndSavePressureCollectionAsync error", ex);
  2277. }
  2278. finally
  2279. {
  2280. try
  2281. {
  2282. _pressureLinkedCts[Index]?.Cancel();
  2283. _pressureLinkedCts[Index]?.Dispose();
  2284. _pressureTimeoutCts[Index]?.Dispose();
  2285. _pressureCts[Index]?.Dispose();
  2286. _pressureSamples[Index]?.Clear();
  2287. }
  2288. catch { }
  2289. }
  2290. }
  2291. #endregion
  2292. private async void DoYieldTime(object state)
  2293. {
  2294. try
  2295. {
  2296. //获取当前产品
  2297. var currentproduct = _productService.GetCurrentProduct();
  2298. if (currentproduct == null) return;
  2299. TotalQuantity = await _systemDatabaseService.GetOverallProductionAsync(currentproduct.Name);
  2300. TotalQuantityToday = await _systemDatabaseService.GetTodayProductionAsync(currentproduct.Name);
  2301. CurrentUPH = await _systemDatabaseService.GetLastHourProductionAsync(currentproduct.Name);
  2302. }
  2303. catch (Exception)
  2304. {
  2305. }
  2306. }
  2307. #region vm启动检测
  2308. /// <summary>
  2309. /// 杀死所有VM有关进程
  2310. /// </summary>
  2311. public void KillVMProcess()
  2312. {
  2313. KillProcess("VisionMasterServerApp");
  2314. KillProcess("VisionMaster");
  2315. KillProcess("VmModuleProxy.exe");
  2316. KillProcess("vServerApp.exe");
  2317. }
  2318. /// <summary>
  2319. /// 杀死指定进程名的进程
  2320. /// </summary>
  2321. /// <param name="strKillName"></param>
  2322. public void KillProcess(string strKillName)
  2323. {
  2324. foreach (System.Diagnostics.Process p in System.Diagnostics.Process.GetProcesses())
  2325. {
  2326. if (p.ProcessName.Contains(strKillName))
  2327. {
  2328. try
  2329. {
  2330. p.Kill();
  2331. p.WaitForExit();
  2332. }
  2333. catch (Exception ex)
  2334. {
  2335. LogHelper.WriteLogError($"杀死进程:{strKillName}时失败!", ex);
  2336. }
  2337. }
  2338. }
  2339. }
  2340. #endregion
  2341. #endregion
  2342. }
  2343. }