Management.cs 179 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437
  1. using MathNet.Numerics.LinearAlgebra;
  2. using Prism.Events;
  3. using Prism.Ioc;
  4. using Prism.Mvvm;
  5. using Prism.Regions;
  6. using System;
  7. using System.Collections.Generic;
  8. using System.Collections.ObjectModel;
  9. using System.Drawing;
  10. using System.IO;
  11. using System.IO.Compression;
  12. using System.Linq;
  13. using System.Net.Sockets;
  14. using System.Text;
  15. using System.Threading;
  16. using System.Threading.Tasks;
  17. using System.Windows.Media;
  18. using Team.FFFeederService.Interfaces;
  19. using TeamAAS_VP.Core.PLCs;
  20. using TeamAAS_VP.Core.ScrewDriver;
  21. using TeamAAS_VP.Enums;
  22. using TeamAAS_VP.Events;
  23. using TeamAAS_VP.Interfaces;
  24. using TeamAAS_VP.Models;
  25. using TeamAAS_VP.Resources.Languages;
  26. using TouchSocket.Core;
  27. using TouchSocket.SerialPorts;
  28. using TouchSocket.Sockets;
  29. namespace TeamAAS_VP.Core
  30. {
  31. public class Management : BindableBase
  32. {
  33. #region 字段
  34. IRegionManager _regionManager;
  35. IEventAggregator _eventAggregator;
  36. IContainerProvider _container;
  37. IConfigService _configService;
  38. IRobotService _robotService;
  39. ICameraService _cameraService;
  40. IFeederService _feederService;
  41. IPlcService _plcService;
  42. ILightManagerService _lightManagerService;
  43. IProductService _productService;
  44. ICalibrationService _calibrationService;
  45. IRemoteCommandService _remoteCommandService;
  46. ISystemDatabaseService _systemDatabaseService;
  47. IMesService _mesService;
  48. Timer yieldtimer;
  49. private DateTime StartTime = DateTime.Now;
  50. // Pressure collection
  51. /// <summary>
  52. /// 压力采集信号控制CTS
  53. /// </summary>
  54. private CancellationTokenSource[] _pressureCts = new CancellationTokenSource[10];
  55. /// <summary>
  56. /// 压力采集超时CTS
  57. /// </summary>
  58. private CancellationTokenSource[] _pressureTimeoutCts = new CancellationTokenSource[10];
  59. /// <summary>
  60. /// 压力采集CTS
  61. /// </summary>
  62. private CancellationTokenSource[] _pressureLinkedCts = new CancellationTokenSource[10];
  63. /// <summary>
  64. /// 压力数据集合
  65. /// </summary>
  66. private List<(DateTime Timestamp, float Value)>[] _pressureSamples = new List<(DateTime, float)>[10];
  67. /// <summary>
  68. /// 采样间隔毫秒
  69. /// </summary>
  70. private int _pressureSampleIntervalMs = 50; //采样间隔毫秒
  71. /// <summary>
  72. /// 超时自动停止秒数
  73. /// </summary>
  74. private int _pressureMaxDurationSeconds = 30; //超时自动停止秒数
  75. DateTime StartCtqTime = DateTime.Now;//开始采集Ctq数据的时间
  76. /// <summary>
  77. /// 上次执行上传csv的日期
  78. /// </summary>
  79. private DateTime _lastCompressDate = DateTime.MinValue;
  80. /// <summary>
  81. /// 当天是否上传过csv
  82. /// </summary>
  83. private bool _hasCompressedToday = false;
  84. #endregion
  85. #region 属性
  86. private System.Windows.Media.Brush _StatusBackground;
  87. public System.Windows.Media.Brush StatusBackground
  88. {
  89. get { return _StatusBackground; }
  90. set { SetProperty(ref _StatusBackground, value); }
  91. }
  92. private ObservableCollection<ShowRender> _Renders;
  93. /// <summary>
  94. /// 显示界面
  95. /// </summary>
  96. public ObservableCollection<ShowRender> Renders
  97. {
  98. get { return _Renders; }
  99. set { SetProperty(ref _Renders, value); }
  100. }
  101. public BgCommunicate BgCommunicate { get; private set; }
  102. public BgModbusTcpCommunicate BgModbusTcpCommunicate { get; private set; }
  103. private ObservableCollection<StatusInfo> _Status = new ObservableCollection<StatusInfo>();
  104. /// <summary>
  105. /// 状态栏集合
  106. /// </summary>
  107. public ObservableCollection<StatusInfo> Status
  108. {
  109. get { return _Status; }
  110. set { SetProperty(ref _Status, value); }
  111. }
  112. private Int64 _TotalQuantity;
  113. /// <summary>
  114. /// 总产量
  115. /// </summary>
  116. public Int64 TotalQuantity
  117. {
  118. get { return _TotalQuantity; }
  119. set { SetProperty(ref _TotalQuantity, value); }
  120. }
  121. private Int64 _TotalQuantityToday;
  122. /// <summary>
  123. /// 当天的总产量
  124. /// </summary>
  125. public Int64 TotalQuantityToday
  126. {
  127. get { return _TotalQuantityToday; }
  128. set { SetProperty(ref _TotalQuantityToday, value); }
  129. }
  130. private Int64 _CurrentUPH;
  131. /// <summary>
  132. /// 当前的UPH
  133. /// </summary>
  134. public Int64 CurrentUPH
  135. {
  136. get { return _CurrentUPH; }
  137. set { SetProperty(ref _CurrentUPH, value); }
  138. }
  139. private SerialPortClient _Scan_Client;
  140. public SerialPortClient Scan_Client
  141. {
  142. get { return _Scan_Client; }
  143. set { _Scan_Client = value; }
  144. }
  145. private XYD_ScrewDriver _ScrewDriver;
  146. public XYD_ScrewDriver ScrewDriver
  147. {
  148. get { return _ScrewDriver; }
  149. set { SetProperty(ref _ScrewDriver, value); }
  150. }
  151. public Dictionary<string, object> BackupObject { get; set; } = new Dictionary<string, object>();
  152. private double _CTtime;
  153. /// <summary>
  154. /// ct
  155. /// </summary>
  156. public double CTtime
  157. {
  158. get { return _CTtime; }
  159. set { SetProperty(ref _CTtime, value); }
  160. }
  161. private ObservableCollection<DataFormCtq> _dfc = new ObservableCollection<DataFormCtq>();
  162. /// <summary>
  163. /// CTQ数据集合
  164. /// </summary>
  165. public ObservableCollection<DataFormCtq> DFC
  166. {
  167. get { return _dfc; }
  168. set { SetProperty(ref _dfc, value); }
  169. }
  170. private Int64 _ThrowNumber;
  171. /// <summary>
  172. /// 抛料数
  173. /// </summary>
  174. public Int64 ThrowNumber
  175. {
  176. get { return _ThrowNumber; }
  177. set { SetProperty(ref _ThrowNumber, value); }
  178. }
  179. private Int64 _NgNumber;
  180. /// <summary>
  181. /// ng数量
  182. /// </summary>
  183. public Int64 NgNumber
  184. {
  185. get { return _NgNumber; }
  186. set { SetProperty(ref _NgNumber, value); }
  187. }
  188. private double _Yield;
  189. /// <summary>
  190. /// 良率
  191. /// </summary>
  192. public double Yield
  193. {
  194. get { return _Yield; }
  195. set { SetProperty(ref _Yield, value); }
  196. }
  197. private ObservableCollection<ProductModel> _ProductList;
  198. public ObservableCollection<ProductModel> ProductList
  199. {
  200. get { return _ProductList; }
  201. set { SetProperty(ref _ProductList, value); }
  202. }
  203. #endregion
  204. #region 命令
  205. #endregion
  206. #region 事件
  207. #endregion
  208. public Management(IRegionManager regionManager, IEventAggregator ea, IContainerProvider container, IConfigService configService,
  209. IRobotService robotService, ICameraService cameraService, IFeederService feederService, IPlcService plcService, IProductService productService,
  210. ICalibrationService calibrationService, IRemoteCommandService remoteCommandService, ISystemDatabaseService systemDatabaseService, ILightManagerService lightManagerService,
  211. IMesService mesService)
  212. {
  213. _regionManager = regionManager;
  214. _eventAggregator = ea;
  215. _container = container;
  216. _configService = configService;
  217. _robotService = robotService;
  218. _cameraService = cameraService;
  219. _feederService = feederService;
  220. _plcService = plcService;
  221. _calibrationService = calibrationService;
  222. yieldtimer = new Timer(DoYieldTime, null, 10000, 1000);
  223. Renders = new ObservableCollection<ShowRender>();
  224. _configService = configService;
  225. _productService = productService;
  226. _remoteCommandService = remoteCommandService;
  227. _systemDatabaseService = systemDatabaseService;
  228. _lightManagerService = lightManagerService;
  229. _mesService = mesService;
  230. InitPressure();
  231. }
  232. #region 初始化硬件模块
  233. /// <summary>
  234. /// 初始化Feeder
  235. /// </summary>
  236. /// <returns></returns>
  237. public async Task<(bool IsSucceed, string Msg)> InitFeeders()
  238. {
  239. var feeders = _configService.GetAllFeeders();
  240. StringBuilder sb = new StringBuilder();
  241. foreach (var item in feeders)
  242. {
  243. _feederService.CreateFeeder(item.Id, item.FeederNo, item.FeederName, item.IP, item.Port, item.FeederBrand);
  244. var feeder = _feederService.GetFeeder(item.Id);
  245. Status.Add(new StatusInfo(item.Id, item.FeederName + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
  246. try
  247. {
  248. feeder.FeederConnectionStatusChanged += Management_FeederConnectionStatusChanged;
  249. await feeder.ConnectAsync(); //连接Feeder
  250. //SendTaskMessage($"{item.FeederName}已连接!", MessageLevel.Debug);
  251. }
  252. catch (Exception ex)
  253. {
  254. sb.AppendLine($"{item.FeederName}:{Lang.断开连接}![{ex.Message}]");
  255. SendTaskMessage($"{item.FeederName}{Lang.断开连接}!", MessageLevel.Alarm);
  256. }
  257. }
  258. if (sb.Length == 0)
  259. {
  260. return (true, "");
  261. }
  262. else
  263. {
  264. return (false, sb.ToString());
  265. }
  266. }
  267. /// <summary>
  268. /// 初始化机器人
  269. /// </summary>
  270. /// <returns></returns>
  271. public async Task<(bool IsSucceed, string Msg)> InitRobots()
  272. {
  273. var robots = _configService.GetAllRobots();
  274. StringBuilder sb = new StringBuilder();
  275. foreach (var item in robots)
  276. {
  277. _robotService.CreateRobot(item.Id, item);
  278. try
  279. {
  280. Status.Add(new StatusInfo(item.Id, item.RobotName + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
  281. var robot = _robotService.GetRobot(item.Id);
  282. robot.ReceivedEvent += Management_ReceivedEvent;
  283. robot.SendEvent += Management_SendEvent;
  284. robot.ConnectedEvent += Management_ConnectedEvent;
  285. robot.DisconnectedEvent += Management_DisconnectedEvent;
  286. await robot.ConnectAsync(); //连接Robot
  287. SendTaskMessage($"{item.RobotName}{Lang.已连接}!", MessageLevel.Debug);
  288. }
  289. catch (Exception ex)
  290. {
  291. sb.AppendLine($"{item.RobotName}:{Lang.断开连接}![{ex.Message}]");
  292. SendTaskMessage($"{item.RobotName}{Lang.断开连接}!", MessageLevel.Alarm);
  293. }
  294. }
  295. if (sb.Length == 0)
  296. {
  297. return (true, "");
  298. }
  299. else
  300. {
  301. return (false, sb.ToString());
  302. }
  303. }
  304. /// <summary>
  305. /// 初始化PLC
  306. /// </summary>
  307. /// <returns></returns>
  308. public async Task<(bool IsSucceed, string Msg)> InitPlc()
  309. {
  310. var plcs = _configService.GetAllPlcs();
  311. StringBuilder sb = new StringBuilder();
  312. foreach (var item in plcs)
  313. {
  314. try
  315. {
  316. _plcService.CreatePlc(item.Id, item);
  317. var plc = _plcService.GetPlc(item.Id);
  318. Status.Add(new StatusInfo(item.Id, item.Name + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
  319. plc.ConnectChangedEvent += Management_PlcConnectChangedEvent;
  320. await plc.ConnectAsync(); //连接PLC
  321. //SendTaskMessage($"{item.Name}{Lang.已连接}!", MessageLevel.Debug);
  322. }
  323. catch (Exception ex)
  324. {
  325. sb.AppendLine($"{item.Name}:{Lang.断开连接}![{ex.Message}]");
  326. SendTaskMessage($"{item.Name}{Lang.断开连接}!", MessageLevel.Alarm);
  327. }
  328. }
  329. try
  330. {
  331. await WriteSystemParameterToPlcAsync(_configService.GetSystemConfiguration());
  332. RegisterPlcMonitorAddress();
  333. }
  334. catch (Exception ex)
  335. {
  336. LogHelper.WriteLogError("为PLC写入系统参数和订阅变量时出错", ex);
  337. }
  338. if (sb.Length == 0)
  339. {
  340. return (true, "");
  341. }
  342. else
  343. {
  344. return (false, sb.ToString());
  345. }
  346. }
  347. /// <summary>
  348. /// 初始化相机
  349. /// </summary>
  350. /// <returns></returns>
  351. public async Task<(bool IsSucceed, string Msg)> InitCameras()
  352. {
  353. var cameras = _configService.GetAllCameras();
  354. StringBuilder sb = new StringBuilder();
  355. foreach (var item in cameras)
  356. {
  357. try
  358. {
  359. //Renders.Add(new ShowRender() { Id = item.Id, CameraName = item.CameraName });
  360. _cameraService.CreateCamera(item.Id, item);
  361. var camera = _cameraService.GetCamera(item.Id);
  362. Status.Add(new StatusInfo(item.Id, item.CameraName + $"{Lang.未连接}", new SolidColorBrush(Colors.Red)));
  363. camera.CameraConnectChangedEvent += Management_CameraConnectChangedEvent;
  364. try
  365. {
  366. if (await camera.OpenDeviceAsync())
  367. {
  368. SendTaskMessage($"{item.CameraName}{Lang.已连接}!", MessageLevel.Debug);
  369. }
  370. else
  371. {
  372. SendTaskMessage($"{item.CameraName}{Lang.连接失败}!", MessageLevel.Alarm);
  373. sb.AppendLine($"{item.CameraName}:{Lang.连接失败}!");
  374. }
  375. }
  376. catch (Exception ex)
  377. {
  378. SendTaskMessage($"{item.CameraName}{ex.Message}!", MessageLevel.Alarm);
  379. sb.AppendLine($"{item.CameraName}:{ex.Message}!");
  380. }
  381. }
  382. catch (Exception ex)
  383. {
  384. SendTaskMessage($"{item.CameraName}{Lang.连接失败}!", MessageLevel.Alarm);
  385. sb.AppendLine($"{item.CameraName}:{Lang.连接失败}!:{ex.Message}");
  386. }
  387. }
  388. if (sb.Length == 0)
  389. {
  390. return (true, "");
  391. }
  392. else
  393. {
  394. return (false, sb.ToString());
  395. }
  396. }
  397. /// <summary>
  398. /// 初始化光源控制器
  399. /// </summary>
  400. /// <returns></returns>
  401. public async Task<(bool IsSucceed, string Msg)> InitLightControllers()
  402. {
  403. var lightcontrollers = _configService.GetAllLightControllers();
  404. StringBuilder sb = new StringBuilder();
  405. foreach (var item in lightcontrollers)
  406. {
  407. try
  408. {
  409. var lishtCtr = await _lightManagerService.RegisterControllerAsync(item.Id, item);
  410. //var lightcontroller = _cameraService.GetLightController(item.Id);
  411. //await lightcontroller.ConnectAsync(); //连接光源控制器
  412. //SendTaskMessage($"{item.LightControllerName}{Lang.已连接}!", MessageLevel.Debug);
  413. }
  414. catch (Exception ex)
  415. {
  416. //sb.AppendLine($"{item.LightControllerName}:{Lang.断开连接}![{ex.Message}]");
  417. //SendTaskMessage($"{item.LightControllerName}{Lang.断开连接}!", MessageLevel.Alarm);
  418. }
  419. }
  420. if (lightcontrollers.Count > 0)
  421. {
  422. var result = await _lightManagerService.ConnectAllAsync();
  423. if (result)
  424. {
  425. return (true, "");
  426. }
  427. else
  428. {
  429. return (false, "Light Controller Connect Failed!");
  430. }
  431. }
  432. return (true, "");
  433. //if (sb.Length == 0)
  434. //{
  435. // return (true, "");
  436. //}
  437. //else
  438. //{
  439. // return (false, sb.ToString());
  440. //}
  441. }
  442. /// <summary>
  443. /// 初始化后台TCP服务器通讯
  444. /// </summary>
  445. public void InitBgTcp()
  446. {
  447. var config = _configService.GetBgTcp();
  448. try
  449. {
  450. BgCommunicate = new BgCommunicate(config);
  451. BgCommunicate.ConnectedEvent += BgCommunicate_ConnectedEvent;
  452. BgCommunicate.DisconnectedEvent += BgCommunicate_DisconnectedEvent;
  453. BgCommunicate.ReceivedEvent += BgCommunicate_ReceivedEvent;
  454. BgCommunicate.SendEvent += BgCommunicate_SendEvent;
  455. BgCommunicate.StartListening();
  456. SendTaskMessage($"{Lang.已开启监听端口}:{config.Port}", MessageLevel.Debug);
  457. }
  458. catch (Exception ex)
  459. {
  460. SendTaskMessage($"{Lang.未开启监听端口}:{config.Port}", MessageLevel.Error);
  461. LogHelper.WriteLogError("开启后台服务器通讯时出错!", ex);
  462. }
  463. }
  464. /// <summary>
  465. /// 初始化后台ModbusTCP从站
  466. /// </summary>
  467. public void InitModbusTcp()
  468. {
  469. try
  470. {
  471. var config = _configService.GetBgModbusTcp();
  472. BgModbusTcpCommunicate = new BgModbusTcpCommunicate(config);
  473. if (config.IsEnabled)
  474. {
  475. BgModbusTcpCommunicate.Listen();
  476. SendTaskMessage($"Start Modbus Tcp Slave:{BgModbusTcpCommunicate.IP}:{BgModbusTcpCommunicate.Port}:{BgModbusTcpCommunicate.SlaveID}", MessageLevel.Debug);
  477. }
  478. }
  479. catch (Exception ex)
  480. {
  481. SendTaskMessage($"No Start Modbus Tcp Slave:{ex.Message}", MessageLevel.Alarm);
  482. LogHelper.WriteLogError("开启后台Modbus TCP通讯时出错!", ex);
  483. }
  484. }
  485. /// <summary>
  486. /// 初始化后台脚本
  487. /// </summary>
  488. public void InitBackgroundcript()
  489. {
  490. try
  491. {
  492. if (!Directory.Exists(FilePath.BackgroundScriptPath))
  493. {
  494. Directory.CreateDirectory(FilePath.BackgroundScriptPath);
  495. }
  496. try
  497. {
  498. string[] files = Directory.GetFiles(FilePath.BackgroundScriptPath);
  499. List<string> ScriptFilesCollection = new List<string>();
  500. foreach (string file in files)
  501. {
  502. string fileName = Path.GetFileName(file);
  503. string fileExtension = Path.GetExtension(file);
  504. if (fileExtension == ".cs")
  505. {
  506. ScriptFilesCollection.Add(file);
  507. }
  508. }
  509. foreach (var item in ScriptFilesCollection)
  510. {
  511. try
  512. {
  513. string script = FileHelper.ReadFile(item);
  514. SendTaskMessage($"{Lang.执行脚本}:{item}", MessageLevel.Info);
  515. Task.Factory.StartNew(() =>
  516. {
  517. ScriptHelper.ExecuteScriptingAsync(script, _regionManager, _eventAggregator, _container, rst =>
  518. {
  519. if (!rst.Item1)
  520. {
  521. foreach (var err in rst.Item2)
  522. {
  523. SendTaskMessage($"{Lang.后台脚本出错}:{err}", MessageLevel.Error);
  524. }
  525. }
  526. });
  527. });
  528. }
  529. catch (Exception ex)
  530. {
  531. LogHelper.WriteLogError($"开启脚本时出错:{item}", ex);
  532. }
  533. }
  534. }
  535. catch (Exception ex)
  536. {
  537. LogHelper.WriteLogError("读取本地脚本文件列表时出错", ex);
  538. }
  539. }
  540. catch (Exception ex)
  541. {
  542. LogHelper.WriteLogError("开启后台脚本时出错!", ex);
  543. }
  544. }
  545. /// <summary>
  546. /// 初始化电批
  547. /// </summary>
  548. /// <returns></returns>
  549. public async Task InitScrewDriver()
  550. {
  551. try
  552. {
  553. var screwDriverConfig = _configService.GetScrewDriverConfig();
  554. ScrewDriver = new XYD_ScrewDriver(screwDriverConfig.IPAdress, screwDriverConfig.Port);
  555. Status.Add(new StatusInfo(ScrewDriver.Id, "电批未连接", new SolidColorBrush(Colors.Red)));
  556. ScrewDriver.ConnectStateChangedEvent += ScrewDriver_ConnectStateChangedEvent;
  557. ScrewDriver.SendTimeout = screwDriverConfig.SendTimeout;
  558. screwDriverConfig.ReceiveTimeout = screwDriverConfig.ReceiveTimeout;
  559. var isConnected = await ScrewDriver.ConnectAsync();
  560. if (isConnected)
  561. {
  562. SendTaskMessage($"电批已连接", MessageLevel.Debug);
  563. }
  564. else
  565. {
  566. SendTaskMessage($"电批连接失败", MessageLevel.Error);
  567. }
  568. }
  569. catch (Exception ex)
  570. {
  571. SendTaskMessage($"电批连接失败:{ex.Message}", MessageLevel.Alarm);
  572. LogHelper.WriteLogError("连接电批时出错!", ex);
  573. }
  574. }
  575. public async Task InitScan()
  576. {
  577. if (!File.Exists(FilePath.ScanRS232ConfigPath))
  578. {
  579. var scan = new ScanRs232ConfigModel();
  580. FileHelper.WriteJsonFile(scan, FilePath.ScanRS232ConfigPath);
  581. }
  582. try
  583. {
  584. var res = FileHelper.ReadJsonFile<ScanRs232ConfigModel>(FilePath.ScanRS232ConfigPath);
  585. if (res != null)
  586. {
  587. Scan_Client = new SerialPortClient();
  588. Scan_Client.Connecting = (client1, e) => { return EasyTask.CompletedTask; };//即将连接到端口
  589. Scan_Client.Connected = (client1, e) => { return EasyTask.CompletedTask; };//成功连接到端口
  590. Scan_Client.Closing = (client1, e) => { return EasyTask.CompletedTask; };//即将从端口断开连接。此处仅主动断开才有效。
  591. Scan_Client.Closed = (client1, e) => { return EasyTask.CompletedTask; };//从端口断开连接,当连接不成功时不会触发。
  592. Scan_Client.Received = async (c, e) =>
  593. {
  594. //await Console.Out.WriteLineAsync(Encoding.UTF8.GetString(e.ByteBlock.Buffer));
  595. await Console.Out.WriteLineAsync(e.ByteBlock.Span.ToString(Encoding.ASCII));
  596. };
  597. Scan_Client.Received = Scan_DataReceived;
  598. await Scan_Client.SetupAsync(new TouchSocketConfig()
  599. .SetSerialPortOption(new SerialPortOption()
  600. {
  601. BaudRate = res.BaudRate,//波特率
  602. DataBits = res.DataBits,//数据位
  603. Parity = res.Parity,//校验位
  604. PortName = res.PortName,//COM
  605. StopBits = res.StopBits//停止位
  606. })
  607. .SetSerialDataHandlingAdapter(() => new PeriodPackageAdapter() { CacheTimeout = TimeSpan.FromMilliseconds(100) })
  608. );
  609. await Scan_Client.ConnectAsync();
  610. if (Scan_Client.Online)
  611. {
  612. SendTaskMessage($"扫码机已连接", MessageLevel.Debug);
  613. }
  614. else
  615. {
  616. SendTaskMessage($"扫码机未连接", MessageLevel.Debug);
  617. }
  618. }
  619. else
  620. {
  621. SendTaskMessage("请设置扫码机串口!", MessageLevel.Error);
  622. }
  623. }
  624. catch (Exception ex)
  625. {
  626. LogHelper.WriteLogError("初始化扫码枪时出错!", ex);
  627. SendTaskMessage("初始化扫码枪时出错!" + ex.Message, MessageLevel.Error);
  628. }
  629. }
  630. #endregion
  631. #region 机器人指令执行
  632. public Dictionary<Guid, CancellationTokenSource> RobotTCPCollection = new Dictionary<Guid, CancellationTokenSource>();
  633. /// <summary>
  634. /// 机器人TCP接收
  635. /// </summary>
  636. /// <param name="arg1"></param>
  637. /// <param name="arg2"></param>
  638. /// <param name="arg3"></param>
  639. private async void Management_ReceivedEvent(Guid robotid, object arg2, TouchSocket.Sockets.ReceivedDataEventArgs e)
  640. {
  641. try
  642. {
  643. if (!RobotTCPCollection.ContainsKey(robotid))
  644. RobotTCPCollection.Add(robotid, new CancellationTokenSource());
  645. else
  646. {
  647. if (RobotTCPCollection[robotid].IsCancellationRequested)
  648. {
  649. RobotTCPCollection[robotid] = new CancellationTokenSource();
  650. }
  651. }
  652. var robot = await _robotService.GetRobotAsync(robotid);
  653. //从服务器收到信息。但是一般byteBlock和requestInfo会根据适配器呈现不同的值。
  654. var buffer = e.ByteBlock.Span.ToString(robot.GetEncoding());
  655. SendTaskMessage($"{robot.Name}Received:{buffer}", MessageLevel.Info);
  656. var _ = _remoteCommandService.ExecuteAsync(buffer, RobotTCPCollection[robotid].Token, async msg =>
  657. {
  658. try
  659. {
  660. if (robot.ConnectType == TCPConnectType.Client)
  661. {
  662. if (robot.IsConnected)
  663. {
  664. await robot.SendAsync($"{msg}");
  665. }
  666. }
  667. else
  668. {
  669. var cient = (ITcpSessionClient)arg2;
  670. if (cient.Online)
  671. {
  672. await robot.SendAsync(cient, $"{msg}");
  673. }
  674. }
  675. }
  676. catch (Exception ex)
  677. {
  678. LogHelper.WriteLogError("TCP发送数据时出错!", ex);
  679. SendTaskMessage(ex.Message, MessageLevel.Alarm);
  680. }
  681. });
  682. }
  683. catch (Exception ex)
  684. {
  685. LogHelper.WriteLogError("处理机器人接收的命令时出错!", ex);
  686. SendTaskMessage(ex.Message, MessageLevel.Alarm);
  687. }
  688. }
  689. #endregion
  690. #region 机器人&Feeder&相机连接状态事件
  691. /// <summary>
  692. /// 机器人发送事件
  693. /// </summary>
  694. /// <param name="arg1"></param>
  695. /// <param name="arg2"></param>
  696. /// <param name="arg3"></param>
  697. /// <exception cref="NotImplementedException"></exception>
  698. private void Management_SendEvent(Guid robotid, object arg2, string arg3)
  699. {
  700. var r = _robotService.GetRobot(robotid);
  701. SendTaskMessage($"{r.Name}Send:{arg3}", MessageLevel.Info);
  702. }
  703. /// <summary>
  704. /// 机器人断开连接时
  705. /// </summary>
  706. /// <param name="arg1"></param>
  707. /// <param name="arg2"></param>
  708. /// <param name="arg3"></param>
  709. /// <exception cref="NotImplementedException"></exception>
  710. private void Management_DisconnectedEvent(Guid robotid, object arg2, ClosedEventArgs arg3)
  711. {
  712. if (RobotTCPCollection.ContainsKey(robotid))
  713. {
  714. RobotTCPCollection[robotid].Cancel();
  715. }
  716. var r = _configService.GetRobot(robotid);
  717. if (r.ConnectType == TCPConnectType.Server)
  718. {
  719. ITcpSessionClient socketClient = arg2 as ITcpSessionClient;
  720. SendTaskMessage($"{r.RobotName}[{socketClient.Id}:{socketClient.IP}]{Lang.断开连接}!", MessageLevel.Error);
  721. var robot = _robotService.GetRobot(robotid);
  722. if (robot.TcpService.Count < 1)
  723. {
  724. var sta = Status.FirstOrDefault(s => s.ID == robotid);
  725. App.Current.Dispatcher.Invoke(new
  726. Action(() =>
  727. {
  728. sta.Message = $"{r.RobotName}{Lang.未连接}";
  729. sta.Background = new SolidColorBrush(Colors.Red);
  730. }));
  731. }
  732. }
  733. else
  734. {
  735. SendTaskMessage($"{r.RobotName}{Lang.断开连接}!", MessageLevel.Error);
  736. var sta = Status.FirstOrDefault(s => s.ID == robotid);
  737. App.Current.Dispatcher.Invoke(new
  738. Action(() =>
  739. {
  740. sta.Message = $"{r.RobotName}{Lang.断开连接}";
  741. sta.Background = new SolidColorBrush(Colors.Red);
  742. }));
  743. }
  744. }
  745. /// <summary>
  746. /// 机器人连接成功时
  747. /// </summary>
  748. /// <param name="arg1"></param>
  749. /// <param name="arg2"></param>
  750. /// <param name="arg3"></param>
  751. /// <exception cref="NotImplementedException"></exception>
  752. private void Management_ConnectedEvent(Guid robotid, object arg2, ConnectedEventArgs arg3)
  753. {
  754. var r = _configService.GetRobot(robotid);
  755. if (r.ConnectType == TCPConnectType.Server)
  756. {
  757. ITcpSessionClient socketClient = arg2 as ITcpSessionClient;
  758. SendTaskMessage($"{r.RobotName}[{socketClient.Id}:{socketClient.IP}]{Lang.已连接}!", MessageLevel.Debug);
  759. var robot = _robotService.GetRobot(robotid);
  760. if (robot.TcpService.Count > 0)
  761. {
  762. var sta = Status.FirstOrDefault(s => s.ID == robotid);
  763. App.Current.Dispatcher.Invoke(new
  764. Action(() =>
  765. {
  766. sta.Message = $"{r.RobotName}{Lang.已连接}";
  767. sta.Background = new SolidColorBrush(Colors.Green);
  768. }));
  769. }
  770. }
  771. else
  772. {
  773. SendTaskMessage($"{r.RobotName}{Lang.已连接}!", MessageLevel.Debug);
  774. var sta = Status.FirstOrDefault(s => s.ID == robotid);
  775. App.Current.Dispatcher.Invoke(new
  776. Action(() =>
  777. {
  778. sta.Message = $"{r.RobotName}{Lang.已连接}";
  779. sta.Background = new SolidColorBrush(Colors.Green);
  780. }));
  781. }
  782. }
  783. /// <summary>
  784. /// Feeder连接状态改变时
  785. /// </summary>
  786. /// <param name="sender"></param>
  787. /// <param name="state"></param>
  788. private void Management_FeederConnectionStatusChanged(object sender, bool state)
  789. {
  790. IFeeder feeder = sender as IFeeder;
  791. var sta = Status.FirstOrDefault(s => s.ID == feeder.Id);
  792. if (state)
  793. {
  794. App.Current.Dispatcher.Invoke(new
  795. Action(() =>
  796. {
  797. sta.Message = $"{feeder.Name}{Lang.已连接}";
  798. sta.Background = new SolidColorBrush(Colors.Green);
  799. }));
  800. SendTaskMessage($"{feeder.Name}{Lang.已连接}!", MessageLevel.Debug);
  801. }
  802. else
  803. {
  804. App.Current.Dispatcher.Invoke(new
  805. Action(() =>
  806. {
  807. sta.Message = $"{feeder.Name}{Lang.未连接}";
  808. sta.Background = new SolidColorBrush(Colors.Red);
  809. }));
  810. SendTaskMessage($"{feeder.Name}{Lang.断开连接}!", MessageLevel.Error);
  811. }
  812. }
  813. /// <summary>
  814. /// 相机连接或者断开时
  815. /// </summary>
  816. /// <param name="id"></param>
  817. /// <param name="state"></param>
  818. private void Management_CameraConnectChangedEvent(Guid id, bool state)
  819. {
  820. var sta = Status.FirstOrDefault(s => s.ID == id);
  821. var camera = _configService.GetCamera(id);
  822. if (sta != null && camera != null)
  823. {
  824. if (state)
  825. {
  826. App.Current.Dispatcher.Invoke(new Action(() =>
  827. {
  828. sta.Message = $"{camera.CameraName}{Lang.已连接}";
  829. sta.Background = new SolidColorBrush(Colors.Green);
  830. }));
  831. }
  832. else
  833. {
  834. App.Current.Dispatcher.Invoke(new Action(() =>
  835. {
  836. sta.Message = $"{camera.CameraName}{Lang.断开连接}";
  837. sta.Background = new SolidColorBrush(Colors.Red);
  838. }));
  839. }
  840. }
  841. }
  842. /// <summary>
  843. /// PLC连接状态改变事件
  844. /// </summary>
  845. /// <param name="plc"></param>
  846. /// <param name="isconnected"></param>
  847. private async void Management_PlcConnectChangedEvent(object sender, bool isconnected)
  848. {
  849. IPlc plc = sender as IPlc;
  850. var sta = Status.FirstOrDefault(s => s.ID == plc.Id);
  851. if (plc.IsConnected)
  852. {
  853. SendTaskMessage($"{plc.Name}{Lang.已连接}!", MessageLevel.Debug);
  854. if (sta == null) return;
  855. App.Current.Dispatcher.Invoke(new
  856. Action(() =>
  857. {
  858. sta.Message = $"{plc.Name}{Lang.已连接}";
  859. sta.Background = new SolidColorBrush(Colors.Green);
  860. }));
  861. try
  862. {
  863. await WriteSystemParameterToPlcAsync(_configService.GetSystemConfiguration());
  864. await WriteParameterToPlcExAsync();
  865. }
  866. catch (Exception ex)
  867. {
  868. LogHelper.WriteLogError("PLC连接成功时,写入系统参数和点位信息时出错!", ex);
  869. }
  870. }
  871. else
  872. {
  873. SendTaskMessage($"{plc.Name}{Lang.断开连接}!", MessageLevel.Error);
  874. if (sta == null) return;
  875. App.Current.Dispatcher.Invoke(new
  876. Action(() =>
  877. {
  878. sta.Message = $"{plc.Name}{Lang.未连接}";
  879. sta.Background = new SolidColorBrush(Colors.Red);
  880. }));
  881. }
  882. }
  883. /// <summary>
  884. /// 电批连接状态改变时
  885. /// </summary>
  886. /// <param name="screwDevice"></param>
  887. /// <param name="state"></param>
  888. private void ScrewDriver_ConnectStateChangedEvent(object screwDevice, bool state)
  889. {
  890. try
  891. {
  892. XYD_ScrewDriver screwDriver = screwDevice as XYD_ScrewDriver;
  893. if (state)
  894. {
  895. SendTaskMessage($"电批{Lang.已连接}!", MessageLevel.Debug);
  896. var sta = Status.FirstOrDefault(s => s.ID == screwDriver.Id);
  897. App.Current.Dispatcher.Invoke(new
  898. Action(() =>
  899. {
  900. sta.Message = $"电批{Lang.已连接}";
  901. sta.Background = new SolidColorBrush(Colors.Green);
  902. }));
  903. }
  904. else
  905. {
  906. SendTaskMessage($"电批{Lang.未连接}!", MessageLevel.Error);
  907. var sta = Status.FirstOrDefault(s => s.ID == screwDriver.Id);
  908. App.Current.Dispatcher.Invoke(new
  909. Action(() =>
  910. {
  911. sta.Message = $"电批{Lang.未连接}";
  912. sta.Background = new SolidColorBrush(Colors.Red);
  913. }));
  914. }
  915. }
  916. catch (Exception ex)
  917. {
  918. LogHelper.WriteLogError("电批连接状态改变时出错了", ex);
  919. }
  920. }
  921. #endregion
  922. #region 后台服务器通讯事件
  923. private void BgCommunicate_SendEvent(ITcpSessionClient client, string msg)
  924. {
  925. SendTaskMessage($"{Lang.服务器}[{client.ServicePort}] Send To {Lang.客户端}[{client.Id}:{client.IP}]:{msg}", MessageLevel.Info);
  926. }
  927. public Dictionary<string, CancellationTokenSource> BgCommunicateollection = new Dictionary<string, CancellationTokenSource>();
  928. private async void BgCommunicate_ReceivedEvent(ITcpSessionClient client, string msg)
  929. {
  930. try
  931. {
  932. if (!BgCommunicateollection.ContainsKey(client.Id))
  933. {
  934. BgCommunicateollection.Add(client.Id, new CancellationTokenSource());
  935. }
  936. SendTaskMessage($"{Lang.服务器}[{client.ServicePort}]ReceiveFor{Lang.客户端}[{client.Id}:{client.IP}]:{msg}", MessageLevel.Info);
  937. var _ = _remoteCommandService.ExecuteAsync(msg, BgCommunicateollection[client.Id].Token, async response =>
  938. {
  939. try
  940. {
  941. if (!client.Online)
  942. {
  943. return;
  944. }
  945. await BgCommunicate.SendAsync(client, $"{response}");
  946. }
  947. catch (Exception ex)
  948. {
  949. LogHelper.WriteLogError("后台TCP发送数据时出错!", ex);
  950. SendTaskMessage(ex.Message, MessageLevel.Alarm);
  951. }
  952. });
  953. }
  954. catch (Exception ex)
  955. {
  956. LogHelper.WriteLogError("处理后台服务器接收的命令时出错!", ex);
  957. SendTaskMessage(ex.Message, MessageLevel.Alarm);
  958. }
  959. }
  960. private void BgCommunicate_DisconnectedEvent(ITcpSessionClient client, ClosedEventArgs e)
  961. {
  962. SendTaskMessage($"{Lang.服务器}[{client.ServicePort}]{Lang.客户端}[{client.Id}:{client.IP}]{Lang.断开连接}!", MessageLevel.Alarm);
  963. if (BgCommunicateollection.ContainsKey(client.Id))
  964. {
  965. BgCommunicateollection[client.Id].Cancel();
  966. }
  967. }
  968. private void BgCommunicate_ConnectedEvent(ITcpSessionClient client, ConnectedEventArgs e)
  969. {
  970. SendTaskMessage($"{Lang.服务器}[{client.ServicePort}]{Lang.客户端}[{client.Id}:{client.IP}]{Lang.连接成功}!", MessageLevel.Debug);
  971. }
  972. private async Task Scan_DataReceived(ISerialPortClient client, ReceivedDataEventArgs e)
  973. {
  974. try
  975. {
  976. string poname = client.MainSerialPort.PortName;
  977. string data = e.ByteBlock.Span.ToString(Encoding.ASCII);
  978. await Console.Out.WriteLineAsync(data);
  979. string response = data.Split('\r')[0];
  980. SendTaskMessage($"扫码机:{poname}Receive:{response}", MessageLevel.Info);
  981. ScanValue = response;
  982. _scanDoneEvent.Set();
  983. }
  984. catch (Exception ex)
  985. {
  986. LogHelper.WriteLogError("扭力测量仪接收信息时出错!", ex);
  987. SendTaskMessage("扭力测量仪接收信息时出错!" + ex.Message, MessageLevel.Error);
  988. }
  989. }
  990. #endregion
  991. #region PLC
  992. /// <summary>
  993. /// 将系统参数写入PLC
  994. /// </summary>
  995. /// <param name="systemConfiguration"></param>
  996. /// <returns></returns>
  997. public async Task WriteSystemParameterToPlcAsync(SystemConfiguration systemConfiguration)
  998. {
  999. var addressConfig = _configService.GetPlcAddresses();
  1000. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  1001. if (plc == null || !plc.IsConnected) return;
  1002. Dictionary<string, object> nodeValues = new Dictionary<string, object>();
  1003. nodeValues.Add(addressConfig.Out_WorkMode.Address, (Int16)systemConfiguration.WorkMode);
  1004. nodeValues.Add(addressConfig.Out_PickPointNum.Address, (Int16)systemConfiguration.PickPointNum);
  1005. nodeValues.Add(addressConfig.Out_DowmCameraNum.Address, (Int16)systemConfiguration.DowmCameraNum);
  1006. nodeValues.Add(addressConfig.Out_UpCameraPickNum.Address, (Int16)systemConfiguration.UpCameraPickNum);
  1007. nodeValues.Add(addressConfig.Out_UpCameraPutNum.Address, (Int16)systemConfiguration.UpCameraPutNum);
  1008. nodeValues.Add(addressConfig.Out_UPCameracheckNum.Address, (Int16)systemConfiguration.UPCameracheckNum);
  1009. nodeValues.Add(addressConfig.Out_FixedCameraPickNum.Address, (Int16)systemConfiguration.FixedCameraPickNum);
  1010. nodeValues.Add(addressConfig.Out_FixedCameraPutNum.Address, (Int16)systemConfiguration.FixedCameraPutNum);
  1011. nodeValues.Add(addressConfig.Out_FixedCameracheckNum.Address, (Int16)systemConfiguration.FixedCameracheckNum);
  1012. nodeValues.Add(addressConfig.Out_ScrewTeachNum.Address, (Int16)systemConfiguration.ScrewTeachNum);
  1013. var res = await plc.WriteNodesAsync(nodeValues);
  1014. }
  1015. /// <summary>
  1016. /// 注册需要监控的PLC地址
  1017. /// </summary>
  1018. public void RegisterPlcMonitorAddress()
  1019. {
  1020. var addressConfig = _configService.GetPlcAddresses();
  1021. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  1022. if (plc == null || !plc.IsConnected) return;
  1023. //PLC地址数组
  1024. List<string> monitorNodeIds = new List<string>()
  1025. {
  1026. addressConfig.In_DowmCameraExe.Address,
  1027. addressConfig.In_UpCameraPickExe.Address,
  1028. addressConfig.In_UpCameraPutExe.Address,
  1029. addressConfig.In_UPCameracheckExe.Address,
  1030. addressConfig.In_FixedCameraPickExe.Address,
  1031. addressConfig.In_FixedCameraPutExe.Address,
  1032. addressConfig.In_FixedCameracheckExe.Address,
  1033. addressConfig.In_RequestPosition.Address,
  1034. addressConfig.In_ScrewTeachExe.Address,
  1035. addressConfig.In_PickINC.Address,
  1036. addressConfig.In_Throw.Address,
  1037. addressConfig.RunMode.Address,
  1038. addressConfig.ManualMode.Address,
  1039. addressConfig.ClearMode.Address,
  1040. addressConfig.Fault.Address,
  1041. };
  1042. for (int i = 0; i < 10; i++)
  1043. {
  1044. monitorNodeIds.Add(string.Format(addressConfig.In_MesCheck.Address, i));
  1045. }
  1046. for (int i = 0; i < 7; i++)
  1047. {
  1048. monitorNodeIds.Add(string.Format(addressConfig.In_WorkStart.Address, i));
  1049. monitorNodeIds.Add(string.Format(addressConfig.In_WorkDone.Address, i));
  1050. }
  1051. //订阅PLC地址变化
  1052. plc.SubscribeNodes("AutoSensor", monitorNodeIds, PlcCommandTrigger);
  1053. }
  1054. /// <summary>
  1055. /// 将产品的参数统一写入PLC
  1056. /// </summary>
  1057. /// <returns></returns>
  1058. public async Task WriteParameterToPlcExAsync()
  1059. {
  1060. await WritePositionToPlcAsync();// 写入点位信息给PLC
  1061. await WriteParameterToPlcAsync();// 写入组装上下限给PLC
  1062. await WriteProductLoadModeToPLC();//把当前产品型号,写入PLC
  1063. }
  1064. /// <summary>
  1065. /// 写入点位信息给PLC
  1066. /// </summary>
  1067. /// <returns></returns>
  1068. public async Task WritePositionToPlcAsync()
  1069. {
  1070. var addressConfig = _configService.GetPlcAddresses();
  1071. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  1072. if (plc == null || !plc.IsConnected) return;
  1073. var current = _productService.GetCurrentProduct();
  1074. if (current == null) return;
  1075. if (current.PickCameraPoints != null && current.PickCameraPoints.Count > 0)
  1076. {
  1077. foreach (var item in current.PickCameraPoints)
  1078. {
  1079. await item.WriteToPlcAddress(addressConfig.Out_PickCamera, plc);
  1080. }
  1081. }
  1082. if (current.PickPoints != null && current.PickPoints.Count > 0)
  1083. {
  1084. foreach (var item in current.PickPoints)
  1085. {
  1086. var res = await item.WriteToPlcAddress(addressConfig.Out_Pick, plc);
  1087. }
  1088. }
  1089. if (current.SecPosCameraPoints != null && current.SecPosCameraPoints.Count > 0)
  1090. {
  1091. foreach (var item in current.SecPosCameraPoints)
  1092. {
  1093. await item.WriteToPlcAddress(addressConfig.Out_SecPosCamera, plc);
  1094. }
  1095. }
  1096. if (current.ScrewCameraPoints != null && current.ScrewCameraPoints.Count > 0)
  1097. {
  1098. foreach (var item in current.ScrewCameraPoints)
  1099. {
  1100. await item.WriteToPlcAddress(addressConfig.Out_ScrewCamera, plc);
  1101. }
  1102. }
  1103. if (current.ScrewPoints != null && current.ScrewPoints.Count > 0)
  1104. {
  1105. foreach (var item in current.ScrewPoints)
  1106. {
  1107. await item.WriteToPlcAddressEx(addressConfig.Out_Screw, plc);
  1108. }
  1109. await plc.WriteNodeAsync(addressConfig.Out_WorkNum.Address, (Int16)current.ScrewPoints.Count);
  1110. }
  1111. if (current.CheckCameraPoints != null && current.CheckCameraPoints.Count > 0)
  1112. {
  1113. foreach (var item in current.CheckCameraPoints)
  1114. {
  1115. await item.WriteToPlcAddress(addressConfig.Out_CheckCamera, plc);
  1116. }
  1117. }
  1118. if (current.RemovePoints != null && current.RemovePoints.Count > 0)
  1119. {
  1120. foreach (var item in current.RemovePoints)
  1121. {
  1122. await item.WriteToPlcAddress(addressConfig.Out_RemovePos, plc);
  1123. }
  1124. }
  1125. if (current.PressurePlacePoints != null && current.PressurePlacePoints.Count > 0)
  1126. {
  1127. foreach (var item in current.PressurePlacePoints)
  1128. {
  1129. await item.WriteToPlcAddress(addressConfig.Out_PressurePlace, plc);
  1130. }
  1131. }
  1132. }
  1133. /// <summary>
  1134. /// 写入组装上下限给PLC
  1135. /// </summary>
  1136. /// <returns></returns>
  1137. public async Task WriteParameterToPlcAsync()
  1138. {
  1139. var addressConfig = _configService.GetPlcAddresses();
  1140. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  1141. if (plc == null || !plc.IsConnected) return;
  1142. // 获取当前产品
  1143. var currentProduct = _productService.GetCurrentProduct();
  1144. if (currentProduct == null) return;
  1145. try
  1146. {
  1147. if (currentProduct.GlobalParamEx == null) currentProduct.GlobalParamEx = new Models.Product.ProductGlobalParamEx();
  1148. if (currentProduct.GlobalParamEx.DownPressure == null) currentProduct.GlobalParamEx.DownPressure = new PressureModel();
  1149. await plc.WriteNodeAsync(addressConfig.Down_Time.Address, currentProduct.GlobalParamEx.DownPressure.PressureTime);
  1150. await plc.WriteNodeAsync(addressConfig.Down_WetOut_Num.Address, currentProduct.GlobalParamEx.DownPressure.PressureNum);
  1151. await plc.WriteNodeAsync(addressConfig.Down_WetOut_Num_max.Address, currentProduct.GlobalParamEx.DownPressure.PressureNumMax);
  1152. }
  1153. catch (Exception)
  1154. {
  1155. }
  1156. }
  1157. /// <summary>
  1158. /// 将当前产品类型写入PLC
  1159. /// </summary>
  1160. /// <param name="mode"></param>
  1161. public async Task WriteProductLoadModeToPLC(int modeIndex)
  1162. {
  1163. var addressConfig = _configService.GetPlcAddresses();
  1164. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  1165. if (plc == null || !plc.IsConnected) return;
  1166. await plc.WriteNodeAsync(addressConfig.Out_ProductLoadMode.Address, (Int16)modeIndex);
  1167. }
  1168. /// <summary>
  1169. /// 将当前产品类型写入PLC
  1170. /// </summary>
  1171. /// <param name="mode"></param>
  1172. public async Task WriteProductLoadModeToPLC()
  1173. {
  1174. var addressConfig = _configService.GetPlcAddresses();
  1175. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  1176. if (plc == null || !plc.IsConnected) return;
  1177. var current = _productService.GetCurrentProduct();
  1178. if (current == null) return;
  1179. var qMes = await _systemDatabaseService.QueryProductFromMesAsync(current.Name);
  1180. if (qMes == null) return;
  1181. await plc.WriteNodeAsync(addressConfig.Out_ProductLoadMode.Address, (Int16)qMes.ProductLoadMode);
  1182. }
  1183. /// <summary>
  1184. /// 固定向上相机拍照结果
  1185. /// </summary>
  1186. OpenCvSharp.Point3f[] DowmCameraResults = new OpenCvSharp.Point3f[10];
  1187. /// <summary>
  1188. /// 移动向下相机拍照结果
  1189. /// </summary>
  1190. OpenCvSharp.Point3f[] UpCameraPutResults = new OpenCvSharp.Point3f[10];
  1191. /// <summary>
  1192. /// 取料移动相机拍照结果
  1193. /// </summary>
  1194. OpenCvSharp.Point3f UpCameraPickResult = new OpenCvSharp.Point3f();
  1195. /// <summary>
  1196. /// 最终组装位置
  1197. /// </summary>
  1198. OpenCvSharp.Point3f PlaceActualCoord = new OpenCvSharp.Point3f();
  1199. /// <summary>
  1200. /// 零件SN
  1201. /// </summary>
  1202. string PartSN = "";
  1203. /// <summary>
  1204. /// 压力曲线编号
  1205. /// </summary>
  1206. int pngindex = 100;
  1207. /// <summary>
  1208. /// 产品SN
  1209. /// </summary>
  1210. string[] ProductMainSN = new string[10];//产品主sn
  1211. /// <summary>
  1212. /// 工单信息
  1213. /// </summary>
  1214. string[] wo = new string[10];
  1215. string[] model_num = new string[10];//产品model_num
  1216. string[] color = new string[10];//产品color
  1217. string[] ppid = new string[10];//产品ppid
  1218. string[] revision { get; set; } = new string[10];//产品revision
  1219. /// <summary>
  1220. /// 二次定位相机的工具坐标
  1221. /// </summary>
  1222. PointF DownTool = new PointF();
  1223. double _FixedUpCameraAngle = 0;
  1224. double _MoveCameraAngle = 0;
  1225. // 扫码完成事件
  1226. private readonly ManualResetEventSlim _scanDoneEvent = new ManualResetEventSlim(false);
  1227. // 扫码结果
  1228. private string ScanValue = "";
  1229. bool _LastDowmCameraExe = false;
  1230. bool _LastScrewTeachExe = false;
  1231. bool _LastUpCameraPickExe = false;
  1232. bool _LastUpCameraPutExe = false;
  1233. bool _LastUPCameracheckExe = false;
  1234. bool _LastFixedCameraPickExe = false;
  1235. bool _LastFixedCameraPutExe = false;
  1236. bool _LastFixedCameracheckExe = false;
  1237. bool _LastThrowExe = false;
  1238. bool _LastRunModel = false;
  1239. bool _LastManualMode = false;
  1240. bool _LastClearMode = false;
  1241. bool _LastFault = false;
  1242. Int16 _LastQrCodePhotoRequest = 0;
  1243. Int16[] _LastWorkStart = new Int16[7];
  1244. Int16[] _LastWorkDone = new Int16[7];
  1245. Int16 _LastRequestPosition = 0;
  1246. Int16 _LastPickINC = 0;
  1247. Int16[] _LastMesCheck = new Int16[10];
  1248. DateTime[] _LastMesCheckTime = new DateTime[10];
  1249. Dictionary<string, string> mes_cc { get; set; } = new Dictionary<string, string>();
  1250. /// <summary>
  1251. /// 当前压力值
  1252. /// </summary>
  1253. double[] currentPressure = new double[10];
  1254. /// <summary>
  1255. /// PLC命令触发时
  1256. /// </summary>
  1257. /// <param name="tuple"></param>
  1258. private async void PlcCommandTrigger((string key, string nodeId, object value) tuple)
  1259. {
  1260. try
  1261. {
  1262. if (tuple.key != "AutoSensor")
  1263. {
  1264. return;
  1265. }
  1266. var addressConfig = _configService.GetPlcAddresses();
  1267. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  1268. if (plc == null || !plc.IsConnected) return;
  1269. // 获取当前产品
  1270. var currentProduct = _productService.GetCurrentProduct();
  1271. if (currentProduct == null)
  1272. {
  1273. return;
  1274. }
  1275. ////获取产品编码
  1276. //_productService.CurrentProductCode = plc.ReadNode<string>(string.Format(addressConfig.In_Code.Address, 0));
  1277. ////如果产品编码为空,则以当前的时间戳作为编码
  1278. //if (string.IsNullOrEmpty(_productService.CurrentProductCode))
  1279. //{
  1280. // _productService.CurrentProductCode = DateTime.Now.ToString("yyyyMMddHHmmssfff");
  1281. //}
  1282. bool isDryMode = plc.ReadNode<bool>(addressConfig.In_DryMode.Address);
  1283. // 触发下相机拍照
  1284. if (addressConfig.In_DowmCameraExe.Address.Contains(tuple.nodeId))
  1285. {
  1286. if (tuple.value is bool state)
  1287. {
  1288. if (_LastDowmCameraExe != state)
  1289. {
  1290. _LastDowmCameraExe = state;
  1291. }
  1292. else
  1293. {
  1294. return;
  1295. }
  1296. if (state)
  1297. {
  1298. SendTaskMessage($"触发下相机拍照...", MessageLevel.Debug);
  1299. //相机的编号
  1300. Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_DowmCameraNum.Address);
  1301. SendTaskMessage($"编号:{cameraIndex}", MessageLevel.Info);
  1302. // 获取机器人当前坐标
  1303. var robot = _robotService.GetAllRobots().FirstOrDefault();
  1304. if (robot == null)
  1305. {
  1306. SendTaskMessage($"未找到机器人,无法执行上相机锁附/组装拍照视觉任务", MessageLevel.Alarm);
  1307. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1308. return;
  1309. }
  1310. var currentPosition = robot.GetRobotPos();
  1311. //如果下相机拍照的次数是1,则判断用时拍照的相机是几个
  1312. int downCameraNum = _configService.GetSystemConfiguration().DowmCameraNum;
  1313. if (downCameraNum == 1)
  1314. {
  1315. //如果下相机2的流程id为空,则表示只有一个下相机
  1316. if (currentProduct.FixedUpCamera2ProcedureId == Guid.Empty)
  1317. {
  1318. //获取固定向上相机1的流程
  1319. var process = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
  1320. if (process == null)
  1321. {
  1322. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera1ProcedureId}", MessageLevel.Alarm);
  1323. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1324. return;
  1325. }
  1326. // 执行视觉任务
  1327. var _cts = new CancellationTokenSource();
  1328. var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, cameraIndex, null);
  1329. if (isDryMode)
  1330. {
  1331. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1332. return;
  1333. }
  1334. if (visionResult.IsSucceed)
  1335. {
  1336. float toolX = (float)(visionResult.X - currentPosition.X);
  1337. float toolY = (float)(visionResult.Y - currentPosition.Y);
  1338. DowmCameraResults[cameraIndex] = new OpenCvSharp.Point3f(toolX, toolY, (float)visionResult.U);
  1339. DownTool = new PointF(toolX, toolY);
  1340. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1341. return;
  1342. }
  1343. else
  1344. {
  1345. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1346. return;
  1347. }
  1348. }
  1349. else
  1350. {
  1351. //获取固定向上相机1的流程
  1352. var process1 = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
  1353. if (process1 == null)
  1354. {
  1355. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera1ProcedureId}", MessageLevel.Alarm);
  1356. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1357. return;
  1358. }
  1359. //获取固定向上相机2的流程
  1360. var process2 = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera2ProcedureId);
  1361. if (process2 == null)
  1362. {
  1363. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera2ProcedureId}", MessageLevel.Alarm);
  1364. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1365. return;
  1366. }
  1367. // 执行视觉任务
  1368. var _cts = new CancellationTokenSource();
  1369. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 1, null);
  1370. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 2, null);
  1371. var visionResults = await Task.WhenAll(task1, task2);
  1372. if (isDryMode)
  1373. {
  1374. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1375. return;
  1376. }
  1377. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed)
  1378. {
  1379. float toolX = (float)(visionResults[0].X + visionResults[1].X) / 2;
  1380. float toolY = (float)(visionResults[0].Y + visionResults[1].Y) / 2;
  1381. _FixedUpCameraAngle = Common.CalculateAngleBetweenPointsDegrees(new PointF((float)visionResults[0].X, (float)visionResults[0].Y), new PointF((float)visionResults[1].X, (float)visionResults[1].Y));
  1382. DowmCameraResults[cameraIndex] = new OpenCvSharp.Point3f(toolX, toolY, (float)_FixedUpCameraAngle);
  1383. DownTool = new PointF(toolX, toolY);
  1384. SendTaskMessage($"固定向上相机拍照Tool: {DownTool.X:F3},{DownTool.Y:F3},{_FixedUpCameraAngle:F3}", MessageLevel.Info);
  1385. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1386. return;
  1387. }
  1388. else
  1389. {
  1390. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1391. return;
  1392. }
  1393. }
  1394. }
  1395. else if (downCameraNum == 2)
  1396. {
  1397. //如果下相机2的流程id为空,则表示只有一个下相机
  1398. if (currentProduct.FixedUpCamera2ProcedureId == Guid.Empty)
  1399. {
  1400. //获取固定向上相机1的流程
  1401. //var process = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
  1402. //if (process == null)
  1403. //{
  1404. // SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera1ProcedureId}", MessageLevel.Alarm);
  1405. // await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1406. // return;
  1407. //}
  1408. //// 执行视觉任务
  1409. //var _cts = new CancellationTokenSource();
  1410. //var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token);
  1411. //if (visionResult.IsSucceed)
  1412. //{
  1413. // float toolX = (float)(visionResult.X - currentPosition.X);
  1414. // float toolY = (float)(visionResult.Y - currentPosition.Y);
  1415. // DowmCameraResults[cameraIndex] = new PointF(toolX, toolX);
  1416. // if (cameraIndex == downCameraNum)
  1417. // {
  1418. // //求取多个DowmCameraResults的中心点
  1419. // DownTool = new PointF(toolX, toolX);
  1420. // }
  1421. // await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1422. // return;
  1423. //}
  1424. //else
  1425. //{
  1426. // await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1427. // return;
  1428. //}
  1429. //暂时没有应用场景,不支持
  1430. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1431. return;
  1432. }
  1433. else
  1434. {
  1435. //获取固定向上相机1的流程
  1436. var process1 = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
  1437. if (process1 == null)
  1438. {
  1439. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera1ProcedureId}", MessageLevel.Alarm);
  1440. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1441. return;
  1442. }
  1443. //获取固定向上相机2的流程
  1444. var process2 = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera2ProcedureId);
  1445. if (process2 == null)
  1446. {
  1447. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera2ProcedureId}", MessageLevel.Alarm);
  1448. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1449. return;
  1450. }
  1451. // 执行视觉任务
  1452. var _cts = new CancellationTokenSource();
  1453. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 1, null);
  1454. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 2, null);
  1455. var visionResults = await Task.WhenAll(task1, task2);
  1456. if (isDryMode)
  1457. {
  1458. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1459. return;
  1460. }
  1461. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed)
  1462. {
  1463. float toolX = (float)(visionResults[0].X + visionResults[1].X) / 2;
  1464. float toolY = (float)(visionResults[0].Y + visionResults[1].Y) / 2;
  1465. _FixedUpCameraAngle = Common.CalculateAngleBetweenPointsDegrees(new PointF((float)visionResults[0].X, (float)visionResults[0].Y), new PointF((float)visionResults[1].X, (float)visionResults[1].Y));
  1466. DowmCameraResults[cameraIndex] = new OpenCvSharp.Point3f(toolX, toolY, (float)_FixedUpCameraAngle);
  1467. DownTool = new PointF(toolX, toolY);
  1468. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)1);
  1469. return;
  1470. }
  1471. else
  1472. {
  1473. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1474. return;
  1475. }
  1476. }
  1477. }
  1478. else
  1479. {
  1480. //暂时没有应用场景,不支持
  1481. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1482. return;
  1483. }
  1484. }
  1485. else
  1486. {
  1487. SendTaskMessage($"触发下相机拍照信号已关闭", MessageLevel.Alarm);
  1488. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)0);
  1489. }
  1490. }
  1491. }
  1492. // 触发下相机拍照披头
  1493. if (addressConfig.In_ScrewTeachExe.Address.Contains(tuple.nodeId))
  1494. {
  1495. if (tuple.value is bool state)
  1496. {
  1497. if (_LastScrewTeachExe != state)
  1498. {
  1499. _LastScrewTeachExe = state;
  1500. }
  1501. else
  1502. {
  1503. return;
  1504. }
  1505. if (state)
  1506. {
  1507. SendTaskMessage($"触发下相机拍照...", MessageLevel.Debug);
  1508. //相机的编号
  1509. Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_DowmCameraNum.Address);
  1510. SendTaskMessage($"编号:{cameraIndex}", MessageLevel.Info);
  1511. // 获取流程
  1512. //var process = _productService.GetCurrentProductProcedureModelById(currentProduct.FixedUpCamera1ProcedureId);
  1513. //if (process == null)
  1514. //{
  1515. // SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.FixedUpCamera1ProcedureId}", MessageLevel.Alarm);
  1516. // await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)2);
  1517. // return;
  1518. //}
  1519. //// 获取机器人当前坐标
  1520. //var robot = _robotService.GetAllRobots().FirstOrDefault();
  1521. //if (robot == null)
  1522. //{
  1523. // SendTaskMessage($"未找到机器人,无法执行上相机锁附/组装拍照视觉任务", MessageLevel.Alarm);
  1524. // await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)2);
  1525. // return;
  1526. //}
  1527. //var currentPosition = robot.GetRobotPos();
  1528. //// 执行视觉任务
  1529. //var _cts = new CancellationTokenSource();
  1530. //var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, null, _cts.Token);
  1531. //if (visionResult.IsSucceed)
  1532. //{
  1533. // //披头偏差
  1534. // float offsetX = (float)(visionResult.X - currentPosition.X);
  1535. // float offsetY = (float)(visionResult.Y - currentPosition.Y);
  1536. // DowmCameraResults[cameraIndex] = new PointF(offsetX, offsetY);
  1537. // await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)1);
  1538. // return;
  1539. //}
  1540. //else
  1541. //{
  1542. // await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)2);
  1543. // return;
  1544. //}
  1545. }
  1546. else
  1547. {
  1548. SendTaskMessage($"触发下相机拍照信号已关闭", MessageLevel.Alarm);
  1549. await plc.WriteNodeAsync(addressConfig.Out_ScrewTeachOk.Address, (Int16)0);
  1550. }
  1551. }
  1552. }
  1553. // 触发上相机取料拍照
  1554. else if (addressConfig.In_UpCameraPickExe.Address.Contains(tuple.nodeId))
  1555. {
  1556. if (tuple.value is bool state)
  1557. {
  1558. if (_LastUpCameraPickExe != state)
  1559. {
  1560. _LastUpCameraPickExe = state;
  1561. }
  1562. else
  1563. {
  1564. return;
  1565. }
  1566. if (state)
  1567. {
  1568. SendTaskMessage($"触发上相机取料拍照...", MessageLevel.Debug);
  1569. //相机的编号
  1570. Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_UpCameraPickNum.Address);
  1571. SendTaskMessage($"编号:{cameraIndex}", MessageLevel.Info);
  1572. // 获取机器人当前坐标
  1573. var robot = _robotService.GetAllRobots().FirstOrDefault();
  1574. if (robot == null)
  1575. {
  1576. SendTaskMessage($"未找到机器人,无法执行上相机锁附/组装拍照视觉任务", MessageLevel.Alarm);
  1577. await plc.WriteNodeAsync(addressConfig.Out_DownCameraStatus.Address, (Int16)2);
  1578. return;
  1579. }
  1580. var currentPosition = robot.GetRobotPos();
  1581. //如果上相机2的流程id为空,则表示只有一个下相机
  1582. if (currentProduct.MoveDownCamer2PickPhotoProcedureId == Guid.Empty)
  1583. {
  1584. //获取移动向下相机1的流程
  1585. var process = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamer1PickPhotoProcedureId);
  1586. if (process == null)
  1587. {
  1588. SendTaskMessage($"移动向下相机1视觉流程,流程ID:{currentProduct.MoveDownCamer1PickPhotoProcedureId}", MessageLevel.Alarm);
  1589. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)2);
  1590. return;
  1591. }
  1592. // 执行视觉任务
  1593. var _cts = new CancellationTokenSource();
  1594. var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, cameraIndex, null);
  1595. if (visionResult.IsSucceed)
  1596. {
  1597. currentProduct.PickPoints[0].X_Position = (float)visionResult.X;
  1598. currentProduct.PickPoints[0].Y_Position = (float)visionResult.Y;
  1599. //currentProduct.PickPoints[0].U_Position += (float)visionResult.U;
  1600. await currentProduct.ScrewPoints[0].WriteToPlcAddress(addressConfig.Out_Pick, plc);
  1601. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)1);
  1602. return;
  1603. }
  1604. else
  1605. {
  1606. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)2);
  1607. return;
  1608. }
  1609. }
  1610. else
  1611. {
  1612. //获取固定向上相机1的流程
  1613. var process1 = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamer1PickPhotoProcedureId);
  1614. if (process1 == null)
  1615. {
  1616. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.MoveDownCamer1PickPhotoProcedureId}", MessageLevel.Alarm);
  1617. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)2);
  1618. return;
  1619. }
  1620. //获取固定向上相机2的流程
  1621. var process2 = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamer2PickPhotoProcedureId);
  1622. if (process2 == null)
  1623. {
  1624. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.MoveDownCamer2PickPhotoProcedureId}", MessageLevel.Alarm);
  1625. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)2);
  1626. return;
  1627. }
  1628. // 执行视觉任务
  1629. var _cts = new CancellationTokenSource();
  1630. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 1, null);
  1631. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 2, null);
  1632. var visionResults = await Task.WhenAll(task1, task2);
  1633. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed)
  1634. {
  1635. float tool1X = (float)(visionResults[0].X - visionResults[0].X);
  1636. float tool1Y = (float)(visionResults[0].Y - visionResults[0].Y);
  1637. float tool2X = (float)(visionResults[1].X - visionResults[1].X);
  1638. float tool2Y = (float)(visionResults[1].Y - visionResults[1].Y);
  1639. float toolX = (tool1X + tool2X) / 2;
  1640. float toolY = (tool1Y + tool2Y) / 2;
  1641. //计算两个点的线角度
  1642. currentProduct.PickPoints[0].X_Position = (float)toolX;
  1643. currentProduct.PickPoints[0].Y_Position = (float)toolY;
  1644. //currentProduct.PickPoints[0].U_Position += (float)visionResult.U;
  1645. await currentProduct.ScrewPoints[0].WriteToPlcAddress(addressConfig.Out_Pick, plc);
  1646. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)1);
  1647. return;
  1648. }
  1649. else
  1650. {
  1651. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)2);
  1652. return;
  1653. }
  1654. }
  1655. }
  1656. else
  1657. {
  1658. SendTaskMessage($"触发上相机取料拍照信号已关闭", MessageLevel.Alarm);
  1659. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPickStatus.Address, (Int16)0);
  1660. }
  1661. }
  1662. }
  1663. // 上相机锁附/组装拍照
  1664. else if (addressConfig.In_UpCameraPutExe.Address.Contains(tuple.nodeId))
  1665. {
  1666. if (tuple.value is bool state)
  1667. {
  1668. if (_LastUpCameraPutExe != state)
  1669. {
  1670. _LastUpCameraPutExe = state;
  1671. }
  1672. else
  1673. {
  1674. return;
  1675. }
  1676. if (state)
  1677. {
  1678. SendTaskMessage($"触发上相机锁附/组装拍照...", MessageLevel.Debug);
  1679. //相机的编号
  1680. Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_UpCameraPutNum.Address);
  1681. SendTaskMessage($"编号:{cameraIndex}", MessageLevel.Info);
  1682. //视觉流程ID
  1683. Guid procedureId = currentProduct.MoveDownCamera1LockPhotoProcedureId;
  1684. // 获取机器人当前坐标
  1685. var robot = _robotService.GetAllRobots().FirstOrDefault();
  1686. if (robot == null)
  1687. {
  1688. SendTaskMessage($"未找到机器人,无法执行上相机锁附/组装拍照视觉任务", MessageLevel.Alarm);
  1689. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1690. return;
  1691. }
  1692. var currentPosition = robot.GetRobotPos();
  1693. //如果上相机2的流程id为空,则表示只有一个上相机
  1694. if (currentProduct.MoveDownCamera2LockPhotoProcedureId == Guid.Empty)
  1695. {
  1696. //获取锁付拍照的点位
  1697. var pos = currentProduct.ScrewCameraPoints.FirstOrDefault(p => p.Number == cameraIndex);
  1698. if (pos != null)
  1699. {
  1700. procedureId = pos.VisionProcessID;
  1701. }
  1702. // 获取移动向下相机的流程
  1703. var process = _productService.GetCurrentProductProcedureModelById(procedureId);
  1704. if (process == null)
  1705. {
  1706. SendTaskMessage($"未找到移动向下相机组装拍照对应的视觉流程流程ID:{procedureId}", MessageLevel.Alarm);
  1707. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1708. return;
  1709. }
  1710. // 执行视觉任务
  1711. var _cts = new CancellationTokenSource();
  1712. var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, cameraIndex, null);
  1713. if (isDryMode)
  1714. {
  1715. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)1);
  1716. return;
  1717. }
  1718. if (visionResult.IsSucceed)
  1719. {
  1720. UpCameraPutResults[cameraIndex] = new OpenCvSharp.Point3f((float)visionResult.X, (float)visionResult.Y, (float)visionResult.U);
  1721. SendTaskMessage($"移动向下相机拍照[{cameraIndex}]结果: {UpCameraPutResults[cameraIndex].X:F3},{UpCameraPutResults[cameraIndex].Y:F3},{UpCameraPutResults[cameraIndex].Z:F3}", MessageLevel.Info);
  1722. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)1);
  1723. return;
  1724. }
  1725. else
  1726. {
  1727. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1728. return;
  1729. }
  1730. }
  1731. else
  1732. {
  1733. //获取移动向下相机1的流程
  1734. var process1 = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamera1LockPhotoProcedureId);
  1735. if (process1 == null)
  1736. {
  1737. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.MoveDownCamera1LockPhotoProcedureId}", MessageLevel.Alarm);
  1738. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1739. return;
  1740. }
  1741. //获取移动向下相机2的流程
  1742. var process2 = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamera2LockPhotoProcedureId);
  1743. if (process2 == null)
  1744. {
  1745. SendTaskMessage($"固定向上相机1视觉流程,流程ID:{currentProduct.MoveDownCamera2LockPhotoProcedureId}", MessageLevel.Alarm);
  1746. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1747. return;
  1748. }
  1749. // 执行视觉任务
  1750. var _cts = new CancellationTokenSource();
  1751. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 1, null);
  1752. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, 2, null);
  1753. var visionResults = await Task.WhenAll(task1, task2);
  1754. if (isDryMode)
  1755. {
  1756. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)1);
  1757. return;
  1758. }
  1759. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed)
  1760. {
  1761. float centerX = (float)(visionResults[0].X + visionResults[1].X) / 2;
  1762. float centerY = (float)(visionResults[0].Y + visionResults[1].Y) / 2;
  1763. _MoveCameraAngle = Common.CalculateAngleBetweenPointsDegrees(new PointF((float)visionResults[0].X, (float)visionResults[0].Y), new PointF((float)visionResults[1].X, (float)visionResults[1].Y));
  1764. UpCameraPutResults[cameraIndex] = new OpenCvSharp.Point3f(centerX, centerY, (float)_MoveCameraAngle);
  1765. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)1);
  1766. return;
  1767. }
  1768. else
  1769. {
  1770. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1771. return;
  1772. }
  1773. }
  1774. }
  1775. else
  1776. {
  1777. SendTaskMessage($"触发上相机锁附/组装拍照信号已关闭", MessageLevel.Alarm);
  1778. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)0);
  1779. }
  1780. }
  1781. }
  1782. // 上相机检测拍照
  1783. else if (addressConfig.In_UPCameracheckExe.Address.Contains(tuple.nodeId))
  1784. {
  1785. if (tuple.value is bool state)
  1786. {
  1787. if (_LastUPCameracheckExe != state)
  1788. {
  1789. _LastUPCameracheckExe = state;
  1790. }
  1791. else
  1792. {
  1793. return;
  1794. }
  1795. if (state)
  1796. {
  1797. SendTaskMessage($"触发上相机检测拍照...", MessageLevel.Debug);
  1798. //相机的编号
  1799. Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_UPCameracheckNum.Address);
  1800. //视觉流程ID
  1801. Guid procedureId = Guid.Empty;
  1802. //获取锁付拍照的点位
  1803. var pos = currentProduct.CheckCameraPoints.FirstOrDefault(p => p.Number == cameraIndex);
  1804. if (pos != null)
  1805. {
  1806. procedureId = pos.VisionProcessID;
  1807. }
  1808. // 获取流程
  1809. var process = _productService.GetCurrentProductProcedureModelById(procedureId);
  1810. if (process == null)
  1811. {
  1812. SendTaskMessage(string.Format("未找到点位:{0}的视觉流程:{1}", cameraIndex, procedureId), MessageLevel.Alarm);
  1813. await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)2);
  1814. return;
  1815. }
  1816. // 获取机器人当前坐标
  1817. var robot = _robotService.GetAllRobots().FirstOrDefault();
  1818. if (robot == null)
  1819. {
  1820. SendTaskMessage($"未找到机器人,无法执行上相机锁附/组装拍照视觉任务", MessageLevel.Alarm);
  1821. await plc.WriteNodeAsync(addressConfig.Out_UpCameraPutStatus.Address, (Int16)2);
  1822. return;
  1823. }
  1824. var currentPosition = robot.GetRobotPos();
  1825. // 执行视觉任务
  1826. var _cts = new CancellationTokenSource();
  1827. var visionResult = await _remoteCommandService.ExecutePhotoGetDistance(1, process, null, new double[] { currentPosition.X, currentPosition.Y, currentPosition.U }, _cts.Token, cameraIndex, null);
  1828. if (visionResult.IsSucceed)
  1829. {
  1830. if (mes_cc.ContainsKey(visionResult.distance.Split(',')[0]))
  1831. {
  1832. mes_cc[visionResult.distance.Split(',')[0]] = visionResult.distance.Split(',')[1];
  1833. }
  1834. else
  1835. {
  1836. mes_cc.Add(visionResult.distance.Split(',')[0], visionResult.distance.Split(',')[1]);
  1837. }
  1838. await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)1);
  1839. SendTaskMessage($"点位{cameraIndex}检测OK", MessageLevel.Debug);
  1840. }
  1841. else
  1842. {
  1843. if (mes_cc.ContainsKey(visionResult.distance.Split(',')[0]))
  1844. {
  1845. mes_cc[visionResult.distance.Split(',')[0]] = visionResult.distance.Split(',')[1];
  1846. }
  1847. else
  1848. {
  1849. if (mes_cc.ContainsKey(cameraIndex.ToString()))
  1850. {
  1851. mes_cc[cameraIndex.ToString()] = "0";
  1852. }
  1853. else
  1854. {
  1855. mes_cc.Add(cameraIndex.ToString(), "0");
  1856. }
  1857. }
  1858. await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)2);
  1859. SendTaskMessage($"点位{cameraIndex}检测NG", MessageLevel.Error);
  1860. }
  1861. }
  1862. else
  1863. {
  1864. SendTaskMessage($"触发上相机检测拍照信号已关闭", MessageLevel.Alarm);
  1865. await plc.WriteNodeAsync(addressConfig.Out_UPCameracheckStatus.Address, (Int16)0);
  1866. }
  1867. }
  1868. }
  1869. // 固定相机取料拍照
  1870. else if (addressConfig.In_FixedCameraPickExe.Address.Contains(tuple.nodeId))
  1871. {
  1872. if (tuple.value is bool state)
  1873. {
  1874. if (_LastFixedCameraPickExe != state)
  1875. {
  1876. _LastFixedCameraPickExe = state;
  1877. }
  1878. else
  1879. {
  1880. return;
  1881. }
  1882. if (state)
  1883. {
  1884. SendTaskMessage($"触发固定相机取料拍照...", MessageLevel.Debug);
  1885. //相机的编号
  1886. //Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_FixedCameraPickNum.Address);
  1887. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPickStatus.Address, (Int16)1);
  1888. }
  1889. else
  1890. {
  1891. SendTaskMessage($"触发固定相机取料拍照信号已关闭", MessageLevel.Alarm);
  1892. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPickStatus.Address, (Int16)0);
  1893. }
  1894. }
  1895. }
  1896. // 固定相机锁附/组装拍照
  1897. else if (addressConfig.In_FixedCameraPutExe.Address.Contains(tuple.nodeId))
  1898. {
  1899. if (tuple.value is bool state)
  1900. {
  1901. if (_LastFixedCameraPutExe != state)
  1902. {
  1903. _LastFixedCameraPutExe = state;
  1904. }
  1905. else
  1906. {
  1907. return;
  1908. }
  1909. if (state)
  1910. {
  1911. SendTaskMessage($"触发固定相机锁附/组装拍照...", MessageLevel.Debug);
  1912. //相机的编号
  1913. //Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_FixedCameraPutNum.Address);
  1914. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)1);
  1915. }
  1916. else
  1917. {
  1918. SendTaskMessage($"触发固定相机锁附/组装拍照信号已关闭", MessageLevel.Alarm);
  1919. await plc.WriteNodeAsync(addressConfig.Out_FixedCameraPutStatus.Address, (Int16)0);
  1920. }
  1921. }
  1922. }
  1923. // 固定相机检测拍照
  1924. else if (addressConfig.In_FixedCameracheckExe.Address.Contains(tuple.nodeId))
  1925. {
  1926. if (tuple.value is bool state)
  1927. {
  1928. if (_LastFixedCameracheckExe != state)
  1929. {
  1930. _LastFixedCameracheckExe = state;
  1931. }
  1932. else
  1933. {
  1934. return;
  1935. }
  1936. if (state)
  1937. {
  1938. SendTaskMessage($"触发固定相机检测拍照...", MessageLevel.Debug);
  1939. //相机的编号
  1940. Int16 cameraIndex = plc.ReadNode<Int16>(addressConfig.In_FixedCameracheckNum.Address);
  1941. List<Task<(bool IsSucceed, double X, double Y, double U)>> visionTasks = new List<Task<(bool IsSucceed, double X, double Y, double U)>>();
  1942. List<ProcedureModel> visionProcesses = new List<ProcedureModel>();
  1943. if (currentProduct.MoveDownCamer1CheckProcedureId != Guid.Empty)
  1944. {
  1945. var process = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamer1CheckProcedureId);
  1946. if (process != null)
  1947. {
  1948. visionProcesses.Add(process);
  1949. }
  1950. }
  1951. if (currentProduct.MoveDownCamer2CheckProcedureId != Guid.Empty)
  1952. {
  1953. var process = _productService.GetCurrentProductProcedureModelById(currentProduct.MoveDownCamer2CheckProcedureId);
  1954. if (process != null)
  1955. {
  1956. visionProcesses.Add(process);
  1957. }
  1958. }
  1959. if (visionProcesses.Count <= 0)
  1960. {
  1961. SendTaskMessage($"未配置移动向下相机检测视觉流程", MessageLevel.Alarm);
  1962. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)2);
  1963. return;
  1964. }
  1965. // 执行视觉任务
  1966. var _cts = new CancellationTokenSource();
  1967. for (int i = 0; i < visionProcesses.Count; i++)
  1968. {
  1969. visionTasks.Add(_remoteCommandService.ExecutePhotoGetSinglePoint(visionProcesses[i], null, null, _cts.Token, i + 1, null));
  1970. }
  1971. var visionResults = await Task.WhenAll(visionTasks.ToArray());
  1972. if (isDryMode)
  1973. {
  1974. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)1);
  1975. return;
  1976. }
  1977. //获取visionResults集合中所有的结果,如果全部成功则为通过
  1978. bool allSucceed = true;
  1979. for (int i = 0; i < visionResults.Length; i++)
  1980. {
  1981. if (!visionResults[i].IsSucceed)
  1982. {
  1983. allSucceed = false;
  1984. break;
  1985. }
  1986. }
  1987. if (allSucceed)
  1988. {
  1989. SendTaskMessage($"固定相机检测OK", MessageLevel.Debug);
  1990. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)1);
  1991. return;
  1992. }
  1993. else
  1994. {
  1995. SendTaskMessage($"固定相机检测NG", MessageLevel.Error);
  1996. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)2);
  1997. return;
  1998. }
  1999. }
  2000. else
  2001. {
  2002. SendTaskMessage($"触发固定相机检测拍照信号已关闭", MessageLevel.Alarm);
  2003. await plc.WriteNodeAsync(addressConfig.Out_FixedCameracheckStatus.Address, (Int16)0);
  2004. }
  2005. }
  2006. }
  2007. // 多相机坐标合并
  2008. else if (addressConfig.In_RequestPosition.Address.Contains(tuple.nodeId))
  2009. {
  2010. if (tuple.value is Int16 state)
  2011. {
  2012. if (_LastRequestPosition != state)
  2013. {
  2014. _LastRequestPosition = state;
  2015. }
  2016. else
  2017. {
  2018. return;
  2019. }
  2020. if (state == 1)
  2021. {
  2022. SendTaskMessage($"收到多相机坐标合并请求,开始合并...", MessageLevel.Debug);
  2023. if (isDryMode)
  2024. {
  2025. var point1 = currentProduct.ScrewPoints[0].Clone();
  2026. SendTaskMessage($"点:1,{point1.X_Position:F3},{point1.Y_Position:F4},{point1.U_Position:F4}", MessageLevel.Info);
  2027. await point1.WriteToPlcAddress(addressConfig.Out_Screw, plc);
  2028. await plc.WriteNodeAsync(addressConfig.Out_WorkNum.Address, (Int16)1);
  2029. await plc.WriteNodeAsync(addressConfig.Out_CameraDone.Address, (Int16)1);
  2030. return;
  2031. }
  2032. double upCameraX = 0, upCameraY = 0, upCameraU = 0;
  2033. upCameraX = UpCameraPutResults[1].X;
  2034. upCameraY = UpCameraPutResults[1].Y;
  2035. upCameraU = UpCameraPutResults[1].Z;
  2036. //如果下相机拍照的次数是1,则判断用时拍照的相机是几个
  2037. int upCameraNum = _configService.GetSystemConfiguration().UpCameraPutNum;
  2038. if (upCameraNum == 2)
  2039. {
  2040. upCameraX = (UpCameraPutResults[1].X + UpCameraPutResults[2].X) / 2;
  2041. upCameraY = (UpCameraPutResults[1].Y + UpCameraPutResults[2].Y) / 2;
  2042. upCameraU = Common.CalculateAngleBetweenPointsDegrees(new PointF((float)UpCameraPutResults[1].X, (float)UpCameraPutResults[1].Y), new PointF((float)UpCameraPutResults[2].X, (float)UpCameraPutResults[2].Y));
  2043. }
  2044. var point = currentProduct.ScrewPoints[0].Clone();
  2045. var pn = Vector<double>.Build.Dense(new double[] { upCameraX, upCameraY });
  2046. //目标角度:
  2047. double angle = point.U_Position - (DowmCameraResults[1].Z - currentProduct.FixedUpCameraTempletAngle) + (upCameraU - currentProduct.MoveDownCamerTempletAngle);
  2048. var toolCoord = new ToolCoord();
  2049. toolCoord.SetTool(DowmCameraResults[1].X, DowmCameraResults[1].Y);
  2050. //将_PutPoint转换为Tool0下要走的点
  2051. var p0 = toolCoord.GetTool0Coord(pn, angle);
  2052. point.X_Position = (float)p0[0];
  2053. point.Y_Position = (float)p0[1];
  2054. point.U_Position = (float)angle;
  2055. PlaceActualCoord = new OpenCvSharp.Point3f(point.X_Position, point.Y_Position, point.U_Position);
  2056. SendTaskMessage($"点:1,{point.X_Position:F3},{point.Y_Position:F4},{point.U_Position:F4}", MessageLevel.Info);
  2057. await point.WriteToPlcAddress(addressConfig.Out_Screw, plc);
  2058. await plc.WriteNodeAsync(addressConfig.Out_WorkNum.Address, (Int16)1);
  2059. await plc.WriteNodeAsync(addressConfig.Out_CameraDone.Address, (Int16)1);
  2060. }
  2061. else
  2062. {
  2063. SendTaskMessage($"多相机坐标合并请求已结束或被取消,state={state}", MessageLevel.Alarm);
  2064. await plc.WriteNodeAsync(addressConfig.Out_CameraDone.Address, (Int16)0);
  2065. }
  2066. }
  2067. }
  2068. // 螺丝供料器螺丝递减
  2069. else if (addressConfig.In_PickINC.Address.Contains(tuple.nodeId))
  2070. {
  2071. if (tuple.value is Int16 state)
  2072. {
  2073. if (_LastPickINC != state)
  2074. {
  2075. _LastPickINC = state;
  2076. }
  2077. else
  2078. {
  2079. return;
  2080. }
  2081. if (state != 0)
  2082. {
  2083. SendTaskMessage($"螺丝供料器...", MessageLevel.Info);
  2084. await plc.WriteNodeAsync(addressConfig.In_PickINC.Address, (Int16)0);
  2085. }
  2086. }
  2087. }
  2088. // PLC请求二维码拍照
  2089. else if (addressConfig.In_QrCodePhotoRequest.Address.Contains(tuple.nodeId))
  2090. {
  2091. if (tuple.value is Int16 state)
  2092. {
  2093. if (_LastQrCodePhotoRequest != state)
  2094. {
  2095. _LastQrCodePhotoRequest = state;
  2096. }
  2097. else
  2098. {
  2099. return;
  2100. }
  2101. if (state == 1)
  2102. {
  2103. SendTaskMessage("收到PLC二维码拍照请求", MessageLevel.Debug);
  2104. // 四、几个非常重要的细节(工程级)
  2105. //1.Reset() 一定在发送命令前
  2106. //_scanDoneEvent.Reset();
  2107. //否则:
  2108. //上一次扫码的 Set() 还在
  2109. //本次 Wait() 会直接通过(严重 bug)
  2110. // 2.Wait() 不要直接在 UI 线程
  2111. //你这里是 async,用:
  2112. //await Task.Run(() => _scanDoneEvent.Wait(3000));
  2113. ScanValue = "";
  2114. _scanDoneEvent.Reset(); // 重要:先关门
  2115. await Scan_Client.SendAsync("T\r\n");
  2116. // 等待扫码结果,最多 3 秒
  2117. bool scanOk = await Task.Run(() => _scanDoneEvent.Wait(3000));
  2118. if (scanOk && !ScanValue.IsNullOrWhiteSpace())
  2119. {
  2120. PartSN = ScanValue;
  2121. //await plc.WriteNodeAsync(addressConfig.Out_PartCode.Address, PartSN);
  2122. SendTaskMessage($"二维码拍照成功,接收到值:{ScanValue}", MessageLevel.Info);
  2123. var stationConfig = _configService.GetDeviceInfo(0);
  2124. if (stationConfig.EnableMES)
  2125. {
  2126. (bool isSuccess, string response) = await _mesService.StationGetEx2Async(0, PartSN, "", 2);//询问零件码,是否可以使用
  2127. if (!isSuccess)//如果二维码已使用,则返回false
  2128. {
  2129. await plc.WriteNodeAsync(addressConfig.Out_QrCodePhotoResault.Address, (Int16)3);
  2130. return;
  2131. }
  2132. }
  2133. }
  2134. else
  2135. {
  2136. SendTaskMessage("二维码拍照失败或超时", MessageLevel.Alarm);
  2137. await plc.WriteNodeAsync(addressConfig.Out_QrCodePhotoResault.Address, (short)2);
  2138. }
  2139. }
  2140. else
  2141. {
  2142. SendTaskMessage("二维码拍照点位发送信号已关闭", MessageLevel.Alarm);
  2143. await plc.WriteNodeAsync(addressConfig.Out_QrCodePhotoResault.Address, (Int16)0);
  2144. }
  2145. }
  2146. }
  2147. // 抛料计数
  2148. else if (addressConfig.In_Throw.Address.Contains(tuple.nodeId))
  2149. {
  2150. if (tuple.value is bool state)
  2151. {
  2152. if (_LastThrowExe != state)
  2153. {
  2154. _LastThrowExe = state;
  2155. }
  2156. else
  2157. {
  2158. return;
  2159. }
  2160. if (state)
  2161. {
  2162. SendTaskMessage("收到抛料信号", MessageLevel.Info);
  2163. await _systemDatabaseService.RecordThrowNumberAsync(new ThrowRecord()
  2164. {
  2165. DayTime = DateTime.Now,
  2166. ThrowCount = 1
  2167. });
  2168. }
  2169. }
  2170. }
  2171. //切换成自动运行模式
  2172. else if (addressConfig.RunMode.Address.Contains(tuple.nodeId))
  2173. {
  2174. if (tuple.value is bool state)
  2175. {
  2176. if (_LastRunModel != state)
  2177. {
  2178. _LastRunModel = state;
  2179. }
  2180. else
  2181. {
  2182. return;
  2183. }
  2184. if (state)
  2185. {
  2186. SendTaskMessage("收到切换成自动模式", MessageLevel.Info);
  2187. StatusBackground = System.Windows.Media.Brushes.Green;
  2188. }
  2189. }
  2190. }
  2191. //切换成维修模式
  2192. else if (addressConfig.ManualMode.Address.Contains(tuple.nodeId))
  2193. {
  2194. if (tuple.value is bool state)
  2195. {
  2196. if (_LastManualMode != state)
  2197. {
  2198. _LastManualMode = state;
  2199. }
  2200. else
  2201. {
  2202. return;
  2203. }
  2204. if (state)
  2205. {
  2206. SendTaskMessage("收到切换成维修模式", MessageLevel.Info);
  2207. StatusBackground = System.Windows.Media.Brushes.Yellow;
  2208. }
  2209. else
  2210. {
  2211. SendTaskMessage("收到切换成自动模式", MessageLevel.Info);
  2212. StatusBackground = System.Windows.Media.Brushes.Green;
  2213. }
  2214. }
  2215. }
  2216. //切换成流线模式
  2217. else if (addressConfig.ClearMode.Address.Contains(tuple.nodeId))
  2218. {
  2219. if (tuple.value is bool state)
  2220. {
  2221. if (_LastClearMode != state)
  2222. {
  2223. _LastClearMode = state;
  2224. }
  2225. else
  2226. {
  2227. return;
  2228. }
  2229. if (state)
  2230. {
  2231. SendTaskMessage("收到切换成流线模式", MessageLevel.Info);
  2232. StatusBackground = System.Windows.Media.Brushes.Green;
  2233. }
  2234. }
  2235. }
  2236. //plc报警
  2237. else if (addressConfig.Fault.Address.Contains(tuple.nodeId))
  2238. {
  2239. if (tuple.value is bool state)
  2240. {
  2241. if (_LastFault != state)
  2242. {
  2243. _LastFault = state;
  2244. }
  2245. else
  2246. {
  2247. return;
  2248. }
  2249. if (state)
  2250. {
  2251. SendTaskMessage("收到PLC报警", MessageLevel.Error);
  2252. StatusBackground = System.Windows.Media.Brushes.Red;
  2253. }
  2254. else
  2255. {
  2256. SendTaskMessage("收到PLC消除报警", MessageLevel.Debug);
  2257. StatusBackground = System.Windows.Media.Brushes.Green;
  2258. }
  2259. }
  2260. }
  2261. else
  2262. {
  2263. // 过站检查
  2264. for (int i = 0; i < 10; i++)
  2265. {
  2266. if (string.Format(addressConfig.In_MesCheck.Address, i).Contains(tuple.nodeId))
  2267. {
  2268. if (tuple.value is Int16 state)
  2269. {
  2270. if (_LastMesCheck[i] != state)
  2271. {
  2272. _LastMesCheck[i] = state;
  2273. }
  2274. else
  2275. {
  2276. return;
  2277. }
  2278. var code = plc.ReadNode<string>(string.Format(addressConfig.In_Code.Address, i));
  2279. string comp = "";
  2280. //过站请求
  2281. if (state == 1)
  2282. {
  2283. //获取过站时间
  2284. _LastMesCheckTime[i] = (await _mesService.GetServerTimeAsync(i, code, 2)).Now;
  2285. //获取当前工位的配置
  2286. var stationConfig = _configService.GetDeviceInfo(i);
  2287. if (stationConfig.EnableDoubleMes)
  2288. {
  2289. SendTaskMessage($"收到{i}:{stationConfig.DeviceName}过站检查请求(当站是否生产)(当前需要双MES验证)...", MessageLevel.Debug);
  2290. LogHelper.WriteLogMes($"【mes开始QUERY】");
  2291. SendTaskMessage($"mes开始QUERY", MessageLevel.Info);
  2292. (bool isSuccess, string response) = await _mesService.StationGetExAsync(i, code, "", 2);//询问mes
  2293. if (isSuccess)
  2294. {
  2295. LogHelper.WriteLogMes($"询问mes成功");
  2296. SendTaskMessage($"询问mes成功:{response}", MessageLevel.Debug);
  2297. string ProductMainSN_Temp = "";
  2298. string[] item = response.Split('\n');
  2299. //获取过度件sn
  2300. string snItem = item.FirstOrDefault(f => f.Contains("sn="));
  2301. if (snItem != null)
  2302. {
  2303. ProductMainSN_Temp = snItem.Replace("sn=", "").Trim();
  2304. SendTaskMessage($"过度件sn:{ProductMainSN_Temp}", MessageLevel.Info);
  2305. }
  2306. (bool isSuccess2, string response2) = await _mesService.StationGetAsync(i, ProductMainSN_Temp, "", 2);//询问mes
  2307. if (isSuccess2)
  2308. {
  2309. LogHelper.WriteLogMes($"第二次询问mes成功");
  2310. SendTaskMessage($"第二次询问mes成功:{response2}", MessageLevel.Debug);
  2311. item = response2.Split('\n');
  2312. //获取产品主sn和wo用于后续上传数据使用
  2313. snItem = item.FirstOrDefault(f => f.Contains("sn="));
  2314. if (snItem != null)
  2315. {
  2316. ProductMainSN[i] = snItem.Replace("sn=", "").Trim();
  2317. if (i == 0)
  2318. {
  2319. _productService.CurrentProductCode = ProductMainSN[i];
  2320. //_eventAggregator.GetEvent<DelaySaveImageNotification>().Publish(true);//通知界面延迟保存图片,等待MES查询结果返回,避免图片和数据不同步
  2321. }
  2322. SendTaskMessage($"产品主sn:{ProductMainSN[i]}", MessageLevel.Info);
  2323. }
  2324. string woItem = item.FirstOrDefault(f => f.Contains("wo="));
  2325. if (woItem != null)
  2326. {
  2327. wo[i] = woItem.Replace("wo=", "").Trim();
  2328. SendTaskMessage($"工单信息:{wo[i]}", MessageLevel.Info);
  2329. }
  2330. string modelItem = item.FirstOrDefault(f => f.Contains("model_num="));
  2331. if (modelItem != null)
  2332. {
  2333. model_num[i] = modelItem.Replace("model_num=", "").Trim();
  2334. SendTaskMessage($"model_num:{model_num[i]}", MessageLevel.Info);
  2335. }
  2336. string colorItem = item.FirstOrDefault(f => f.Contains("color="));
  2337. if (colorItem != null)
  2338. {
  2339. color[i] = colorItem.Replace("color=", "").Trim();
  2340. SendTaskMessage($"color:{color[i]}", MessageLevel.Info);
  2341. }
  2342. string ppidItem = item.FirstOrDefault(f => f.Contains("ppid="));
  2343. if (ppidItem != null)
  2344. {
  2345. ppid[i] = ppidItem.Replace("ppid=", "").Trim();
  2346. SendTaskMessage($"ppid:{ppid[i]}", MessageLevel.Info);
  2347. }
  2348. string revisionItem = item.FirstOrDefault(f => f.Contains("stage="));
  2349. if (revisionItem != null)
  2350. {
  2351. revision[i] = revisionItem.Replace("stage=", "").Trim();
  2352. SendTaskMessage($"stage:{revision[i]}", MessageLevel.Info);
  2353. }
  2354. //切换产品
  2355. if (i == 0)//i=0时才会切换产品
  2356. {
  2357. var q = await _systemDatabaseService.QueryProductFromMesAsync(model_num[i], color[i]);
  2358. if (q != null && !string.IsNullOrEmpty(q.ProductName))
  2359. {
  2360. ProductList = new ObservableCollection<ProductModel>(_productService.GetAllProducts());
  2361. Guid productId = Guid.Empty;
  2362. foreach (var itt in ProductList)
  2363. {
  2364. if (itt.Name == q.ProductName)
  2365. {
  2366. productId = itt.ID;
  2367. break;
  2368. }
  2369. }
  2370. if (currentProduct.ID != productId)
  2371. {
  2372. //切换产品
  2373. await _productService.LoadProductAsync(productId);
  2374. _productService.SetCurrentProduct(productId);
  2375. await WriteParameterToPlcExAsync();
  2376. SendTaskMessage($"切换产品成功", MessageLevel.Debug);
  2377. }
  2378. }
  2379. }
  2380. //产品发生改变并且供料器发生了变化时,需要通知PLC进行取料更改
  2381. await plc.WriteNodeAsync(addressConfig.Out_ScrewFeederIsChanged.Address, (Int16)1); //不发生改变
  2382. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)1);
  2383. }
  2384. else
  2385. {
  2386. LogHelper.WriteLogMes($"第二次询问mes失败");
  2387. SendTaskMessage($"第二次询问mes失败:{response2}", MessageLevel.Error);
  2388. //产品发生改变并且供料器发生了变化时,需要通知PLC进行取料更改
  2389. await plc.WriteNodeAsync(addressConfig.Out_ScrewFeederIsChanged.Address, (Int16)1); //不发生改变
  2390. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)2);
  2391. }
  2392. }
  2393. else
  2394. {
  2395. LogHelper.WriteLogMes($"询问mes失败");
  2396. SendTaskMessage($"询问mes失败:{response}", MessageLevel.Error);
  2397. //产品发生改变并且供料器发生了变化时,需要通知PLC进行取料更改
  2398. await plc.WriteNodeAsync(addressConfig.Out_ScrewFeederIsChanged.Address, (Int16)1); //不发生改变
  2399. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)2);
  2400. }
  2401. LogHelper.WriteLogMes($"【mes结束QUERY】");
  2402. SendTaskMessage($"mes结束QUERY", MessageLevel.Info);
  2403. }
  2404. else if (stationConfig.EnableMES)
  2405. {
  2406. SendTaskMessage($"收到{i}:{stationConfig.DeviceName}过站检查请求(当站是否生产)(当前不需要双MES验证)...", MessageLevel.Debug);
  2407. LogHelper.WriteLogMes($"【mes开始QUERY】");
  2408. SendTaskMessage($"mes开始QUERY", MessageLevel.Info);
  2409. (bool isSuccess, string response) = await _mesService.StationGetAsync(i, code, "", 2);//询问mes
  2410. if (isSuccess)
  2411. {
  2412. string[] item = response.Split('\n');
  2413. //获取产品主sn和wo用于后续上传数据使用
  2414. string snItem = item.FirstOrDefault(f => f.Contains("sn="));
  2415. if (snItem != null)
  2416. {
  2417. ProductMainSN[i] = snItem.Replace("sn=", "").Trim();
  2418. if (i == 0)
  2419. {
  2420. _productService.CurrentProductCode = ProductMainSN[i];
  2421. //_eventAggregator.GetEvent<DelaySaveImageNotification>().Publish(true);//通知界面延迟保存图片,等待MES查询结果返回,避免图片和数据不同步
  2422. }
  2423. SendTaskMessage($"产品主sn:{ProductMainSN[i]}", MessageLevel.Info);
  2424. }
  2425. string woItem = item.FirstOrDefault(f => f.Contains("wo="));
  2426. if (woItem != null)
  2427. {
  2428. wo[i] = woItem.Replace("wo=", "").Trim();
  2429. SendTaskMessage($"工单信息:{wo[i]}", MessageLevel.Info);
  2430. }
  2431. string modelItem = item.FirstOrDefault(f => f.Contains("model_num="));
  2432. if (modelItem != null)
  2433. {
  2434. model_num[i] = modelItem.Replace("model_num=", "").Trim();
  2435. SendTaskMessage($"model_num:{model_num[i]}", MessageLevel.Info);
  2436. }
  2437. string colorItem = item.FirstOrDefault(f => f.Contains("color="));
  2438. if (colorItem != null)
  2439. {
  2440. color[i] = colorItem.Replace("color=", "").Trim();
  2441. SendTaskMessage($"color:{color[i]}", MessageLevel.Info);
  2442. }
  2443. string ppidItem = item.FirstOrDefault(f => f.Contains("ppid="));
  2444. if (ppidItem != null)
  2445. {
  2446. ppid[i] = ppidItem.Replace("ppid=", "").Trim();
  2447. SendTaskMessage($"ppid:{ppid[i]}", MessageLevel.Info);
  2448. }
  2449. string revisionItem = item.FirstOrDefault(f => f.Contains("stage="));
  2450. if (revisionItem != null)
  2451. {
  2452. revision[i] = revisionItem.Replace("stage=", "").Trim();
  2453. SendTaskMessage($"revision:{revision[i]}", MessageLevel.Info);
  2454. }
  2455. LogHelper.WriteLogMes($"询问mes成功");
  2456. SendTaskMessage($"询问mes成功:{response}", MessageLevel.Debug);
  2457. //切换产品
  2458. if (i == 0)//i=0时才会切换产品
  2459. {
  2460. var q = await _systemDatabaseService.QueryProductFromMesAsync(model_num[i], color[i]);
  2461. if (q != null && !string.IsNullOrEmpty(q.ProductName))
  2462. {
  2463. ProductList = new ObservableCollection<ProductModel>(_productService.GetAllProducts());
  2464. Guid productId = Guid.Empty;
  2465. foreach (var itt in ProductList)
  2466. {
  2467. if (itt.Name == q.ProductName)
  2468. {
  2469. productId = itt.ID;
  2470. break;
  2471. }
  2472. }
  2473. if (currentProduct.ID != productId)
  2474. {
  2475. //切换产品
  2476. await _productService.LoadProductAsync(productId);
  2477. _productService.SetCurrentProduct(productId);
  2478. await WriteParameterToPlcExAsync();
  2479. SendTaskMessage($"切换产品成功", MessageLevel.Debug);
  2480. }
  2481. }
  2482. }
  2483. //产品发生改变并且供料器发生了变化时,需要通知PLC进行取料更改
  2484. await plc.WriteNodeAsync(addressConfig.Out_ScrewFeederIsChanged.Address, (Int16)1); //不发生改变
  2485. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)1);
  2486. }
  2487. else
  2488. {
  2489. LogHelper.WriteLogMes($"询问mes失败");
  2490. SendTaskMessage($"询问mes失败:{response}", MessageLevel.Error);
  2491. //产品发生改变并且供料器发生了变化时,需要通知PLC进行取料更改
  2492. await plc.WriteNodeAsync(addressConfig.Out_ScrewFeederIsChanged.Address, (Int16)1); //不发生改变
  2493. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)2);
  2494. }
  2495. LogHelper.WriteLogMes($"【mes结束QUERY】");
  2496. SendTaskMessage($"mes结束QUERY", MessageLevel.Info);
  2497. }
  2498. else
  2499. {
  2500. ProductMainSN[i] = DateTime.Now.ToString();
  2501. if (i == 0)
  2502. {
  2503. _productService.CurrentProductCode = ProductMainSN[i];
  2504. //_eventAggregator.GetEvent<DelaySaveImageNotification>().Publish(true);//通知界面延迟保存图片,等待MES查询结果返回,避免图片和数据不同步
  2505. }
  2506. LogHelper.WriteLogMes("未启用mes");
  2507. SendTaskMessage("未启用mes", MessageLevel.Error);
  2508. //产品发生改变并且供料器发生了变化时,需要通知PLC进行取料更改
  2509. await plc.WriteNodeAsync(addressConfig.Out_ScrewFeederIsChanged.Address, (Int16)1); //不发生改变
  2510. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)1);
  2511. }
  2512. }
  2513. // 上传本站数据
  2514. else if (state == 2)
  2515. {
  2516. DFC.Clear();//CTQ数据集合
  2517. //获取当前工位的配置
  2518. var stationConfig = _configService.GetDeviceInfo(i);
  2519. SendTaskMessage($"收到{i}:{stationConfig.DeviceName}上传本站数据请求...", MessageLevel.Debug);
  2520. //从服务器中获取当前时间
  2521. var serverTimeResult = await _mesService.GetServerTimeAsync(i, ProductMainSN[i], 2);
  2522. double ct = serverTimeResult.Now.Subtract(_LastMesCheckTime[i]).TotalSeconds;
  2523. if (i == 0)
  2524. {
  2525. CTtime = ct;
  2526. _eventAggregator.GetEvent<DelaySaveImageNotification>().Publish(true);//通知界面延迟保存图片,等待MES查询结果返回,避免图片和数据不同步
  2527. }
  2528. //读取产品结果
  2529. Int16 resultIndex = plc.ReadNode<Int16>(string.Format(addressConfig.In_Result.Address, i));
  2530. //读取压力值
  2531. float pressure = plc.ReadNode<float>(string.Format(addressConfig.In_PressureValue.Address, i));
  2532. #region 组装结果显示列表信息
  2533. AssemblyRecord assemblyRecord = new AssemblyRecord();
  2534. assemblyRecord.ProductSN = ProductMainSN[i];
  2535. assemblyRecord.RecipeName = currentProduct.Name;
  2536. assemblyRecord.PartSN = PartSN;
  2537. assemblyRecord.AssemblyDurationSeconds = ct;
  2538. assemblyRecord.AssemblyPressure = pressure;
  2539. assemblyRecord.DeviceId = i;
  2540. assemblyRecord.DeviceName = stationConfig.DeviceName;
  2541. assemblyRecord.OperatorName = _systemDatabaseService.GetCurrentUser().UserName;
  2542. assemblyRecord.Success = resultIndex == 1 ? true : false;
  2543. assemblyRecord.DownCameraCoord1 = "";
  2544. assemblyRecord.DownCameraCoord2 = "";
  2545. assemblyRecord.DownCameraCoord3 = "";
  2546. assemblyRecord.DownCameraCoord4 = "";
  2547. assemblyRecord.PickMoveCameraCoord = "";
  2548. assemblyRecord.PlaceMoveCameraCoord1 = "";
  2549. assemblyRecord.PlaceMoveCameraCoord2 = "";
  2550. assemblyRecord.PlaceMoveCameraCoord3 = "";
  2551. assemblyRecord.PlaceMoveCameraCoord4 = "";
  2552. assemblyRecord.PlaceActualCoord = "";
  2553. //目前只记录当前站
  2554. if (i == 0)
  2555. {
  2556. await _systemDatabaseService.RecordProductionAsync(new ProductionRecord()
  2557. {
  2558. ProductName = currentProduct.Name,
  2559. ProductCode = ProductMainSN[i],
  2560. DeviceId = i,
  2561. DeviceName = "",
  2562. Category = resultIndex == 1 ? "OK" : "NG",
  2563. Quantity = 1,
  2564. Remark = $"TotalSeconds:{ct.ToString("F2")}",
  2565. UserName = _systemDatabaseService.GetCurrentUser().UserName,
  2566. });
  2567. assemblyRecord.DownCameraCoord1 = $"{DowmCameraResults[1].X:F3},{DowmCameraResults[1].Y:F3},{DowmCameraResults[1].Z:F3}";
  2568. assemblyRecord.PlaceMoveCameraCoord1 = $"{UpCameraPutResults[1].X:F3},{UpCameraPutResults[1].Y:F3},{UpCameraPutResults[1].Z:F3}";
  2569. assemblyRecord.PlaceMoveCameraCoord2 = $"{UpCameraPutResults[2].X:F3},{UpCameraPutResults[2].Y:F3},{UpCameraPutResults[2].Z:F3}";
  2570. assemblyRecord.PlaceActualCoord = $"{PlaceActualCoord.X:F3},{PlaceActualCoord.Y:F3},{PlaceActualCoord.Z:F3}";
  2571. App.Current.Dispatcher.Invoke(() =>
  2572. {
  2573. _eventAggregator.GetEvent<AssemblyFinishNotification>().Publish(assemblyRecord);
  2574. });
  2575. }
  2576. await _systemDatabaseService.RecordAssemblyAsync(assemblyRecord);
  2577. #endregion
  2578. LogHelper.WriteLogMes($"【mes开始ADD】");
  2579. SendTaskMessage($"mes开始ADD", MessageLevel.Info);
  2580. string assypress = ""; string cc = "";
  2581. cc = string.Join(",", mes_cc.OrderBy(kv => kv.Key, StringComparer.Ordinal).Select(kv => kv.Value));
  2582. //data.Add("CC1", mes_cc["1"]);
  2583. //data.Add("CC1", mes_cc["2"]);
  2584. //SendTaskMessage($"CC1:{mes_cc["1"]},CC2:{mes_cc["2"]}", MessageLevel.Info);
  2585. assypress = currentPressure[i].ToString("F2");
  2586. SendTaskMessage($"cc:{cc},组装压力:{assypress}", MessageLevel.Debug);
  2587. #region CSV数据
  2588. DFC.Clear();
  2589. bool assyPress = resultIndex == 1 ? true : false;
  2590. string midValue = "NA", saveppid = "NA";
  2591. midValue = ((currentProduct.GlobalParamEx.CC1DownLimit + currentProduct.GlobalParamEx.CC1UpLimit) / 2).ToString("F3");
  2592. if (stationConfig.SaveCsvPPID) saveppid = ppid[i];
  2593. DFC.Add(new DataFormCtq
  2594. {
  2595. PPID = saveppid,
  2596. PROCESS_NAME = stationConfig.DataInfo.PROCESS_NAME,
  2597. PROCESS_START_TIME = _LastMesCheckTime[i].ToString("yyyy-MM-ddTHH:mm:ss.fffffff") + "+08:00",
  2598. CTQ_NAME = "CC1",
  2599. CTQ_VALUE = mes_cc["1"],
  2600. CTQ_LSL = currentProduct.GlobalParamEx.CC1DownLimit.ToString("F3"),
  2601. CTQ_USL = currentProduct.GlobalParamEx.CC1UpLimit.ToString("F3"),
  2602. PROCESS_END_TIME = serverTimeResult.Now.ToString("yyyy-MM-ddTHH:mm:ss.fffffff") + "+08:00",
  2603. SUPPLIER_NAME = stationConfig.DataInfo.SUPPLIER_NAME,
  2604. COMMODITY_TYPE = stationConfig.DataInfo.COMMODITY_TYPE,
  2605. REVISION = stationConfig.DataInfo.REVISION+"_"+ revision[i],
  2606. WO = wo[i],
  2607. MFG_LOT = stationConfig.DataInfo.MFG_LOT,
  2608. MFG_ASSY_LINE = stationConfig.DataInfo.MFG_ASSY_LINE,
  2609. PROCESS_OUTCOME = assyPress ? "Pass" : "Fail",
  2610. PROCESS_MACHINE_ID = stationConfig.DataInfo.PROCESS_MACHINE_ID,
  2611. CTQ_UNIT_OF_MEASURE = "mm",
  2612. ERROR_MESSAGE = assyPress ? "NA" : "CC OOS",
  2613. PD_ATTR_01 = ProductMainSN[i],
  2614. PD_ATTR_02 = midValue,
  2615. PD_ATTR_03 = PartSN,
  2616. PD_ATTR_04 = code,
  2617. PD_ATTR_05 = "NA",
  2618. });
  2619. midValue = ((currentProduct.GlobalParamEx.CC2DownLimit + currentProduct.GlobalParamEx.CC2UpLimit) / 2).ToString("F3");
  2620. DFC.Add(new DataFormCtq
  2621. {
  2622. PPID = saveppid,
  2623. PROCESS_NAME = stationConfig.DataInfo.PROCESS_NAME,
  2624. PROCESS_START_TIME = _LastMesCheckTime[i].ToString("yyyy-MM-ddTHH:mm:ss.fffffff") + "+08:00",
  2625. CTQ_NAME = "CC2",
  2626. CTQ_VALUE = mes_cc["2"],
  2627. CTQ_LSL = currentProduct.GlobalParamEx.CC2DownLimit.ToString("F3"),
  2628. CTQ_USL = currentProduct.GlobalParamEx.CC2UpLimit.ToString("F3"),
  2629. PROCESS_END_TIME = serverTimeResult.Now.ToString("yyyy-MM-ddTHH:mm:ss.fffffff") + "+08:00",
  2630. SUPPLIER_NAME = stationConfig.DataInfo.SUPPLIER_NAME,
  2631. COMMODITY_TYPE = stationConfig.DataInfo.COMMODITY_TYPE,
  2632. REVISION = stationConfig.DataInfo.REVISION + "_" + revision[i],
  2633. WO = wo[i],
  2634. MFG_LOT = stationConfig.DataInfo.MFG_LOT,
  2635. MFG_ASSY_LINE = stationConfig.DataInfo.MFG_ASSY_LINE,
  2636. PROCESS_OUTCOME = assyPress ? "Pass" : "Fail",
  2637. PROCESS_MACHINE_ID = stationConfig.DataInfo.PROCESS_MACHINE_ID,
  2638. CTQ_UNIT_OF_MEASURE = "mm",
  2639. ERROR_MESSAGE = assyPress ? "NA" : "CC OOS",
  2640. PD_ATTR_01 = ProductMainSN[i],
  2641. PD_ATTR_02 = midValue,
  2642. PD_ATTR_03 = PartSN,
  2643. PD_ATTR_04 = code,
  2644. PD_ATTR_05 = "NA",
  2645. });
  2646. midValue = ((currentProduct.GlobalParamEx.DownPressure.PressureDownLimit + currentProduct.GlobalParamEx.DownPressure.PressureUpLimit) / 2).ToString("F3");
  2647. DFC.Add(new DataFormCtq
  2648. {
  2649. PPID = saveppid,
  2650. PROCESS_NAME = stationConfig.DataInfo.PROCESS_NAME,
  2651. PROCESS_START_TIME = _LastMesCheckTime[i].ToString("yyyy-MM-ddTHH:mm:ss.fffffff") + "+08:00",
  2652. CTQ_NAME = "Assy_Pressure",
  2653. CTQ_VALUE = Math.Round(double.Parse(assypress), 3).ToString(),
  2654. CTQ_LSL = currentProduct.GlobalParamEx.DownPressure.PressureDownLimit.ToString("F3"),
  2655. CTQ_USL = currentProduct.GlobalParamEx.DownPressure.PressureUpLimit.ToString("F3"),
  2656. PROCESS_END_TIME = serverTimeResult.Now.ToString("yyyy-MM-ddTHH:mm:ss.fffffff") + "+08:00",
  2657. SUPPLIER_NAME = stationConfig.DataInfo.SUPPLIER_NAME,
  2658. COMMODITY_TYPE = stationConfig.DataInfo.COMMODITY_TYPE,
  2659. REVISION = stationConfig.DataInfo.REVISION + "_" + revision[i],
  2660. WO = wo[i],
  2661. MFG_LOT = stationConfig.DataInfo.MFG_LOT,
  2662. MFG_ASSY_LINE = stationConfig.DataInfo.MFG_ASSY_LINE,
  2663. PROCESS_OUTCOME = assyPress ? "Pass" : "Fail",
  2664. PROCESS_MACHINE_ID = stationConfig.DataInfo.PROCESS_MACHINE_ID,
  2665. CTQ_UNIT_OF_MEASURE = "kg",
  2666. ERROR_MESSAGE = assyPress ? "NA" : "Assy_Pressure OOS",
  2667. PD_ATTR_01 = ProductMainSN[i],
  2668. PD_ATTR_02 = midValue,
  2669. PD_ATTR_03 = PartSN,
  2670. PD_ATTR_04 = code,
  2671. PD_ATTR_05 = "NA",
  2672. });
  2673. #endregion
  2674. //cc-复检cc,assypress-组装站压力
  2675. (bool isSuccess, string response) = await _mesService.SubmitGetAsync(i, ProductMainSN[i], comp, cc, assypress, resultIndex == 1 ? true : false, _LastMesCheckTime[i], serverTimeResult.Now);
  2676. if (!stationConfig.EnableMES || isSuccess)
  2677. {
  2678. LogHelper.WriteLogMes($"上传mes成功");
  2679. SendTaskMessage($"上传mes成功", MessageLevel.Debug);
  2680. }
  2681. else
  2682. {
  2683. LogHelper.WriteLogMes($"上传mes失败");
  2684. SendTaskMessage($"上传mes失败", MessageLevel.Error);
  2685. }
  2686. //是否保存当前的产品记录至CSV?
  2687. if (stationConfig.SaveCsv)
  2688. {
  2689. //判断锁付路径字符串是否为空,如果不为空则保存,否则不保存
  2690. if (!string.IsNullOrEmpty(stationConfig.SaveCsvPath))
  2691. {
  2692. bool recordResult = RecordStationResult(i, DFC, ProductMainSN[i], serverTimeResult.Now.Subtract(_LastMesCheckTime[i]).TotalSeconds, _LastMesCheckTime[i], stationConfig.SaveCsvPath);
  2693. if (recordResult)
  2694. {
  2695. SendTaskMessage($"{i}:{stationConfig.DeviceName}产品记录保存成功", MessageLevel.Debug);
  2696. //上传数据
  2697. try
  2698. {
  2699. if (stationConfig.EnableMES)
  2700. {
  2701. DateTime dt = DateTime.Now;
  2702. string filename = $"{ProductMainSN[i]}_{dt.ToString("yyyyMMddHHmmss")}";
  2703. string csvfilename = $"{i}_{stationConfig.DeviceName}_{dt.ToString("yyyy-MM-dd")}";
  2704. var device = _configService.GetDeviceInfo(i);
  2705. var systemConfig = _configService.GetSystemConfiguration();
  2706. var pressureSensorConfig = systemConfig.PressureSensorConfig.FirstOrDefault();
  2707. (bool isSuc, string resp) = await _mesService.SendFtpFileAsync(ProductMainSN[i], filename);
  2708. if (isSuc)
  2709. {
  2710. LogHelper.WriteLogMes($"上传数据成功");
  2711. SendTaskMessage($"上传数据成功", MessageLevel.Debug);
  2712. string filePath = $"D:\\image\\Recored\\{dt.ToString("yyyy-MM")}\\{dt.ToString("MM-dd")}\\{currentProduct.Name}\\{ProductMainSN[i]}";
  2713. string source_csv2 = $"{stationConfig.SaveCsvPath}\\{dt.ToString("yyyy-MM")}\\{i}_{stationConfig.DeviceName}_{dt.ToString("yyyy-MM-dd")}";
  2714. if (!Directory.Exists(filePath))
  2715. {
  2716. Directory.CreateDirectory(filePath);
  2717. }
  2718. //复制csv
  2719. string source_csv = $"{stationConfig.SaveCsvPath}\\{dt.ToString("yyyy-MM")}\\{i}_{stationConfig.DeviceName}_{dt.ToString("yyyy-MM-dd")}.csv";
  2720. string target_csv = Path.Combine(filePath, Path.GetFileName(source_csv)); ;
  2721. File.Copy(source_csv, target_csv, true);
  2722. //复制log
  2723. string source_log = $"..\\Log\\LogInfo\\{dt.ToString("yyyy-MM")}\\{dt.ToString("yyyy-MM-dd")}.txt";
  2724. string target_log = Path.Combine(filePath, Path.GetFileName(source_log));
  2725. File.Copy(source_log, target_log, true);
  2726. if (pressureSensorConfig.IsSavePressureCurve && i == pngindex)
  2727. {
  2728. //复制曲线图
  2729. string pngfile_path = $"{pressureSensorConfig.PressureCurvePath}\\{dt.ToString("yyyy-MM")}\\{dt.ToString("yyyy-MM-dd")}\\{currentProduct.Name}\\{ProductMainSN[i]}";
  2730. string pngfileName = $"{pngfile_path}\\pressure-{ProductMainSN[i]}-{pngindex}.png";
  2731. string target_png = Path.Combine(filePath, Path.GetFileName(pngfileName));
  2732. File.Copy(pngfileName, target_png, true);
  2733. SendTaskMessage($"曲线图{pngindex}复制完成", MessageLevel.Debug);
  2734. }
  2735. CompressionImage(filePath, filename, device.Station, device.FixtureId);
  2736. //上传csv
  2737. bool isAfter20 = dt.Hour >= 20;
  2738. //判断是否是新的一天
  2739. bool isNewDay = dt.Date != _lastCompressDate.Date;
  2740. //当天还没执行过压缩
  2741. if (isAfter20 && isNewDay && !_hasCompressedToday)
  2742. {
  2743. // 执行压缩
  2744. CompressionImage(source_csv2, csvfilename, device.Station, device.FixtureId);
  2745. _lastCompressDate = dt;
  2746. _hasCompressedToday = true;
  2747. LogHelper.WriteLogMes("csv上传数据成功");
  2748. SendTaskMessage($"csv上传数据成功", MessageLevel.Debug);
  2749. }
  2750. // 跨天后重置当天执行标记
  2751. if (!isNewDay && _hasCompressedToday)
  2752. {
  2753. _hasCompressedToday = false;
  2754. }
  2755. }
  2756. else
  2757. {
  2758. LogHelper.WriteLogMes($"上传数据失败");
  2759. SendTaskMessage($"上传数据失败", MessageLevel.Error);
  2760. }
  2761. }
  2762. else
  2763. {
  2764. LogHelper.WriteLogMes($"未启用mes");
  2765. SendTaskMessage($"未启用mes", MessageLevel.Error);
  2766. }
  2767. }
  2768. catch (Exception ex)
  2769. {
  2770. SendTaskMessage($"上传数据时出错:{ex.Message}", MessageLevel.Error);
  2771. LogHelper.WriteLogError($"上传数据时出错", ex);
  2772. }
  2773. }
  2774. else
  2775. {
  2776. SendTaskMessage($"{i}:{stationConfig.DeviceName}产品记录保存失败", MessageLevel.Error);
  2777. }
  2778. }
  2779. else
  2780. {
  2781. SendTaskMessage($"{i}:{stationConfig.DeviceName}工位未配置保存路径,无法保存产品记录", MessageLevel.Error);
  2782. }
  2783. }
  2784. else
  2785. {
  2786. SendTaskMessage($"{i}:{stationConfig.DeviceName}工位未配置保存产品记录", MessageLevel.Debug);
  2787. }
  2788. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)3);
  2789. LogHelper.WriteLogMes($"【mes结束ADD】");
  2790. SendTaskMessage($"mes结束ADD", MessageLevel.Info);
  2791. mes_cc.Clear();
  2792. return;
  2793. }
  2794. else
  2795. {
  2796. SendTaskMessage($"{i}过站检查信号:state={state},处理为默认状态", MessageLevel.Alarm);
  2797. await plc.WriteNodeAsync(string.Format(addressConfig.Out_MesStatus.Address, i), (Int16)0);
  2798. return;
  2799. }
  2800. }
  2801. }
  2802. }
  2803. //开始/停止 组装/锁附
  2804. for (int i = 0; i < 7; i++)
  2805. {
  2806. //开始组装
  2807. if (string.Format(addressConfig.In_WorkStart.Address, i).Contains(tuple.nodeId))
  2808. {
  2809. if (tuple.value is Int16 state)
  2810. {
  2811. if (_LastWorkStart[i] != state)
  2812. {
  2813. _LastWorkStart[i] = state;
  2814. }
  2815. else
  2816. {
  2817. return;
  2818. }
  2819. var code = plc.ReadNode<string>(string.Format(addressConfig.In_Code.Address, i));
  2820. if (state == 1)
  2821. {
  2822. SendTaskMessage($"收到开始保压信号[{i}]...", MessageLevel.Debug);
  2823. // 开始采集压力值
  2824. StartPressureCollection(currentProduct.Name, ProductMainSN[i], i);
  2825. }
  2826. else
  2827. {
  2828. SendTaskMessage($"收到关闭开始保压信号[{i}]...", MessageLevel.Debug);
  2829. }
  2830. }
  2831. }
  2832. //停止组装
  2833. else if (string.Format(addressConfig.In_WorkDone.Address, i).Contains(tuple.nodeId))
  2834. {
  2835. if (tuple.value is Int16 state)
  2836. {
  2837. if (_LastWorkDone[i] != state)
  2838. {
  2839. _LastWorkDone[i] = state;
  2840. }
  2841. else
  2842. {
  2843. return;
  2844. }
  2845. if (state == 1)
  2846. {
  2847. SendTaskMessage($"收到停止压力信号[{i}]...", MessageLevel.Debug);
  2848. //获取当前锁付点
  2849. //var screwPoint = currentProduct.ScrewPoints.FirstOrDefault(p => p.Number == positionIndex);
  2850. //读取压力值
  2851. float pressure = plc.ReadNode<float>(string.Format(addressConfig.In_PressureValue.Address, i));
  2852. currentPressure[i] = pressure;
  2853. SendTaskMessage($"[{i}]压力:{pressure}", MessageLevel.Info);
  2854. await plc.WriteNodeAsync(string.Format(addressConfig.In_WorkDone.Address, i), (Int16)0);
  2855. var code = plc.ReadNode<string>(string.Format(addressConfig.In_Code.Address, i));
  2856. // 停止采集压力并保存
  2857. await StopAndSavePressureCollectionAsync(currentProduct.Name, ProductMainSN[i], i);
  2858. }
  2859. else
  2860. {
  2861. SendTaskMessage($"停止压力信号[{i}]已关闭", MessageLevel.Alarm);
  2862. }
  2863. }
  2864. }
  2865. }
  2866. }
  2867. }
  2868. catch (Exception ex)
  2869. {
  2870. SendTaskMessage(ex.Message, MessageLevel.Error);
  2871. }
  2872. }
  2873. #endregion
  2874. #region 方法
  2875. private void SendTaskMessage(string msg, MessageLevel level)
  2876. {
  2877. App.Current.Dispatcher.Invoke(() =>
  2878. {
  2879. _eventAggregator.GetEvent<TaskMessageNotification>().Publish(new Models.MessageStruct() { Message = msg, level = level });
  2880. });
  2881. }
  2882. #region Pressure collection helpers
  2883. public void InitPressure()
  2884. {
  2885. for (int i = 0; i < _pressureSamples.Length; i++)
  2886. {
  2887. _pressureSamples[i] = new List<(DateTime, float)>();
  2888. }
  2889. for (int i = 0; i < _pressureCts.Length; i++)
  2890. {
  2891. _pressureCts[i] = new CancellationTokenSource();
  2892. }
  2893. for (int i = 0; i < _pressureTimeoutCts.Length; i++)
  2894. {
  2895. _pressureTimeoutCts[i] = new CancellationTokenSource();
  2896. }
  2897. for (int i = 0; i < _pressureLinkedCts.Length; i++)
  2898. {
  2899. _pressureLinkedCts[i] = new CancellationTokenSource();
  2900. }
  2901. }
  2902. /// <summary>
  2903. /// 开始采集压力值
  2904. /// </summary>
  2905. /// <param name="productName">配方名称</param>
  2906. /// <param name="productCode">产品编号</param>
  2907. /// <param name="Index">编号</param>
  2908. private void StartPressureCollection(string productName, string productCode, int Index)
  2909. {
  2910. try
  2911. {
  2912. // cancel existing if any
  2913. //_pressureCts[Index]?.Cancel();
  2914. //_pressureTimeoutCts[Index]?.Cancel();
  2915. //_pressureLinkedCts[Index]?.Dispose();
  2916. _pressureSamples[Index]?.Clear();
  2917. _pressureCts[Index] = new CancellationTokenSource();
  2918. _pressureTimeoutCts[Index] = new CancellationTokenSource();
  2919. // timeout after configured seconds
  2920. _pressureTimeoutCts[Index].CancelAfter(TimeSpan.FromSeconds(_pressureMaxDurationSeconds));
  2921. // link tokens so either stop or timeout cancels
  2922. _pressureLinkedCts[Index] = CancellationTokenSource.CreateLinkedTokenSource(_pressureCts[Index].Token, _pressureTimeoutCts[Index].Token);
  2923. var token = _pressureLinkedCts[Index].Token;
  2924. var addressConfig = _configService.GetPlcAddresses();
  2925. var plc = _plcService.GetPlcByNumber(addressConfig.PlcNo) as OpcUaClientPLC;
  2926. if (plc == null || !plc.IsConnected) return;
  2927. Task.Run(async () =>
  2928. {
  2929. SendTaskMessage($"Pressure collection started for position {Index}", MessageLevel.Debug);
  2930. while (!token.IsCancellationRequested)
  2931. {
  2932. try
  2933. {
  2934. float pressure = plc.ReadNode<float>(string.Format(addressConfig.In_CurPressureValue.Address, Index));
  2935. lock (_pressureSamples[Index])
  2936. {
  2937. _pressureSamples[Index].Add((DateTime.Now, pressure));
  2938. }
  2939. }
  2940. catch (Exception ex)
  2941. {
  2942. LogHelper.WriteLogError("采集压力值时出错", ex);
  2943. }
  2944. await Task.Delay(_pressureSampleIntervalMs);
  2945. }
  2946. // if cancelled due to timeout
  2947. if (_pressureTimeoutCts[Index].IsCancellationRequested && !_pressureCts[Index].IsCancellationRequested)
  2948. {
  2949. SendTaskMessage("Pressure collection timed out, saving collected data.", MessageLevel.Alarm);
  2950. await StopAndSavePressureCollectionAsync(productName, productCode, Index);
  2951. }
  2952. }, token);
  2953. }
  2954. catch (Exception ex)
  2955. {
  2956. LogHelper.WriteLogError("StartPressureCollection error", ex);
  2957. }
  2958. }
  2959. /// <summary>
  2960. /// 停止采集并保存压力数据
  2961. /// </summary>
  2962. /// <param name="productName"></param>
  2963. /// <param name="productCode"></param>
  2964. /// <param name="positionIndex"></param>
  2965. /// <returns></returns>
  2966. private async Task StopAndSavePressureCollectionAsync(string productName, string productCode, int Index)
  2967. {
  2968. try
  2969. {
  2970. // cancel sampling
  2971. //_pressureCts[Index]?.Cancel();
  2972. // allow worker to observe cancel
  2973. await Task.Delay(50);
  2974. List<(DateTime Timestamp, float Value)> snapshot;
  2975. lock (_pressureSamples[Index])
  2976. {
  2977. snapshot = new List<(DateTime, float)>(_pressureSamples[Index]);
  2978. }
  2979. if (snapshot.Count == 0)
  2980. {
  2981. SendTaskMessage("No pressure samples collected.", MessageLevel.Info);
  2982. return;
  2983. }
  2984. // save to file under configured path
  2985. try
  2986. {
  2987. //获取系统参数
  2988. var systemConfig = _configService.GetSystemConfiguration();
  2989. if (systemConfig.PressureSensorConfig == null || systemConfig.PressureSensorConfig.Count <= 0)
  2990. {
  2991. SendTaskMessage("当前没有配置任何压力传感器!", MessageLevel.Alarm);
  2992. return;
  2993. }
  2994. //获取当前压力传感器配置
  2995. var pressureSensorConfig = systemConfig.PressureSensorConfig.FirstOrDefault(p => p.SensorId == Index);
  2996. if (pressureSensorConfig == null)
  2997. {
  2998. SendTaskMessage($"当前压力传感器配置不存在!- {Index}", MessageLevel.Alarm);
  2999. return;
  3000. }
  3001. //PressureFinishNotification : Prism.Events.PubSubEvent<(bool IsSuccess, int Index, (DateTime Timestamp, float Value)[] values,string SavePath )>
  3002. string basePath = pressureSensorConfig?.PressureCurvePath ?? Environment.GetFolderPath(Environment.SpecialFolder.MyDocuments);
  3003. string datePath = DateTime.Now.ToString("yyyy-MM") + "\\" + DateTime.Now.ToString("yyyy-MM-dd") + "\\";
  3004. string dirPath = Path.Combine(basePath, datePath, productName ?? "UnknownProduct", productCode ?? DateTime.Now.ToString("yyyyMMddHHmmssfff"));
  3005. if (!Directory.Exists(dirPath)) Directory.CreateDirectory(dirPath);
  3006. string csvfileName = $"pressure-{productCode}-{Index}-{DateTime.Now.ToString("HHmmss")}.csv";
  3007. string csvPath = Path.Combine(dirPath, csvfileName);
  3008. string pngfileName = $"pressure-{productCode}-{Index}-{DateTime.Now.ToString("HHmmss")}.png";
  3009. string pngPath = Path.Combine(dirPath, pngfileName);
  3010. if (!pressureSensorConfig.IsSavePressureCurve)
  3011. {
  3012. csvPath = string.Empty;
  3013. pngPath = string.Empty;
  3014. }
  3015. App.Current.Dispatcher.Invoke(() =>
  3016. {
  3017. _eventAggregator.GetEvent<PressureFinishNotification>().Publish((true, Index, snapshot.ToArray(), pngPath));
  3018. });
  3019. //判断是否保存锁付曲线
  3020. if (pressureSensorConfig.IsSavePressureCurve)
  3021. {
  3022. if (!string.IsNullOrEmpty(csvPath))
  3023. {
  3024. var sb = new StringBuilder();
  3025. sb.AppendLine("Timestamp,Value");
  3026. foreach (var s in snapshot)
  3027. {
  3028. sb.AppendLine($"{s.Timestamp:O},{s.Value}");
  3029. }
  3030. File.WriteAllText(csvPath, sb.ToString());
  3031. SendTaskMessage($"Pressure samples saved to {csvPath}", MessageLevel.Debug);
  3032. }
  3033. }
  3034. }
  3035. catch (Exception ex)
  3036. {
  3037. LogHelper.WriteLogError("保存压力采样文件时出错", ex);
  3038. SendTaskMessage("保存压力采样文件时出错: " + ex.Message, MessageLevel.Error);
  3039. }
  3040. }
  3041. catch (Exception ex)
  3042. {
  3043. LogHelper.WriteLogError("StopAndSavePressureCollectionAsync error", ex);
  3044. }
  3045. finally
  3046. {
  3047. try
  3048. {
  3049. _pressureLinkedCts[Index]?.Cancel();
  3050. _pressureLinkedCts[Index]?.Dispose();
  3051. _pressureTimeoutCts[Index]?.Dispose();
  3052. _pressureCts[Index]?.Dispose();
  3053. _pressureSamples[Index]?.Clear();
  3054. }
  3055. catch { }
  3056. }
  3057. }
  3058. #endregion
  3059. private async void DoYieldTime(object state)
  3060. {
  3061. try
  3062. {
  3063. //获取当前产品
  3064. var currentproduct = _productService.GetCurrentProduct();
  3065. if (currentproduct == null) return;
  3066. TotalQuantity = await _systemDatabaseService.GetOverallProductionAsync(currentproduct.Name);
  3067. TotalQuantityToday = await _systemDatabaseService.GetTodayProductionAsync(currentproduct.Name);
  3068. CurrentUPH = await _systemDatabaseService.GetLastHourProductionAsync(currentproduct.Name);
  3069. //
  3070. ThrowNumber = await _systemDatabaseService.GetThrowNumberAsync();
  3071. NgNumber = await _systemDatabaseService.GetNGProductionAsync(currentproduct.Name);
  3072. Yield = ((double)TotalQuantityToday - (double)NgNumber) / (double)TotalQuantityToday * 100;
  3073. }
  3074. catch (Exception)
  3075. {
  3076. }
  3077. }
  3078. #region vm启动检测
  3079. /// <summary>
  3080. /// 杀死所有VM有关进程
  3081. /// </summary>
  3082. public void KillVMProcess()
  3083. {
  3084. KillProcess("VisionMasterServerApp");
  3085. KillProcess("VisionMaster");
  3086. KillProcess("VmModuleProxy.exe");
  3087. KillProcess("vServerApp.exe");
  3088. }
  3089. /// <summary>
  3090. /// 杀死指定进程名的进程
  3091. /// </summary>
  3092. /// <param name="strKillName"></param>
  3093. public void KillProcess(string strKillName)
  3094. {
  3095. foreach (System.Diagnostics.Process p in System.Diagnostics.Process.GetProcesses())
  3096. {
  3097. if (p.ProcessName.Contains(strKillName))
  3098. {
  3099. try
  3100. {
  3101. p.Kill();
  3102. p.WaitForExit();
  3103. }
  3104. catch (Exception ex)
  3105. {
  3106. LogHelper.WriteLogError($"杀死进程:{strKillName}时失败!", ex);
  3107. }
  3108. }
  3109. }
  3110. }
  3111. #endregion
  3112. /// <summary>
  3113. /// 记录工位的结果,其他工位要存储的数据项按照键值对集合的形式传入,键为数据项名称,值为数据项的值
  3114. /// </summary>
  3115. /// <param name="stationIndex"></param>
  3116. /// <param name="dfcs"></param>
  3117. /// <param name="productMainSN"></param>
  3118. /// <param name="ct"></param>
  3119. /// <param name="timestamp"></param>
  3120. /// <param name="savePath"></param>
  3121. /// <param name="isFirstEnter"></param>
  3122. /// <returns></returns>
  3123. private bool RecordStationResult(int stationIndex, IEnumerable<DataFormCtq> dfcs, string productMainSN, double ct, DateTime timestamp, string savePath, bool isFirstEnter = true)
  3124. {
  3125. try
  3126. {
  3127. //获取当前工位的配置
  3128. var stationConfig = _configService.GetDeviceInfo(stationIndex);
  3129. if (stationConfig == null) return false;
  3130. //如果保存路径为空,则不保存
  3131. if (string.IsNullOrEmpty(savePath)) return false;
  3132. string fullPath = savePath;
  3133. //如果保存路径是一个文件路径,则直接保存,否则按照工位和日期进行保存
  3134. if (!File.Exists(savePath) || !Path.HasExtension(savePath))
  3135. {
  3136. fullPath = savePath;
  3137. //如果路径不存在,则创建
  3138. // 创建目录
  3139. string directory = Path.GetDirectoryName(fullPath);
  3140. if (!string.IsNullOrEmpty(directory) && !Directory.Exists(directory))
  3141. {
  3142. Directory.CreateDirectory(directory);
  3143. }
  3144. }
  3145. //结果保存至CSV文件,文件名格式:savePath\yyyy-MM\工位编号_工位名称_yyyy-MM-dd.csv
  3146. string datePath = timestamp.ToString("yyyy-MM") + "\\";
  3147. string dirPath = Path.Combine(savePath, datePath);
  3148. if (!Directory.Exists(dirPath)) Directory.CreateDirectory(dirPath);
  3149. string fileName = $"{stationIndex}_{stationConfig.DeviceName}_{timestamp.ToString("yyyy-MM-dd")}.csv";
  3150. fullPath = Path.Combine(dirPath, fileName);
  3151. StringBuilder sb = new StringBuilder();
  3152. if (!File.Exists(fullPath))
  3153. {
  3154. sb.Append("PPID,PROCESS_NAME,PROCESS_START_TIME,CTQ_NAME,CTQ_VALUE,CTQ_LSL,CTQ_USL,PROCESS_END_TIME,SUPPLIER_NAME,COMMODITY_TYPE,REVISION,WO#,MFG_LOT#," +
  3155. "MFG_ASSY_LINE,PROCESS_OUTCOME,PROCESS_MACHINE_ID,CTQ_UNIT_OF_MEASURE,ERROR_MESSAGE,PD_ATTR_01,PD_ATTR_02,PD_ATTR_03,PD_ATTR_04,PD_ATTR_05");
  3156. sb.AppendLine();
  3157. }
  3158. if (dfcs == null || dfcs.Count() == 0)
  3159. {
  3160. return false;
  3161. }
  3162. foreach (var dfc in dfcs)
  3163. {
  3164. sb.Append($"{dfc.PPID},{dfc.PROCESS_NAME},{dfc.PROCESS_START_TIME},{dfc.CTQ_NAME},{dfc.CTQ_VALUE},{dfc.CTQ_LSL},{dfc.CTQ_USL},{dfc.PROCESS_END_TIME},{dfc.SUPPLIER_NAME},{dfc.COMMODITY_TYPE},{dfc.REVISION},{dfc.WO},{dfc.MFG_LOT},{dfc.MFG_ASSY_LINE},{dfc.PROCESS_OUTCOME},{dfc.PROCESS_MACHINE_ID},{dfc.CTQ_UNIT_OF_MEASURE},{dfc.ERROR_MESSAGE},{dfc.PD_ATTR_01},{dfc.PD_ATTR_02},{dfc.PD_ATTR_03},{dfc.PD_ATTR_04},{dfc.PD_ATTR_05}");
  3165. sb.AppendLine();
  3166. }
  3167. // 使用 StreamWriter 以追加模式打开文件
  3168. StreamWriter sw = new StreamWriter(fullPath, true, Encoding.UTF8);
  3169. sw.Write(sb.ToString());
  3170. sw.Close();
  3171. sw.Dispose();
  3172. return true;
  3173. }
  3174. catch (Exception ex)
  3175. {
  3176. if (!isFirstEnter)
  3177. {
  3178. return false;
  3179. }
  3180. LogHelper.WriteLogError("记录其他工位结果时出错!", ex);
  3181. //我希望在这里生成一个临时文件来保存这次的记录,因为如果本地文件被打开时可能会导致无法写入,如果不保存的话可能会丢失这次的记录,所以我想在这里生成一个临时文件来保存这次的记录
  3182. //生成临时文件的路径,格式为savePath\yyyy-MM\工位编号_yyyy-MM-dd_temp\工位编号_yyyy-MM-dd_HH-mm-ss-fff_temp.csv
  3183. string datePath = timestamp.ToString("yyyy-MM") + "\\";
  3184. string tempDirPath = Path.Combine(savePath, datePath, $"{stationIndex}_{timestamp.ToString("yyyy-MM-dd")}_temp");
  3185. string tempFileName = $"{stationIndex}_{timestamp.ToString("yyyy-MM-dd_HH-mm-ss-fff")}_temp.csv";
  3186. RecordStationResult(stationIndex, dfcs, productMainSN, ct, timestamp, tempFileName, false);
  3187. return false;
  3188. }
  3189. }
  3190. #region 压缩图片文件夹
  3191. /// <summary>
  3192. /// 压缩文件
  3193. /// </summary>
  3194. /// <param name="sourcePath">原路径</param>
  3195. /// <param name="zipname">压缩后文件的名称</param>
  3196. /// <param name="station">mes中的station</param>
  3197. /// <param name="fixid">mes中的fixtureID</param>
  3198. public async void CompressionImage(string sourcePath, string zipname, string station, string fixid)
  3199. {
  3200. string zipPath = "";
  3201. try
  3202. {
  3203. SendTaskMessage($"开始压缩文件", MessageLevel.Info);
  3204. await Task.Run(() =>
  3205. {
  3206. zipPath = $"Z:\\{station}\\{fixid}\\{DateTime.Now.ToString("yyyyMMdd")}\\{zipname}.zip";//生成的zip文件路径
  3207. string path = $"Z:\\{station}\\{fixid}\\{DateTime.Now.ToString("yyyyMMdd")}";
  3208. if (!Directory.Exists(path))
  3209. {
  3210. Directory.CreateDirectory(path);
  3211. }
  3212. ZipFile.CreateFromDirectory(sourcePath, zipPath);
  3213. });
  3214. }
  3215. catch (Exception ex)
  3216. {
  3217. LogHelper.WriteLogError($"压缩文件时出错", ex);
  3218. }
  3219. }
  3220. #endregion
  3221. #endregion
  3222. }
  3223. }