PlcPointParamsViewModel.cs 85 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046
  1. using Cognex.VisionPro;
  2. using MahApps.Metro.Controls;
  3. using MaterialDesignThemes.Wpf;
  4. using MathNet.Numerics.LinearAlgebra;
  5. using NPOI.SS.Formula.Functions;
  6. using OpenCvSharp.Flann;
  7. using Prism.Commands;
  8. using Prism.Events;
  9. using Prism.Ioc;
  10. using Prism.Mvvm;
  11. using Prism.Regions;
  12. using Prism.Services.Dialogs;
  13. using System;
  14. using System.Collections.Generic;
  15. using System.Collections.ObjectModel;
  16. using System.Drawing;
  17. using System.Linq;
  18. using System.Threading;
  19. using System.Threading.Tasks;
  20. using System.Windows;
  21. using TeamAAS_VP.Controls;
  22. using TeamAAS_VP.Core;
  23. using TeamAAS_VP.Core.PLCs;
  24. using TeamAAS_VP.Core.Robots;
  25. using TeamAAS_VP.DxfModule;
  26. using TeamAAS_VP.Enums;
  27. using TeamAAS_VP.Events;
  28. using TeamAAS_VP.Interfaces;
  29. using TeamAAS_VP.Models;
  30. using TeamAAS_VP.Models.PLC;
  31. using TeamAAS_VP.Models.Robot;
  32. using TeamAAS_VP.Resources.Languages;
  33. using TeamAAS_VP.Services;
  34. using TeamAAS_VP.Views.Product;
  35. using static TeamAAS_VP.ViewModels.Product.AutoCorrectLockPointViewModel;
  36. namespace TeamAAS_VP.ViewModels.Product
  37. {
  38. public class PlcPointParamsViewModel : BindableBase, IConfirmNavigationRequest
  39. {
  40. IRegionManager _regionManager;
  41. IEventAggregator _eventAggregator;
  42. IContainerProvider _container;
  43. IDialogService _dialogService;
  44. IConfigService _configService;
  45. IRobotService _robotService;
  46. ISystemDatabaseService _systemDatabaseService;
  47. IRemoteCommandService _remoteCommandService;
  48. ICalibrationService _calibrationService;
  49. ICameraService _cameraService;
  50. IProductService _productService;
  51. #region 属性
  52. private ObservableCollection<AxisExtended> _AdditionalAxisList;
  53. public ObservableCollection<AxisExtended> AdditionalAxisList
  54. {
  55. get { return _AdditionalAxisList; }
  56. set { SetProperty(ref _AdditionalAxisList, value); }
  57. }
  58. private ProductModel _SelectProduct;
  59. /// <summary>
  60. /// 选中的产品
  61. /// </summary>
  62. public ProductModel SelectProduct
  63. {
  64. get { return _SelectProduct; }
  65. set { SetProperty(ref _SelectProduct, value); }
  66. }
  67. private PlcPoint _SelectedPoint;
  68. public PlcPoint SelectedPoint
  69. {
  70. get { return _SelectedPoint; }
  71. set { SetProperty(ref _SelectedPoint, value); }
  72. }
  73. private PlcPoint _selectedPointInDataGrid;
  74. public PlcPoint SelectedPointInDataGrid
  75. {
  76. get { return _selectedPointInDataGrid; }
  77. set
  78. {
  79. if (SetProperty(ref _selectedPointInDataGrid, value))
  80. {
  81. SelectedPointInComboBox = value;
  82. // update command availability
  83. _MovePointUpCommand?.RaiseCanExecuteChanged();
  84. _MovePointDownCommand?.RaiseCanExecuteChanged();
  85. // 更新依赖可执行状态的命令
  86. _TechPointCommand?.RaiseCanExecuteChanged();
  87. _ExecuteMotion?.RaiseCanExecuteChanged();
  88. }
  89. // 可以同步到 SelectPoint 属性
  90. SelectedPoint = value;
  91. }
  92. }
  93. private PlcPoint _selectedPointInComboBox;
  94. public PlcPoint SelectedPointInComboBox
  95. {
  96. get { return _selectedPointInComboBox; }
  97. set
  98. {
  99. if (SetProperty(ref _selectedPointInComboBox, value))
  100. {
  101. SelectedPointInDataGrid = value;
  102. }
  103. // 可以同步到 SelectPoint 属性
  104. SelectedPoint = value;
  105. }
  106. }
  107. private ObservableCollection<PlcPoint> _Points = new ObservableCollection<PlcPoint>();
  108. /// <summary>
  109. /// 点位集合
  110. /// </summary>
  111. public ObservableCollection<PlcPoint> Points
  112. {
  113. get { return _Points; }
  114. set { SetProperty(ref _Points, value); }
  115. }
  116. private MotionCommand _SelectMotionCommand;
  117. /// <summary>
  118. /// 选中的运动指令
  119. /// </summary>
  120. public MotionCommand SelectMotionCommand
  121. {
  122. get { return _SelectMotionCommand; }
  123. set { SetProperty(ref _SelectMotionCommand, value); }
  124. }
  125. public Management management { get; set; }
  126. private XYZU_Robot _Robot;
  127. public XYZU_Robot Robot
  128. {
  129. get { return _Robot; }
  130. set
  131. {
  132. SetProperty(ref _Robot, value);
  133. }
  134. }
  135. private int _SelectedIndex;
  136. public int SelectedIndex
  137. {
  138. get { return _SelectedIndex; }
  139. set { SetProperty(ref _SelectedIndex, value); }
  140. }
  141. private double _Distance = 1;
  142. public double Distance
  143. {
  144. get { return _Distance; }
  145. set
  146. {
  147. SetProperty(ref _Distance, value);
  148. try
  149. {
  150. if (Robot == null)
  151. {
  152. return;
  153. }
  154. _configService.UpdateRobotStepDistance(Robot.Id, value);
  155. }
  156. catch (Exception)
  157. {
  158. }
  159. }
  160. }
  161. private ObservableCollection<ProcedureModel> _ProcedureModels;
  162. /// <summary>
  163. /// 流程集合
  164. /// </summary>
  165. public ObservableCollection<ProcedureModel> ProcedureModels
  166. {
  167. get { return _ProcedureModels; }
  168. set { SetProperty(ref _ProcedureModels, value); }
  169. }
  170. private ProcedureModel _SelectProcedure;
  171. /// <summary>
  172. /// 选中的流程
  173. /// </summary>
  174. public ProcedureModel SelectProcedure
  175. {
  176. get { return _SelectProcedure; }
  177. set
  178. {
  179. SetProperty(ref _SelectProcedure, value);
  180. }
  181. }
  182. private bool _IsGrap;
  183. public bool IsGrap
  184. {
  185. get { return _IsGrap; }
  186. set { SetProperty(ref _IsGrap, value); }
  187. }
  188. private ObservableCollection<CameraInfo> _CameraList;
  189. public ObservableCollection<CameraInfo> CameraList
  190. {
  191. get { return _CameraList; }
  192. set { SetProperty(ref _CameraList, value); }
  193. }
  194. private CameraInfo _SelectedCamera;
  195. public CameraInfo SelectedCamera
  196. {
  197. get { return _SelectedCamera; }
  198. set
  199. {
  200. SetProperty(ref _SelectedCamera, value);
  201. if (value != null)
  202. {
  203. if (Camera != null)
  204. {
  205. if (Camera.IsGrabbing)
  206. {
  207. Camera.StopGrabbing();
  208. }
  209. Camera.ImageCallbackEvent -= Camera_ImageCallbackEvent;
  210. }
  211. Camera = _cameraService.GetCamera(value.Id);
  212. Camera.ImageCallbackEvent += Camera_ImageCallbackEvent;
  213. }
  214. }
  215. }
  216. private ICamera _Camera;
  217. public ICamera Camera
  218. {
  219. get { return _Camera; }
  220. set { SetProperty(ref _Camera, value); }
  221. }
  222. private ICogImage _Image;
  223. public ICogImage Image
  224. {
  225. get { return _Image; }
  226. set { SetProperty(ref _Image, value); }
  227. }
  228. private string _Message;
  229. public string Message
  230. {
  231. get { return _Message; }
  232. set { SetProperty(ref _Message, value); }
  233. }
  234. private bool _IsLeftDrawerOpen;
  235. public bool IsLeftDrawerOpen
  236. {
  237. get { return _IsLeftDrawerOpen; }
  238. set
  239. {
  240. SetProperty(ref _IsLeftDrawerOpen, value);
  241. if (!value)
  242. {
  243. if (IsGrap)
  244. {
  245. ExecuteStopGrabbingCommand();
  246. }
  247. }
  248. }
  249. }
  250. private int _Inhal = 1;
  251. /// <summary>
  252. /// 吸真空编号
  253. /// </summary>
  254. public int Inhal
  255. {
  256. get { return _Inhal; }
  257. set { SetProperty(ref _Inhal, value); }
  258. }
  259. private PalletEx _Pallet1;
  260. /// <summary>
  261. /// 托盘1
  262. /// </summary>
  263. public PalletEx Pallet1
  264. {
  265. get { return _Pallet1; }
  266. set { SetProperty(ref _Pallet1, value); }
  267. }
  268. private PalletEx _Pallet2;
  269. /// <summary>
  270. /// 托盘2
  271. /// </summary>
  272. public PalletEx Pallet2
  273. {
  274. get { return _Pallet2; }
  275. set { SetProperty(ref _Pallet2, value); }
  276. }
  277. #endregion
  278. #region 命令
  279. private DelegateCommand _NextCommand;
  280. public DelegateCommand NextCommand =>
  281. _NextCommand ?? (_NextCommand = new DelegateCommand(ExecuteNextCommand));
  282. private DelegateCommand _BackCommand;
  283. public DelegateCommand BackCommand =>
  284. _BackCommand ?? (_BackCommand = new DelegateCommand(ExecuteBackCommand));
  285. private DelegateCommand _LoadedCommand;
  286. public DelegateCommand LoadedCommand =>
  287. _LoadedCommand ?? (_LoadedCommand = new DelegateCommand(ExecuteLoadedCommand));
  288. private DelegateCommand<object> _ExecuteMotion;
  289. public DelegateCommand<object> ExecuteMotion =>
  290. _ExecuteMotion ?? (_ExecuteMotion = new DelegateCommand<object>(ExecuteExecuteMotion).ObservesCanExecute(() => CanExecutePointCommand).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute).ObservesProperty(() => SelectedPointInDataGrid));
  291. private DelegateCommand<object> _JogCommand;
  292. public DelegateCommand<object> JogCommand =>
  293. _JogCommand ?? (_JogCommand = new DelegateCommand<object>(ExecuteJogCommand).ObservesCanExecute(() => CanExecute).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute));
  294. private DelegateCommand _TechPointCommand;
  295. public DelegateCommand TechPointCommand =>
  296. _TechPointCommand ?? (_TechPointCommand = new DelegateCommand(ExecuteTechPointCommand).ObservesCanExecute(() => CanExecutePointCommand).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute).ObservesProperty(() => SelectedPointInDataGrid));
  297. private DelegateCommand<string> _MotorCommand;
  298. public DelegateCommand<string> MotorCommand =>
  299. _MotorCommand ?? (_MotorCommand = new DelegateCommand<string>(ExecuteMotorCommand).ObservesCanExecute(() => CanExecute).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute));
  300. private DelegateCommand _ResetCommand;
  301. public DelegateCommand ResetCommand =>
  302. _ResetCommand ?? (_ResetCommand = new DelegateCommand(ExecuteResetCommand).ObservesCanExecute(() => CanExecute).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute));
  303. private DelegateCommand _sFreeCommand;
  304. public DelegateCommand sFreeCommand =>
  305. _sFreeCommand ?? (_sFreeCommand = new DelegateCommand(ExecutesFreeCommand).ObservesCanExecute(() => CanExecute).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute));
  306. private DelegateCommand _SLockCommand;
  307. public DelegateCommand SLockCommand =>
  308. _SLockCommand ?? (_SLockCommand = new DelegateCommand(ExecuteSLockCommand).ObservesCanExecute(() => CanExecute).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute));
  309. private DelegateCommand _SelectionChangedCommand;
  310. public DelegateCommand SelectionChangedCommand =>
  311. _SelectionChangedCommand ?? (_SelectionChangedCommand = new DelegateCommand(ExecuteSelectionChangedCommand));
  312. private DelegateCommand _AddPointCommand;
  313. public DelegateCommand AddPointCommand =>
  314. _AddPointCommand ?? (_AddPointCommand = new DelegateCommand(ExecuteAddPointCommand));
  315. private DelegateCommand _DeletePointCommand;
  316. public DelegateCommand DeletePointCommand =>
  317. _DeletePointCommand ?? (_DeletePointCommand = new DelegateCommand(ExecuteDeletePointCommand, CanExecuteDeletePointCommand).ObservesProperty(() => SelectedPointInDataGrid));
  318. private DelegateCommand _MovePointUpCommand;
  319. public DelegateCommand MovePointUpCommand => _MovePointUpCommand ?? (_MovePointUpCommand = new DelegateCommand(ExecuteMovePointUpCommand, CanMovePointUp));
  320. private DelegateCommand _MovePointDownCommand;
  321. public DelegateCommand MovePointDownCommand => _MovePointDownCommand ?? (_MovePointDownCommand = new DelegateCommand(ExecuteMovePointDownCommand, CanMovePointDown));
  322. private DelegateCommand _ImportCadPointCommand;
  323. public DelegateCommand ImportCadPointCommand =>
  324. _ImportCadPointCommand ?? (_ImportCadPointCommand = new DelegateCommand(ExecuteImportCadPointCommand));
  325. private DelegateCommand _StartGrabbingCommand;
  326. public DelegateCommand StartGrabbingCommand =>
  327. _StartGrabbingCommand ?? (_StartGrabbingCommand = new DelegateCommand(ExecuteStartGrabbingCommand, CanExecuteStartGrabbingCommand).ObservesProperty(() => IsGrap).ObservesProperty(() => SelectedCamera));
  328. private DelegateCommand _StopGrabbingCommand;
  329. public DelegateCommand StopGrabbingCommand =>
  330. _StopGrabbingCommand ?? (_StopGrabbingCommand = new DelegateCommand(ExecuteStopGrabbingCommand, CanExecuteStopGrabbingCommand).ObservesProperty(() => IsGrap).ObservesProperty(() => SelectedCamera));
  331. private DelegateCommand _GoPickCommand;
  332. public DelegateCommand GoPickCommand =>
  333. _GoPickCommand ?? (_GoPickCommand = new DelegateCommand(ExecuteGoPickCommand, CanExecuteCommandGoPickCommandName).ObservesProperty(() => SelectedPoint));
  334. private DelegateCommand _GoRepositionCommand;
  335. public DelegateCommand GoRepositionCommand =>
  336. _GoRepositionCommand ?? (_GoRepositionCommand = new DelegateCommand(ExecuteGoRepositionCommand, CanExecuteCommandGoPickCommandName).ObservesProperty(() => SelectedPoint));
  337. private DelegateCommand _TakeProductPhotoCommand;
  338. public DelegateCommand TakeProductPhotoCommand =>
  339. _TakeProductPhotoCommand ?? (_TakeProductPhotoCommand = new DelegateCommand(ExecuteTakeProductPhotoCommand, CanExecuteCommandGoPickCommandName).ObservesProperty(() => SelectedPoint));
  340. private DelegateCommand _TakeProductCommand;
  341. public DelegateCommand TakeProductCommand =>
  342. _TakeProductCommand ?? (_TakeProductCommand = new DelegateCommand(ExecuteTakeProductCommand, CanExecuteCommandGoPickCommandName).ObservesProperty(() => SelectedPoint));
  343. //附加轴,轴点动+命令
  344. private DelegateCommand<object> _AdditionalAxisJogPlusCommand;
  345. public DelegateCommand<object> AdditionalAxisJogPlusCommand =>
  346. _AdditionalAxisJogPlusCommand ?? (_AdditionalAxisJogPlusCommand = new DelegateCommand<object>(ExecuteAdditionalAxisJogPlusCommand).ObservesCanExecute(() => CanExecute).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute));
  347. //附加轴,轴点动-命令
  348. private DelegateCommand<object> _AdditionalAxisJogMinusCommand;
  349. public DelegateCommand<object> AdditionalAxisJogMinusCommand =>
  350. _AdditionalAxisJogMinusCommand ?? (_AdditionalAxisJogMinusCommand = new DelegateCommand<object>(ExecuteAdditionalAxisJogMinusCommand).ObservesCanExecute(() => CanExecute).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute));
  351. private DelegateCommand<object> _AdditionalAxisMotorOnCommand;
  352. public DelegateCommand<object> AdditionalAxisMotorOnCommand =>
  353. _AdditionalAxisMotorOnCommand ?? (_AdditionalAxisMotorOnCommand = new DelegateCommand<object>(ExecuteAdditionalAxisMotorOnCommand).ObservesCanExecute(() => CanExecute).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute));
  354. private DelegateCommand<object> _AdditionalAxisMotorOffCommand;
  355. public DelegateCommand<object> AdditionalAxisMotorOffCommand =>
  356. _AdditionalAxisMotorOffCommand ?? (_AdditionalAxisMotorOffCommand = new DelegateCommand<object>(ExecuteAdditionalAxisMotorOffCommand).ObservesCanExecute(() => CanExecute).ObservesProperty(() => Robot).ObservesProperty(() => Robot.CanExecute));
  357. private DelegateCommand<string> _PickTechCommand;
  358. public DelegateCommand<string> PickTechCommand =>
  359. _PickTechCommand ?? (_PickTechCommand = new DelegateCommand<string>(ExecutePickTechCommand));
  360. private DelegateCommand<string> _PickMoveCommand;
  361. public DelegateCommand<string> PickMoveCommand =>
  362. _PickMoveCommand ?? (_PickMoveCommand = new DelegateCommand<string>(ExecutePickMoveCommand));
  363. private DelegateCommand<string> _CalPickPosCommand;
  364. public DelegateCommand<string> CalPickPosCommand =>
  365. _CalPickPosCommand ?? (_CalPickPosCommand = new DelegateCommand<string>(ExecuteCalPickPosCommand));
  366. private DelegateCommand _DynamicTestAnalyzerCommand;
  367. public DelegateCommand DynamicTestAnalyzerCommand =>
  368. _DynamicTestAnalyzerCommand ?? (_DynamicTestAnalyzerCommand = new DelegateCommand(ExecuteDynamicTestAnalyzerCommand));
  369. #endregion
  370. #region 事件
  371. #endregion
  372. public PlcPointParamsViewModel(IRegionManager regionManager, IEventAggregator ea, IContainerProvider container, IDialogService dialogService,
  373. IConfigService configService, IRobotService robotService, ISystemDatabaseService systemDatabaseService, IRemoteCommandService remoteCommandService,
  374. ICalibrationService calibrationService, ICameraService cameraService, IProductService productService)
  375. {
  376. _regionManager = regionManager;
  377. _eventAggregator = ea;
  378. _container = container;
  379. _dialogService = dialogService;
  380. _configService = configService;
  381. _systemDatabaseService = systemDatabaseService;
  382. //订阅权限登录事件
  383. _eventAggregator.GetEvent<UserLoginNotification>().Subscribe(LoginChange);
  384. management = _container.Resolve<Management>();
  385. _robotService = robotService;
  386. _remoteCommandService = remoteCommandService;
  387. _calibrationService = calibrationService;
  388. _cameraService = cameraService;
  389. _productService = productService;
  390. }
  391. #region 方法
  392. /// <summary>
  393. /// 下一步
  394. /// </summary>
  395. void ExecuteNextCommand()
  396. {
  397. NavigationParameters param = new NavigationParameters();
  398. param.Add("SelectProduct", SelectProduct);
  399. _regionManager.RequestNavigate("ProductRegionContext", "ProductParams", param);
  400. }
  401. /// <summary>
  402. /// 上一步
  403. /// </summary>
  404. void ExecuteBackCommand()
  405. {
  406. NavigationParameters param = new NavigationParameters();
  407. param.Add("SelectProduct", SelectProduct);
  408. param.Add("SelectedProcedure", null);
  409. _regionManager.RequestNavigate("ProductRegionContext", "ProcessBasics", param);
  410. }
  411. /// <summary>
  412. /// 点动
  413. /// </summary>
  414. /// <param name="obj"></param>
  415. private async void ExecuteJogCommand(object obj)
  416. {
  417. if (Robot == null || !Robot.IsConnected) return;
  418. try
  419. {
  420. var items = ((string)obj).Split(':');
  421. //如果移动距离大于10mm,则提示用户确认
  422. double distance = double.Parse(items[1]);
  423. if (Math.Abs(distance) >= 10)
  424. {
  425. if (MessageBox.Show($"确认要点动距离 {distance} mm 吗?", "确认点动", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  426. {
  427. return;
  428. }
  429. }
  430. Robot.Timeout = 6000000;
  431. switch (items[0])
  432. {
  433. case "X+":
  434. await Robot.JogAsync("X", distance);
  435. break;
  436. case "X-":
  437. await Robot.JogAsync("X", -distance);
  438. break;
  439. case "Y+":
  440. await Robot.JogAsync("Y", distance);
  441. break;
  442. case "Y-":
  443. await Robot.JogAsync("Y", -distance);
  444. break;
  445. case "Z+":
  446. await Robot.JogAsync("Z", distance);
  447. break;
  448. case "Z-":
  449. await Robot.JogAsync("Z", -distance);
  450. break;
  451. case "U+":
  452. await Robot.JogAsync("U", distance);
  453. break;
  454. case "U-":
  455. await Robot.JogAsync("U", -distance);
  456. break;
  457. case "V+":
  458. await Robot.JogAsync("V", distance);
  459. break;
  460. case "V-":
  461. await Robot.JogAsync("V", -distance);
  462. break;
  463. case "W+":
  464. await Robot.JogAsync("W", distance);
  465. break;
  466. case "W-":
  467. await Robot.JogAsync("W", -distance);
  468. break;
  469. default:
  470. break;
  471. }
  472. Robot.Timeout = 5000;
  473. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  474. }
  475. catch (Exception ex)
  476. {
  477. LogHelper.WriteLogError("机器人点位-机器人点动时出错", ex);
  478. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  479. }
  480. }
  481. /// <summary>
  482. /// 执行运动
  483. /// </summary>
  484. /// <param name="obj"></param>
  485. async void ExecuteExecuteMotion(object parameter)
  486. {
  487. if (parameter == null)
  488. {
  489. return;
  490. }
  491. if (SelectedPoint == null)
  492. {
  493. return;
  494. }
  495. var values = (object[])parameter;
  496. var point = new RPoint()
  497. {
  498. X = SelectedPoint.X_Position,
  499. Y = SelectedPoint.Y_Position,
  500. Z = SelectedPoint.Z_Position_Start,
  501. U = SelectedPoint.U_Position,
  502. V = SelectedPoint.R_Position,
  503. };
  504. MotionCommand motionCmd = (MotionCommand)values[1];
  505. if (Robot == null || !Robot.IsConnected) return;
  506. try
  507. {
  508. //确认要执行该点位的该运动指令吗
  509. if (MessageBox.Show($"确认要执行点位 {SelectedPoint.Number} 的 {motionCmd} 指令吗?", "执行点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  510. {
  511. return;
  512. }
  513. if (SelectedIndex == 6)
  514. {
  515. await Robot.WaitCameraMoveFinishedAsync(point.Number, point);
  516. }
  517. else if (SelectedIndex == 1)
  518. {
  519. var curpos = await Robot.GetRobotPosAsync();
  520. //var addpos = await Robot.GetAdditionalAxisCurrentPosAsync(Robot.AdditionalAxisList[0].Name);
  521. curpos.Z = 0;
  522. await Robot.CalibMotionAsync(curpos, 0);
  523. await Robot.AdditionalAxisMoveAsync(Robot.AdditionalAxisList[0].Name, SelectedPoint.Z_Position_Stop);
  524. curpos.X = SelectedPoint.X_Position;
  525. curpos.Y = SelectedPoint.Y_Position;
  526. curpos.Z = SelectedPoint.Z_Position_Start;
  527. curpos.U = SelectedPoint.U_Position;
  528. await Robot.CalibMotionAsync(curpos, 0);
  529. }
  530. else
  531. {
  532. //Robot.Timeout = 6000000;
  533. switch (motionCmd)
  534. {
  535. case MotionCommand.Go:
  536. await Robot.GoAsync(point);
  537. break;
  538. case MotionCommand.Jump:
  539. await Robot.JumpAsync(point, null);
  540. break;
  541. case MotionCommand.Move:
  542. await Robot.MoveAsync(point);
  543. break;
  544. }
  545. }
  546. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  547. }
  548. catch (Exception ex)
  549. {
  550. LogHelper.WriteLogError("机器人点位-执行点位时出错", ex);
  551. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  552. }
  553. }
  554. /// <summary>
  555. /// 示教点位
  556. /// </summary>
  557. /// <param name="point"></param>
  558. async void ExecuteTechPointCommand()
  559. {
  560. if (Robot == null || !Robot.IsConnected) return;
  561. if (SelectedPoint == null) return;
  562. try
  563. {
  564. //如果当前的选项卡处于锁付点位,则提示用户当前模式不允许进行示教
  565. if (SelectedIndex == 4)
  566. {
  567. ////如果local为空,则必须先通过相机定位产品,否则无法示教锁付点位
  568. //if (toolCoord == null)
  569. //{
  570. // _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "当前模式不允许直接示教贴敷点位,请先通过相机定位产品和定位辅料!", Duration = 1 });
  571. // return;
  572. //}
  573. //弹窗用户是否确认要示教该点位
  574. if (MessageBox.Show($"确认要示教点位 {SelectedPoint.Number} 吗?", "示教点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  575. {
  576. return;
  577. }
  578. double upCameraU = Common.CalculateAngleBetweenPointsDegrees(new PointF((float)_PutPoints[0].X, (float)_PutPoints[0].Y), new PointF((float)_PutPoints[1].X, (float)_PutPoints[1].Y));
  579. var curpos1 = await Robot.GetRobotPosAsync();
  580. var addpos = await Robot.GetAdditionalAxisCurrentPosAsync(Robot.AdditionalAxisList[1].Name);
  581. //将当前点位转换为产品Local坐标系下的点位
  582. SelectedPoint.X_Position = (float)curpos1.X;
  583. SelectedPoint.Y_Position = (float)curpos1.Y;
  584. SelectedPoint.Z_Position_Start = curpos1.Z;
  585. SelectedPoint.U_Position = curpos1.U;
  586. SelectedPoint.R_Position = curpos1.V;
  587. SelectedPoint.Z_Position_Stop = addpos;
  588. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  589. return;
  590. }
  591. else if (SelectedIndex == 1)
  592. {
  593. //弹窗用户是否确认要示教该点位
  594. if (MessageBox.Show($"确认要示教点位 {SelectedPoint.Number} 吗?", "示教点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  595. {
  596. return;
  597. }
  598. var curpos1 = await Robot.GetRobotPosAsync();
  599. var addpos = await Robot.GetAdditionalAxisCurrentPosAsync(Robot.AdditionalAxisList[0].Name);
  600. //将当前点位转换为产品Local坐标系下的点位
  601. SelectedPoint.X_Position = (float)curpos1.X;
  602. SelectedPoint.Y_Position = (float)curpos1.Y;
  603. SelectedPoint.Z_Position_Start = curpos1.Z;
  604. SelectedPoint.Z_Position_Stop = addpos;
  605. SelectedPoint.U_Position = curpos1.U;
  606. SelectedPoint.R_Position = curpos1.V;
  607. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  608. return;
  609. }
  610. else if (SelectedIndex == 6)
  611. {
  612. //弹窗用户是否确认要示教该点位
  613. if (MessageBox.Show($"确认要示教点位 {SelectedPoint.Number} 吗?", "示教点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  614. {
  615. return;
  616. }
  617. var curpos1 = await Robot.GetCameraPosAsync(SelectedPoint.Number);
  618. //将当前点位转换为产品Local坐标系下的点位
  619. SelectedPoint.X_Position = (float)curpos1.X;
  620. SelectedPoint.Y_Position = (float)curpos1.Y;
  621. SelectedPoint.Z_Position_Start = curpos1.Z;
  622. SelectedPoint.U_Position = curpos1.U;
  623. SelectedPoint.R_Position = curpos1.V;
  624. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  625. return;
  626. }
  627. else
  628. {
  629. //弹窗用户是否确认要示教该点位
  630. if (MessageBox.Show($"确认要示教点位 {SelectedPoint.Number} 吗?", "示教点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  631. {
  632. return;
  633. }
  634. var curpos = await Robot.GetRobotPosAsync();
  635. SelectedPoint.X_Position = curpos.X;
  636. SelectedPoint.Y_Position = curpos.Y;
  637. SelectedPoint.Z_Position_Start = curpos.Z;
  638. SelectedPoint.U_Position = curpos.U;
  639. SelectedPoint.R_Position = curpos.V;
  640. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  641. }
  642. }
  643. catch (Exception ex)
  644. {
  645. LogHelper.WriteLogError("机器人点位-示教点位时出错", ex);
  646. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  647. }
  648. }
  649. void ExecuteLoadedCommand()
  650. {
  651. if (_systemDatabaseService.GetCurrentUser().userPart == Enums.UserPart.Operator)
  652. {
  653. IsAllowEdit = false;
  654. }
  655. else
  656. {
  657. IsAllowEdit = true;
  658. }
  659. }
  660. /// <summary>
  661. /// 电机
  662. /// </summary>
  663. /// <param name="obj"></param>
  664. private async void ExecuteMotorCommand(string obj)
  665. {
  666. if (Robot == null || !Robot.IsConnected) return;
  667. try
  668. {
  669. await Robot.MotorAsync(Convert.ToBoolean(obj));
  670. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  671. }
  672. catch (Exception ex)
  673. {
  674. LogHelper.WriteLogError("机器人点击操作时出错!", ex);
  675. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  676. }
  677. }
  678. /// <summary>
  679. /// 重置
  680. /// </summary>
  681. private async void ExecuteResetCommand()
  682. {
  683. if (Robot == null || !Robot.IsConnected) return;
  684. try
  685. {
  686. await Robot.ResetAsync();
  687. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  688. }
  689. catch (Exception ex)
  690. {
  691. LogHelper.WriteLogError("重置机器人时出错!", ex);
  692. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  693. }
  694. }
  695. /// <summary>
  696. /// 锁定刹车
  697. /// </summary>
  698. private async void ExecuteSLockCommand()
  699. {
  700. if (Robot == null || !Robot.IsConnected) return;
  701. try
  702. {
  703. await Robot.SLockAsync();
  704. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  705. }
  706. catch (Exception ex)
  707. {
  708. LogHelper.WriteLogError("机器人锁定刹车时出错!", ex);
  709. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  710. }
  711. }
  712. /// <summary>
  713. /// 释放刹车
  714. /// </summary>
  715. private async void ExecutesFreeCommand()
  716. {
  717. if (Robot == null || !Robot.IsConnected) return;
  718. try
  719. {
  720. await Robot.SFreeAsync();
  721. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  722. }
  723. catch (Exception ex)
  724. {
  725. LogHelper.WriteLogError("机器人释放刹车时出错!", ex);
  726. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  727. }
  728. }
  729. private bool CanExecute
  730. {
  731. get
  732. {
  733. // 命令可执行仅当机器人可执行且已选择点位
  734. if (Robot != null && Robot.IsConnected && Robot.CanExecute)
  735. {
  736. return true;
  737. }
  738. return false;
  739. }
  740. }
  741. //是否可以示教或者执行点位
  742. private bool CanExecutePointCommand
  743. {
  744. get
  745. {
  746. if (Robot != null && Robot.IsConnected && Robot.CanExecute)
  747. {
  748. return SelectedPointInDataGrid != null;
  749. }
  750. return false;
  751. }
  752. }
  753. /// <summary>
  754. /// 点位表切换时
  755. /// </summary>
  756. void ExecuteSelectionChangedCommand()
  757. {
  758. switch (SelectedIndex)
  759. {
  760. case 0:
  761. Points = SelectProduct.PickCameraPoints;
  762. break;
  763. case 1:
  764. Points = SelectProduct.PickPoints;
  765. break;
  766. case 2:
  767. Points = SelectProduct.SecPosCameraPoints;
  768. break;
  769. case 3:
  770. Points = SelectProduct.ScrewCameraPoints;
  771. break;
  772. case 4:
  773. Points = SelectProduct.ScrewPoints;
  774. break;
  775. case 5:
  776. Points = SelectProduct.CheckCameraPoints;
  777. break;
  778. case 6:
  779. Points = SelectProduct.IndependentCamerPoints;
  780. break;
  781. default:
  782. break;
  783. }
  784. }
  785. /// <summary>
  786. /// 增加点位
  787. /// </summary>
  788. void ExecuteAddPointCommand()
  789. {
  790. //添加点位
  791. Points.Add(new PlcPoint()
  792. {
  793. Number = Points.Count + 1,
  794. X_Velocity = 100,
  795. Y_Velocity = 100,
  796. Z_Velocity_Start = 100,
  797. Z_Velocity_Stop = 100,
  798. U_Velocity = 100,
  799. R_Velocity = 100,
  800. });
  801. // update commands
  802. _MovePointUpCommand?.RaiseCanExecuteChanged();
  803. _MovePointDownCommand?.RaiseCanExecuteChanged();
  804. }
  805. /// <summary>
  806. /// 移除点位
  807. /// </summary>
  808. void ExecuteDeletePointCommand()
  809. {
  810. if (SelectedPoint == null)
  811. {
  812. return;
  813. }
  814. // 确认删除
  815. if (MessageBox.Show("确认要删除选中的点位吗?", "删除点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  816. {
  817. return;
  818. }
  819. int removedIndex = Points.IndexOf(SelectedPoint);
  820. Points.Remove(SelectedPoint);
  821. //重新编号
  822. for (int i = 0; i < Points.Count; i++)
  823. {
  824. Points[i].Number = i + 1;
  825. }
  826. // adjust selection
  827. if (Points.Count > 0)
  828. {
  829. int newIndex = Math.Min(removedIndex, Points.Count - 1);
  830. SelectedPointInDataGrid = Points[newIndex];
  831. }
  832. else
  833. {
  834. SelectedPointInDataGrid = null;
  835. }
  836. // update commands
  837. _MovePointUpCommand?.RaiseCanExecuteChanged();
  838. _MovePointDownCommand?.RaiseCanExecuteChanged();
  839. }
  840. bool CanExecuteDeletePointCommand()
  841. {
  842. return SelectedPointInDataGrid != null;
  843. }
  844. private bool CanMovePointUp()
  845. {
  846. return SelectedPointInDataGrid != null && Points.IndexOf(SelectedPointInDataGrid) > 0;
  847. }
  848. private bool CanMovePointDown()
  849. {
  850. return SelectedPointInDataGrid != null && Points.IndexOf(SelectedPointInDataGrid) >= 0 && Points.IndexOf(SelectedPointInDataGrid) < Points.Count - 1;
  851. }
  852. /// <summary>
  853. /// 向上移动点位
  854. /// </summary>
  855. void ExecuteMovePointUpCommand()
  856. {
  857. if (SelectedPointInDataGrid == null) return;
  858. // 确认移动
  859. if (MessageBox.Show("确认将选中点位上移一位吗?", "移动点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  860. {
  861. return;
  862. }
  863. int idx = Points.IndexOf(SelectedPointInDataGrid);
  864. if (idx <= 0) return;
  865. var item = SelectedPointInDataGrid;
  866. Points.Move(idx, idx - 1);
  867. // renumber
  868. for (int i = 0; i < Points.Count; i++) Points[i].Number = i + 1;
  869. SelectedPointInDataGrid = item;
  870. _MovePointUpCommand?.RaiseCanExecuteChanged();
  871. _MovePointDownCommand?.RaiseCanExecuteChanged();
  872. }
  873. /// <summary>
  874. /// 向下移动点位
  875. /// </summary>
  876. void ExecuteMovePointDownCommand()
  877. {
  878. if (SelectedPointInDataGrid == null) return;
  879. // 确认移动
  880. if (MessageBox.Show("确认将选中点位下移一位吗?", "移动点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  881. {
  882. return;
  883. }
  884. int idx = Points.IndexOf(SelectedPointInDataGrid);
  885. if (idx < 0 || idx >= Points.Count - 1) return;
  886. var item = SelectedPointInDataGrid;
  887. Points.Move(idx, idx + 1);
  888. // renumber
  889. for (int i = 0; i < Points.Count; i++) Points[i].Number = i + 1;
  890. SelectedPointInDataGrid = item;
  891. _MovePointUpCommand?.RaiseCanExecuteChanged();
  892. _MovePointDownCommand?.RaiseCanExecuteChanged();
  893. }
  894. /// <summary>
  895. /// CAD导入点位
  896. /// </summary>
  897. async void ExecuteImportCadPointCommand()
  898. {
  899. try
  900. {
  901. var view = new DxfView();
  902. //show the dialog
  903. var result = await DialogHost.Show(view, "RootDialog", null, null, null);
  904. if (result != null)
  905. {
  906. var cadPoints = view.Points;
  907. if (cadPoints != null && cadPoints.Count > 0)
  908. {
  909. //要导入的开始点编号
  910. int startNumber = view.StartIndex;
  911. //弹窗提示用户是否确认要导入从该编号开始的点位,点位数量为cadPoints.Count
  912. if (MessageBox.Show($"确认要从点位编号 {startNumber} 开始导入 {cadPoints.Count} 个点位吗?", "导入点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  913. {
  914. return;
  915. }
  916. //导入点位
  917. for (int i = 0; i < cadPoints.Count; i++)
  918. {
  919. //如果点位编号已存在,则更新该点位,否则新增点位,只更新XY坐标
  920. var point = cadPoints[i];
  921. var existingPoint = Points.FirstOrDefault(p => p.Number == startNumber + i);
  922. if (existingPoint != null)
  923. {
  924. existingPoint.X_Position = point.X;
  925. existingPoint.Y_Position = point.Y;
  926. }
  927. else
  928. {
  929. Points.Add(new PlcPoint()
  930. {
  931. Number = startNumber + i,
  932. X_Position = point.X,
  933. Y_Position = point.Y,
  934. X_Velocity = 100,
  935. Y_Velocity = 100,
  936. Z_Velocity_Start = 100,
  937. Z_Velocity_Stop = 100,
  938. U_Velocity = 100,
  939. R_Velocity = 100,
  940. });
  941. }
  942. }
  943. //对所有的点位重新编号,确保编号连续
  944. var sortedPoints = Points.OrderBy(p => p.Number).ToList();
  945. Points.Clear();
  946. for (int i = 0; i < sortedPoints.Count; i++)
  947. {
  948. sortedPoints[i].Number = i + 1;
  949. Points.Add(sortedPoints[i]);
  950. }
  951. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  952. }
  953. }
  954. }
  955. catch (Exception ex)
  956. {
  957. LogHelper.WriteLogError("导入CAD点位时出错!", ex);
  958. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  959. }
  960. }
  961. /// <summary>
  962. /// 停止采集
  963. /// </summary>
  964. void ExecuteStopGrabbingCommand()
  965. {
  966. if (Camera != null)
  967. Camera.StopGrabbing();
  968. IsGrap = false;
  969. }
  970. bool CanExecuteStopGrabbingCommand()
  971. {
  972. return IsGrap;
  973. }
  974. /// <summary>
  975. /// 开始采集
  976. /// </summary>
  977. void ExecuteStartGrabbingCommand()
  978. {
  979. if (Camera != null)
  980. Camera.StartGrabbing();
  981. IsGrap = true;
  982. }
  983. bool CanExecuteStartGrabbingCommand()
  984. {
  985. return SelectedCamera != null && !IsGrap;
  986. }
  987. private void Camera_ImageCallbackEvent(ICogImage image, TimeSpan totaltime, string errormessage)
  988. {
  989. Image = image;
  990. App.Current.Dispatcher.Invoke(new
  991. Action(() =>
  992. {
  993. if (errormessage != null && !string.IsNullOrEmpty(errormessage))
  994. {
  995. Message = $"{Lang.耗时}:{totaltime.TotalMilliseconds.ToString("F1")} ms Error:{errormessage}";
  996. }
  997. else
  998. {
  999. Message = $"{Lang.耗时}:{totaltime.TotalMilliseconds.ToString("F1")} ms";
  1000. }
  1001. }));
  1002. }
  1003. /// <summary>
  1004. /// 去取料
  1005. /// </summary>
  1006. async void ExecuteGoPickCommand()
  1007. {
  1008. try
  1009. {
  1010. if (SelectedPoint == null)
  1011. {
  1012. return;
  1013. }
  1014. if (Robot == null || !Robot.IsConnected)
  1015. {
  1016. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "机器人未连接,无法执行取料!", Duration = 1 });
  1017. return;
  1018. }
  1019. if (MessageBox.Show("确认要执行取料吗?", "去取料", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  1020. {
  1021. return;
  1022. }
  1023. var waiting = new WaitingControl();
  1024. //show the dialog
  1025. var task = DialogHost.Show(waiting, "RootDialog", null, null, null);
  1026. // 1. 控制机器人移动至拍照点位
  1027. var rpoint = new RPoint()
  1028. {
  1029. X = SelectedPoint.X_Position,
  1030. Y = SelectedPoint.Y_Position,
  1031. Z = SelectedPoint.Z_Position_Start,
  1032. U = SelectedPoint.U_Position,
  1033. V = SelectedPoint.R_Position,
  1034. };
  1035. await Robot.CalibMotionAsync(rpoint, null);
  1036. await Robot.CalibParameAsync(new PickInfo() { Inhal = Inhal, Blow = 1 }, 20, 20, true, 200, 200);
  1037. //打开吸真空
  1038. await Robot.CalibOutIOAsync(true);
  1039. await Task.Delay(500);
  1040. rpoint.Z = 0;
  1041. await Robot.CalibMotionAsync(rpoint, null);
  1042. if (DialogHost.IsDialogOpen("RootDialog"))
  1043. {
  1044. DialogHost.Close("RootDialog");
  1045. }
  1046. await task;
  1047. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "取料完成!", Duration = 0.4 });
  1048. }
  1049. catch (Exception ex)
  1050. {
  1051. LogHelper.WriteLogError("取料时出错!", ex);
  1052. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1053. }
  1054. }
  1055. bool CanExecuteCommandGoPickCommandName()
  1056. {
  1057. return SelectedPoint != null;
  1058. }
  1059. ToolCoord toolCoord = null;
  1060. double _FixedUpCameraTempletAngle = 0;
  1061. OpenCvSharp.Point3f[] _PutPoints = new OpenCvSharp.Point3f[2];
  1062. /// <summary>
  1063. /// 去二次定位
  1064. /// </summary>
  1065. async void ExecuteGoRepositionCommand()
  1066. {
  1067. try
  1068. {
  1069. if (SelectedPoint == null)
  1070. {
  1071. return;
  1072. }
  1073. if (Robot == null || !Robot.IsConnected)
  1074. {
  1075. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "机器人未连接,无法执行二次定位!", Duration = 1 });
  1076. return;
  1077. }
  1078. if (MessageBox.Show("确认要执行下相机拍产二次定位吗?", "去下相机拍照", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  1079. {
  1080. return;
  1081. }
  1082. var waiting = new WaitingControl();
  1083. //show the dialog
  1084. var task = DialogHost.Show(waiting, "RootDialog", null, null, null);
  1085. // 1. 控制机器人移动至拍照点位
  1086. var rpoint = new RPoint()
  1087. {
  1088. X = SelectedPoint.X_Position,
  1089. Y = SelectedPoint.Y_Position,
  1090. Z = SelectedPoint.Z_Position_Start,
  1091. U = SelectedPoint.U_Position,
  1092. V = SelectedPoint.R_Position,
  1093. };
  1094. await Robot.CalibMotionAsync(rpoint, null);
  1095. await Task.Delay(200);
  1096. //获取固定向上相机1的流程
  1097. var process1 = _productService.GetCurrentProductProcedureModelById(SelectProduct.FixedUpCamera1ProcedureId);
  1098. if (process1 == null)
  1099. {
  1100. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"固定向上相机1视觉流程,流程ID:{SelectProduct.FixedUpCamera1ProcedureId} 未找到!", Duration = 1 });
  1101. if (DialogHost.IsDialogOpen("RootDialog"))
  1102. {
  1103. DialogHost.Close("RootDialog");
  1104. }
  1105. await task;
  1106. return;
  1107. }
  1108. //获取固定向上相机2的流程
  1109. var process2 = _productService.GetCurrentProductProcedureModelById(SelectProduct.FixedUpCamera2ProcedureId);
  1110. if (process2 == null)
  1111. {
  1112. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"固定向上相机2视觉流程,流程ID:{SelectProduct.FixedUpCamera2ProcedureId} 未找到!", Duration = 1 });
  1113. if (DialogHost.IsDialogOpen("RootDialog"))
  1114. {
  1115. DialogHost.Close("RootDialog");
  1116. }
  1117. await task;
  1118. return;
  1119. }
  1120. // 执行视觉任务
  1121. var _cts = new CancellationTokenSource();
  1122. var task1 = _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, new double[] { rpoint.X, rpoint.Y, rpoint.U }, _cts.Token);
  1123. var task2 = _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, new double[] { rpoint.X, rpoint.Y, rpoint.U }, _cts.Token);
  1124. var visionResults = await Task.WhenAll(task1, task2);
  1125. if (visionResults[0].IsSucceed && visionResults[1].IsSucceed)
  1126. {
  1127. float toolX = (float)(visionResults[0].X + visionResults[1].X) / 2;
  1128. float toolY = (float)(visionResults[0].Y + visionResults[1].Y) / 2;
  1129. _FixedUpCameraTempletAngle = Common.CalculateAngleBetweenPointsDegrees(new PointF((float)visionResults[0].X, (float)visionResults[0].Y), new PointF((float)visionResults[1].X, (float)visionResults[1].Y));
  1130. toolCoord = new ToolCoord();
  1131. toolCoord.SetTool(toolX, toolY);
  1132. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "视觉定位成功!", Duration = 0.4 });
  1133. if (DialogHost.IsDialogOpen("RootDialog"))
  1134. {
  1135. DialogHost.Close("RootDialog");
  1136. }
  1137. await task;
  1138. return;
  1139. }
  1140. else
  1141. {
  1142. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "视觉定位失败,无法进行二次定位!", Duration = 1 });
  1143. if (DialogHost.IsDialogOpen("RootDialog"))
  1144. {
  1145. DialogHost.Close("RootDialog");
  1146. }
  1147. await task;
  1148. return;
  1149. }
  1150. }
  1151. catch (Exception ex)
  1152. {
  1153. LogHelper.WriteLogError("二次定位时出错!", ex);
  1154. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1155. if (DialogHost.IsDialogOpen("RootDialog"))
  1156. {
  1157. DialogHost.Close("RootDialog");
  1158. }
  1159. }
  1160. }
  1161. /// <summary>
  1162. /// 执行产品拍照
  1163. /// </summary>
  1164. async void ExecuteTakeProductPhotoCommand()
  1165. {
  1166. try
  1167. {
  1168. if (SelectedPoint == null)
  1169. {
  1170. return;
  1171. }
  1172. if (Robot == null || !Robot.IsConnected)
  1173. {
  1174. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "机器人未连接,无法执行产品拍照!", Duration = 1 });
  1175. return;
  1176. }
  1177. if (MessageBox.Show("确认要执行产品拍照吗?", "去产品位置拍照", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  1178. {
  1179. return;
  1180. }
  1181. //如果二次定位的工具坐标为空,则提示用户先进行二次定位
  1182. if (toolCoord == null)
  1183. {
  1184. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "二次定位的工具坐标为空,无法执行产品拍照!", Duration = 1 });
  1185. return;
  1186. }
  1187. var waiting = new WaitingControl();
  1188. //show the dialog
  1189. var task = DialogHost.Show(waiting, "RootDialog", null, null, null);
  1190. // 1. 控制机器人移动至拍照点位
  1191. var rpoint = new RPoint()
  1192. {
  1193. X = Points[0].X_Position,
  1194. Y = Points[0].Y_Position,
  1195. Z = Points[0].Z_Position_Start,
  1196. U = Points[0].U_Position,
  1197. V = Points[0].R_Position,
  1198. };
  1199. await Robot.CalibMotionAsync(rpoint, null);
  1200. await Task.Delay(200);
  1201. //获取移动向下相机1的流程
  1202. var process1 = _productService.GetCurrentProductProcedureModelById(SelectProduct.MoveDownCamera1LockPhotoProcedureId);
  1203. if (process1 == null)
  1204. {
  1205. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"移动向下相机1视觉流程,流程ID:{SelectProduct.MoveDownCamera1LockPhotoProcedureId} 未找到!", Duration = 1 });
  1206. if (DialogHost.IsDialogOpen("RootDialog"))
  1207. {
  1208. DialogHost.Close("RootDialog");
  1209. }
  1210. await task;
  1211. return;
  1212. }
  1213. // 执行视觉任务
  1214. var _cts = new CancellationTokenSource();
  1215. var visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process1, null, new double[] { rpoint.X, rpoint.Y, rpoint.U }, _cts.Token);
  1216. if (visionResult.IsSucceed)
  1217. {
  1218. _PutPoints[0] = new OpenCvSharp.Point3f((float)visionResult.X, (float)visionResult.Y, (float)visionResult.U);
  1219. }
  1220. else
  1221. {
  1222. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "视觉定位失败,无法进行产品拍照!", Duration = 1 });
  1223. if (DialogHost.IsDialogOpen("RootDialog"))
  1224. {
  1225. DialogHost.Close("RootDialog");
  1226. }
  1227. await task;
  1228. return;
  1229. }
  1230. // 2. 控制机器人移动至拍照点位
  1231. rpoint = new RPoint()
  1232. {
  1233. X = Points[1].X_Position,
  1234. Y = Points[1].Y_Position,
  1235. Z = Points[1].Z_Position_Start,
  1236. U = Points[1].U_Position,
  1237. V = Points[1].R_Position,
  1238. };
  1239. await Robot.CalibMotionAsync(rpoint, null);
  1240. await Task.Delay(200);
  1241. //获取移动向下相机1的流程
  1242. var process2 = _productService.GetCurrentProductProcedureModelById(SelectProduct.MoveDownCamera2LockPhotoProcedureId);
  1243. if (process2 == null)
  1244. {
  1245. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"移动向下相机2视觉流程,流程ID:{SelectProduct.MoveDownCamera2LockPhotoProcedureId} 未找到!", Duration = 1 });
  1246. if (DialogHost.IsDialogOpen("RootDialog"))
  1247. {
  1248. DialogHost.Close("RootDialog");
  1249. }
  1250. await task;
  1251. return;
  1252. }
  1253. // 执行视觉任务
  1254. _cts = new CancellationTokenSource();
  1255. visionResult = await _remoteCommandService.ExecutePhotoGetSinglePoint(process2, null, new double[] { rpoint.X, rpoint.Y, rpoint.U }, _cts.Token);
  1256. if (visionResult.IsSucceed)
  1257. {
  1258. _PutPoints[1] = new OpenCvSharp.Point3f((float)visionResult.X, (float)visionResult.Y, (float)visionResult.U);
  1259. if (DialogHost.IsDialogOpen("RootDialog"))
  1260. {
  1261. DialogHost.Close("RootDialog");
  1262. }
  1263. await task;
  1264. return;
  1265. }
  1266. else
  1267. {
  1268. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "视觉定位失败,无法进行产品拍照!", Duration = 1 });
  1269. if (DialogHost.IsDialogOpen("RootDialog"))
  1270. {
  1271. DialogHost.Close("RootDialog");
  1272. }
  1273. await task;
  1274. return;
  1275. }
  1276. }
  1277. catch (Exception ex)
  1278. {
  1279. LogHelper.WriteLogError("执行产品拍照时出错!", ex);
  1280. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1281. if (DialogHost.IsDialogOpen("RootDialog"))
  1282. {
  1283. DialogHost.Close("RootDialog");
  1284. }
  1285. }
  1286. }
  1287. /// <summary>
  1288. /// 执行产品贴敷
  1289. /// </summary>
  1290. async void ExecuteTakeProductCommand()
  1291. {
  1292. try
  1293. {
  1294. if (SelectedPoint == null)
  1295. {
  1296. return;
  1297. }
  1298. if (Robot == null || !Robot.IsConnected)
  1299. {
  1300. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "机器人未连接,无法执行产品贴敷!", Duration = 1 });
  1301. return;
  1302. }
  1303. if (MessageBox.Show("确认要执行产品贴敷吗?", "去产品贴敷", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  1304. {
  1305. return;
  1306. }
  1307. //如果二次定位的工具坐标为空,则提示用户先进行二次定位
  1308. if (toolCoord == null)
  1309. {
  1310. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "二次定位的工具坐标为空,无法执行产品拍照!", Duration = 1 });
  1311. return;
  1312. }
  1313. if (_PutPoints[0].X == 0 && _PutPoints[0].Y == 0 && _PutPoints[1].X == 0 && _PutPoints[1].Y == 0)
  1314. {
  1315. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "检测到未定位产品", Duration = 1 });
  1316. return;
  1317. }
  1318. var waiting = new WaitingControl();
  1319. //show the dialog
  1320. var task = DialogHost.Show(waiting, "RootDialog", null, null, null);
  1321. double upCameraX = (_PutPoints[0].X + _PutPoints[1].X) / 2;
  1322. double upCameraY = (_PutPoints[0].Y + _PutPoints[1].Y) / 2;
  1323. double upCameraU = Common.CalculateAngleBetweenPointsDegrees(new PointF((float)_PutPoints[0].X, (float)_PutPoints[0].Y), new PointF((float)_PutPoints[1].X, (float)_PutPoints[1].Y));
  1324. var pn = Vector<double>.Build.Dense(new double[] { upCameraX, upCameraY });
  1325. //目标角度:
  1326. double angle = SelectedPoint.U_Position + (_FixedUpCameraTempletAngle - SelectProduct.FixedUpCameraTempletAngle) + (upCameraU - SelectProduct.MoveDownCamerTempletAngle);
  1327. //将_PutPoint转换为Tool0下要走的点
  1328. var p0 = toolCoord.GetTool0Coord(pn, angle);
  1329. // 1. 控制机器人移动至拍照点位
  1330. var rpoint = new RPoint()
  1331. {
  1332. X = (float)p0[0],
  1333. Y = (float)p0[1],
  1334. Z = SelectedPoint.Z_Position_Start,
  1335. U = (float)angle,
  1336. V = SelectedPoint.R_Position,
  1337. };
  1338. await Robot.CalibMotionAsync(rpoint, null);
  1339. if (DialogHost.IsDialogOpen("RootDialog"))
  1340. {
  1341. DialogHost.Close("RootDialog");
  1342. }
  1343. await task;
  1344. return;
  1345. }
  1346. catch (Exception ex)
  1347. {
  1348. LogHelper.WriteLogError("执行产品贴敷时出错!", ex);
  1349. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1350. if (DialogHost.IsDialogOpen("RootDialog"))
  1351. {
  1352. DialogHost.Close("RootDialog");
  1353. }
  1354. }
  1355. }
  1356. /// <summary>
  1357. /// 附加轴+点动
  1358. /// </summary>
  1359. /// <param name="obj"></param>
  1360. async void ExecuteAdditionalAxisJogPlusCommand(object obj)
  1361. {
  1362. if (Robot == null || !Robot.IsConnected) return;
  1363. try
  1364. {
  1365. if (obj is AxisExtended axis)
  1366. {
  1367. //如果移动距离大于10mm,则提示用户确认
  1368. if (Math.Abs(Distance) >= 10)
  1369. {
  1370. if (MessageBox.Show($"确认要点动距离 {Distance} mm 吗?", "确认点动", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  1371. {
  1372. return;
  1373. }
  1374. }
  1375. await Robot.AdditionalAxisJogAsync(axis.Name, Distance);
  1376. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  1377. }
  1378. }
  1379. catch (Exception ex)
  1380. {
  1381. LogHelper.WriteLogError("附加轴点动+时出错!", ex);
  1382. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1383. }
  1384. }
  1385. /// <summary>
  1386. /// 附加轴-点动
  1387. /// </summary>
  1388. /// <param name="obj"></param>
  1389. async void ExecuteAdditionalAxisJogMinusCommand(object obj)
  1390. {
  1391. if (Robot == null || !Robot.IsConnected) return;
  1392. try
  1393. {
  1394. if (obj is AxisExtended axis)
  1395. {
  1396. //如果移动距离大于10mm,则提示用户确认
  1397. if (Math.Abs(Distance) >= 10)
  1398. {
  1399. if (MessageBox.Show($"确认要点动距离 {Distance} mm 吗?", "确认点动", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  1400. {
  1401. return;
  1402. }
  1403. }
  1404. await Robot.AdditionalAxisJogNegAsync(axis.Name, Distance);
  1405. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  1406. }
  1407. }
  1408. catch (Exception ex)
  1409. {
  1410. LogHelper.WriteLogError("附加轴点动-时出错!", ex);
  1411. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1412. }
  1413. }
  1414. /// <summary>
  1415. /// 附加轴下使能
  1416. /// </summary>
  1417. /// <param name="obj"></param>
  1418. async void ExecuteAdditionalAxisMotorOffCommand(object obj)
  1419. {
  1420. if (Robot == null || !Robot.IsConnected) return;
  1421. try
  1422. {
  1423. if (obj is AxisExtended axis)
  1424. {
  1425. await Robot.AdditionalAxisMotorAsync(axis.Name, false);
  1426. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  1427. }
  1428. }
  1429. catch (Exception ex)
  1430. {
  1431. LogHelper.WriteLogError("附加轴上使能时出错!", ex);
  1432. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1433. }
  1434. }
  1435. /// <summary>
  1436. /// 附加轴上使能
  1437. /// </summary>
  1438. /// <param name="obj"></param>
  1439. async void ExecuteAdditionalAxisMotorOnCommand(object obj)
  1440. {
  1441. if (Robot == null || !Robot.IsConnected) return;
  1442. try
  1443. {
  1444. if (obj is AxisExtended axis)
  1445. {
  1446. await Robot.AdditionalAxisMotorAsync(axis.Name, true);
  1447. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  1448. }
  1449. }
  1450. catch (Exception ex)
  1451. {
  1452. LogHelper.WriteLogError("附加轴下使能时出错!", ex);
  1453. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1454. }
  1455. }
  1456. /// <summary>
  1457. /// 移动取料托盘点
  1458. /// </summary>
  1459. async void ExecutePickMoveCommand(string parameter)
  1460. {
  1461. if (Robot == null || !Robot.IsConnected) return;
  1462. try
  1463. {
  1464. //弹窗用户是否确认要示教该点位
  1465. if (MessageBox.Show($"确认要移动取料点位 {parameter} 吗?", "移动点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  1466. {
  1467. return;
  1468. }
  1469. int palletIndex = int.Parse(parameter.Split('-')[0]);
  1470. int pointIndex = int.Parse(parameter.Split('-')[1]);
  1471. var curpos = await Robot.GetRobotPosAsync();
  1472. var addpos = await Robot.GetAdditionalAxisCurrentPosAsync(Robot.AdditionalAxisList[0].Name);
  1473. PlcPoint pn = null;
  1474. if (palletIndex == 1)
  1475. {
  1476. switch (pointIndex)
  1477. {
  1478. case 1:
  1479. pn = Pallet1.P0.Clone();
  1480. break;
  1481. case 2:
  1482. pn = Pallet1.P1.Clone();
  1483. break;
  1484. case 3:
  1485. pn = Pallet1.P2.Clone();
  1486. break;
  1487. default:
  1488. break;
  1489. }
  1490. }
  1491. else
  1492. {
  1493. switch (pointIndex)
  1494. {
  1495. case 1:
  1496. pn = Pallet2.P0.Clone();
  1497. break;
  1498. case 2:
  1499. pn = Pallet2.P1.Clone();
  1500. break;
  1501. case 3:
  1502. pn = Pallet2.P2.Clone();
  1503. break;
  1504. default:
  1505. break;
  1506. }
  1507. }
  1508. if (pn == null)
  1509. {
  1510. return;
  1511. }
  1512. // 1.Z轴上升到安全高度
  1513. curpos.Z = 0;
  1514. bool isSuccess = await Robot.CalibMotionAsync(curpos, null);
  1515. if (!isSuccess)
  1516. {
  1517. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "机器人移动失败!", Duration = 1 });
  1518. return;
  1519. }
  1520. // 2.附加轴移动
  1521. isSuccess = await Robot.AdditionalAxisMoveAsync(Robot.AdditionalAxisList[0].Name, pn.Z_Position_Stop);
  1522. if (!isSuccess)
  1523. {
  1524. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "附加轴移动失败!", Duration = 1 });
  1525. return;
  1526. }
  1527. // 3.移动XY轴到位
  1528. curpos.X = pn.X_Position;
  1529. curpos.Y = pn.Y_Position;
  1530. curpos.Z = pn.Z_Position_Start;
  1531. curpos.U = pn.U_Position;
  1532. isSuccess = await Robot.CalibMotionAsync(curpos, null);
  1533. if (!isSuccess)
  1534. {
  1535. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "机器人移动失败!", Duration = 1 });
  1536. return;
  1537. }
  1538. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  1539. }
  1540. catch (Exception ex)
  1541. {
  1542. LogHelper.WriteLogError("示教取料托盘点时出错!", ex);
  1543. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1544. }
  1545. }
  1546. /// <summary>
  1547. /// 示教取料托盘点
  1548. /// </summary>
  1549. /// <param name="parameter"></param>
  1550. async void ExecutePickTechCommand(string parameter)
  1551. {
  1552. if (Robot == null || !Robot.IsConnected) return;
  1553. try
  1554. {
  1555. //弹窗用户是否确认要示教该点位
  1556. if (MessageBox.Show($"确认要示教取料点位 {parameter} 吗?", "示教点位", MessageBoxButton.YesNo, MessageBoxImage.Question) != MessageBoxResult.Yes)
  1557. {
  1558. return;
  1559. }
  1560. int palletIndex = int.Parse(parameter.Split('-')[0]);
  1561. int pointIndex = int.Parse(parameter.Split('-')[1]);
  1562. var curpos = await Robot.GetRobotPosAsync();
  1563. var addpos = await Robot.GetAdditionalAxisCurrentPosAsync(Robot.AdditionalAxisList[0].Name);
  1564. if (palletIndex == 1)
  1565. {
  1566. switch (pointIndex)
  1567. {
  1568. case 1:
  1569. Pallet1.P0.X_Position = curpos.X;
  1570. Pallet1.P0.Y_Position = curpos.Y;
  1571. Pallet1.P0.Z_Position_Start = curpos.Z;
  1572. Pallet1.P0.U_Position = curpos.U;
  1573. Pallet1.P0.Z_Position_Stop = addpos;
  1574. break;
  1575. case 2:
  1576. Pallet1.P1.X_Position = curpos.X;
  1577. Pallet1.P1.Y_Position = curpos.Y;
  1578. Pallet1.P1.Z_Position_Start = curpos.Z;
  1579. Pallet1.P1.U_Position = curpos.U;
  1580. Pallet1.P1.Z_Position_Stop = addpos;
  1581. break;
  1582. case 3:
  1583. Pallet1.P2.X_Position = curpos.X;
  1584. Pallet1.P2.Y_Position = curpos.Y;
  1585. Pallet1.P2.Z_Position_Start = curpos.Z;
  1586. Pallet1.P2.U_Position = curpos.U;
  1587. Pallet1.P2.Z_Position_Stop = addpos;
  1588. break;
  1589. default:
  1590. break;
  1591. }
  1592. }
  1593. else
  1594. {
  1595. switch (pointIndex)
  1596. {
  1597. case 1:
  1598. Pallet2.P0.X_Position = curpos.X;
  1599. Pallet2.P0.Y_Position = curpos.Y;
  1600. Pallet2.P0.Z_Position_Start = curpos.Z;
  1601. Pallet2.P0.U_Position = curpos.U;
  1602. Pallet2.P0.Z_Position_Stop = addpos;
  1603. break;
  1604. case 2:
  1605. Pallet2.P1.X_Position = curpos.X;
  1606. Pallet2.P1.Y_Position = curpos.Y;
  1607. Pallet2.P1.Z_Position_Start = curpos.Z;
  1608. Pallet2.P1.U_Position = curpos.U;
  1609. Pallet2.P1.Z_Position_Stop = addpos;
  1610. break;
  1611. case 3:
  1612. Pallet2.P2.X_Position = curpos.X;
  1613. Pallet2.P2.Y_Position = curpos.Y;
  1614. Pallet2.P2.Z_Position_Start = curpos.Z;
  1615. Pallet2.P2.U_Position = curpos.U;
  1616. Pallet2.P2.Z_Position_Stop = addpos;
  1617. break;
  1618. default:
  1619. break;
  1620. }
  1621. }
  1622. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  1623. }
  1624. catch (Exception ex)
  1625. {
  1626. LogHelper.WriteLogError("示教取料托盘点时出错!", ex);
  1627. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1628. }
  1629. }
  1630. /// <summary>
  1631. /// 计算所有托盘点
  1632. /// </summary>
  1633. void ExecuteCalPickPosCommand(string parameter)
  1634. {
  1635. try
  1636. {
  1637. int palletIndex = int.Parse(parameter);
  1638. if (palletIndex == 1)
  1639. {
  1640. PalletTool palletTool = new PalletTool(Pallet1);
  1641. //托盘中所有的点‘
  1642. var points = palletTool.PlcPoints;
  1643. //将所有的点写入到取料点中,如果当前定义的取料点不存在,则新增
  1644. for (int i = 0; i < points.Length; i++)
  1645. {
  1646. //如果当前的取料点数量小于等于i,则新增一个取料点
  1647. if (SelectProduct.PickPoints.Count <= i)
  1648. {
  1649. SelectProduct.PickPoints.Add(new PlcPoint()
  1650. {
  1651. Number = i + 1,
  1652. X_Position = points[i].X_Position,
  1653. X_Velocity = 100,
  1654. Y_Position = points[i].Y_Position,
  1655. Y_Velocity = 100,
  1656. Z_Position_Start = points[i].Z_Position_Start,
  1657. Z_Velocity_Start = 100,
  1658. U_Position = points[i].U_Position,
  1659. U_Velocity = 100,
  1660. Z_Position_Stop = points[i].Z_Position_Stop,
  1661. Z_Velocity_Stop = 100,
  1662. });
  1663. }
  1664. else
  1665. {
  1666. //否则更新当前的取料点
  1667. SelectProduct.PickPoints[i].Number = i + 1;
  1668. SelectProduct.PickPoints[i].X_Position = points[i].X_Position;
  1669. SelectProduct.PickPoints[i].Y_Position = points[i].Y_Position;
  1670. SelectProduct.PickPoints[i].Z_Position_Start = points[i].Z_Position_Start;
  1671. SelectProduct.PickPoints[i].U_Position = points[i].U_Position;
  1672. SelectProduct.PickPoints[i].Z_Position_Stop = points[i].Z_Position_Stop;
  1673. }
  1674. }
  1675. }
  1676. else
  1677. {
  1678. //如果当前的取料点数量小于托盘1的点数量,则提示用户先计算托盘1的点
  1679. if (SelectProduct.PickPoints.Count < Pallet1.Row * Pallet1.Column)
  1680. {
  1681. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = "请先计算托盘1的点位!", Duration = 1 });
  1682. return;
  1683. }
  1684. PalletTool palletTool = new PalletTool(Pallet2);
  1685. //托盘中所有的点‘
  1686. var points = palletTool.PlcPoints;
  1687. //将所有的点写入到取料点中,如果当前定义的取料点不存在,则新增
  1688. for (int i = 0; i < points.Length; i++)
  1689. {
  1690. int index = i + Pallet1.Row * Pallet1.Column;
  1691. //如果当前的取料点数量小于等于index,则新增一个取料点
  1692. if (SelectProduct.PickPoints.Count <= index)
  1693. {
  1694. SelectProduct.PickPoints.Add(new PlcPoint()
  1695. {
  1696. Number = index + 1,
  1697. X_Position = points[i].X_Position,
  1698. X_Velocity = 100,
  1699. Y_Position = points[i].Y_Position,
  1700. Y_Velocity = 100,
  1701. Z_Position_Start = points[i].Z_Position_Start,
  1702. Z_Velocity_Start = 100,
  1703. U_Position = points[i].U_Position,
  1704. U_Velocity = 100,
  1705. Z_Position_Stop = points[i].Z_Position_Stop,
  1706. Z_Velocity_Stop = 100,
  1707. });
  1708. }
  1709. else
  1710. {
  1711. //否则更新当前的取料点
  1712. SelectProduct.PickPoints[index].Number = index + 1;
  1713. SelectProduct.PickPoints[index].X_Position = points[i].X_Position;
  1714. SelectProduct.PickPoints[index].Y_Position = points[i].Y_Position;
  1715. SelectProduct.PickPoints[index].Z_Position_Start = points[i].Z_Position_Start;
  1716. SelectProduct.PickPoints[index].U_Position = points[i].U_Position;
  1717. SelectProduct.PickPoints[index].Z_Position_Stop = points[i].Z_Position_Stop;
  1718. }
  1719. }
  1720. }
  1721. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = $"{Lang.完成}!", Duration = 0.4 });
  1722. }
  1723. catch (Exception ex)
  1724. {
  1725. LogHelper.WriteLogError("示教取料托盘点时出错!", ex);
  1726. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = ex.Message, Duration = 1 });
  1727. }
  1728. }
  1729. /// <summary>
  1730. /// 动态测试分析仪
  1731. /// </summary>
  1732. void ExecuteDynamicTestAnalyzerCommand()
  1733. {
  1734. try
  1735. {
  1736. IDialogParameters parameters = new DialogParameters();
  1737. parameters.Add("SelectProduct", SelectProduct);
  1738. parameters.Add("Robot", Robot);
  1739. _dialogService.Show("VisionDynamicAccuracyAnalyzer", parameters, rst =>
  1740. {
  1741. //对话框关闭之后的回调函数,可以在这解析结果。
  1742. ButtonResult result1 = rst.Result;
  1743. if (result1 == ButtonResult.OK)
  1744. {
  1745. //var param = rst.Parameters.GetValue<RobotTool>("Tool");
  1746. //var param1 = rst.Parameters.GetValue<Matrix<double>>("RobotCameraRotationMatrix");
  1747. //var param2 = rst.Parameters.GetValue<double>("Angle");
  1748. _eventAggregator.GetEvent<SnackbarMessageNotification>().Publish(new MessageParameter() { Msg = Lang.完成, Duration = 1 });
  1749. }
  1750. });
  1751. }
  1752. catch (Exception ex)
  1753. {
  1754. LogHelper.WriteLogError("执行动态测试分析仪命令时出错", ex);
  1755. MessageBox.Show(ex.Message);
  1756. }
  1757. }
  1758. #endregion
  1759. #region 继承
  1760. /// <summary>
  1761. /// 确认导航请求时调用。此方法允许您在导航之前执行一些操作。
  1762. /// </summary>
  1763. /// <param name="navigationContext"></param>
  1764. /// <param name="continuationCallback"></param>
  1765. public void ConfirmNavigationRequest(NavigationContext navigationContext, Action<bool> continuationCallback)
  1766. {
  1767. continuationCallback(true);
  1768. }
  1769. /// <summary>
  1770. /// 接收导航请求时调用。传入导航参数,包含有关导航目标的信息。
  1771. /// </summary>
  1772. /// <param name="navigationContext"></param>
  1773. /// <exception cref="NotImplementedException"></exception>
  1774. public async void OnNavigatedTo(NavigationContext navigationContext)
  1775. {
  1776. try
  1777. {
  1778. toolCoord = null;
  1779. SelectProduct = navigationContext.Parameters.GetValue<ProductModel>("SelectProduct");
  1780. SelectedIndex = 0;
  1781. Points = SelectProduct.PickCameraPoints;
  1782. if (Robot == null)
  1783. {
  1784. Robot = _robotService.GetRobotByNumber(1) as XYZU_Robot;
  1785. }
  1786. if (Robot != null && Robot.IsConnected)
  1787. {
  1788. this.Distance = _configService.GetRobotStepDistance(Robot.Id);
  1789. Robot.EnterDebugMode = true;
  1790. AdditionalAxisList = Robot.AdditionalAxisList;
  1791. }
  1792. else if (Robot != null)
  1793. {
  1794. Robot.EnterDebugMode = true;
  1795. }
  1796. ProcedureModels = new ObservableCollection<ProcedureModel>();
  1797. foreach (var item in SelectProduct.CameraProcedures)
  1798. {
  1799. foreach (var item1 in item.ProcedureModels)
  1800. {
  1801. ProcedureModels.Add(item1);
  1802. }
  1803. }
  1804. CameraList = new ObservableCollection<CameraInfo>(_configService.GetAllCameras());
  1805. Pallet1 = new PalletEx() { Row = 4, Column = 2, P1 = new PlcPoint(), P0 = new PlcPoint(), P2 = new PlcPoint() };
  1806. Pallet2 = new PalletEx() { Row = 4, Column = 2, P1 = new PlcPoint(), P0 = new PlcPoint(), P2 = new PlcPoint() };
  1807. }
  1808. catch (Exception ex)
  1809. {
  1810. LogHelper.WriteLogError("机器人点位界面进入时出错!", ex);
  1811. }
  1812. }
  1813. /// <summary>
  1814. /// 是否允许导航到此视图模型。
  1815. /// </summary>
  1816. /// <param name="navigationContext"></param>
  1817. /// <returns></returns>
  1818. public bool IsNavigationTarget(NavigationContext navigationContext)
  1819. {
  1820. return true;
  1821. }
  1822. /// <summary>
  1823. /// 导航离开此视图模型时调用。您可以在此处执行清理操作或保存状态。
  1824. /// </summary>
  1825. /// <param name="navigationContext"></param>
  1826. public void OnNavigatedFrom(NavigationContext navigationContext)
  1827. {
  1828. //if (Robot != null)
  1829. //{
  1830. // Robot.EnterDebugMode = false;
  1831. //}
  1832. try
  1833. {
  1834. IsGrap = false;
  1835. if (Camera != null)
  1836. {
  1837. if (Camera.IsGrabbing)
  1838. {
  1839. Camera.StopGrabbing();
  1840. }
  1841. Camera.ImageCallbackEvent -= Camera_ImageCallbackEvent;
  1842. Camera = null;
  1843. }
  1844. SelectedCamera = null;
  1845. IsLeftDrawerOpen = false;
  1846. }
  1847. catch (Exception)
  1848. {
  1849. }
  1850. }
  1851. #endregion
  1852. private bool _IsAllowEdit = false;
  1853. public bool IsAllowEdit
  1854. {
  1855. get { return _IsAllowEdit; }
  1856. set { SetProperty(ref _IsAllowEdit, value); }
  1857. }
  1858. private void LoginChange(Models.User user)
  1859. {
  1860. if (user.userPart == Enums.UserPart.Operator)
  1861. {
  1862. IsAllowEdit = false;
  1863. }
  1864. else
  1865. {
  1866. IsAllowEdit = true;
  1867. }
  1868. }
  1869. }
  1870. }