Management.cs 93 KB

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