Management.cs 124 KB

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