ProcessChamberViewModel.cs 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330
  1. using Aitex.Core.Util;
  2. using LiveCharts.Wpf;
  3. using MECF.Framework.Common.Beckhoff.Station;
  4. using MECF.Framework.Common.CommonData.PUF;
  5. using MECF.Framework.Common.DataCenter;
  6. using MECF.Framework.Common.Equipment;
  7. using MECF.Framework.Common.Layout;
  8. using MECF.Framework.Common.ProcessCell;
  9. using MECF.Framework.Common.Reservior;
  10. using MECF.Framework.Common.Utilities;
  11. using CyberX8_Core;
  12. using CyberX8_Themes.UserControls;
  13. using Prism.Mvvm;
  14. using System;
  15. using System.Collections.Concurrent;
  16. using System.Collections.Generic;
  17. using System.IO;
  18. using System.Linq;
  19. using System.Text;
  20. using System.Threading.Tasks;
  21. using System.Timers;
  22. using System.Windows.Threading;
  23. using System.Windows;
  24. using System.Windows.Markup;
  25. namespace CyberX8_MainPages.ViewModels
  26. {
  27. public class ProcessChamberViewModel : BindableBase
  28. {
  29. #region 常量
  30. private const string CURRENT_STATION = "CurrentStation";
  31. private const string MOTION_DATA = "MotionData";
  32. /// <summary>
  33. /// Transporter盒子的宽度85
  34. /// </summary>
  35. private const int TRANSPORTER_BOX_LENGTH = 85;
  36. /// <summary>
  37. /// Loader Buffer元素宽度的一半(12/2)
  38. /// </summary>
  39. private const int LOADER_BUFFER_HALF_LENGTH = 6;
  40. /// <summary>
  41. /// Transporter中线最高位置到Cell之间的距离
  42. /// </summary>
  43. private const int VERTICAL_DISTANCE = 115;
  44. #endregion
  45. #region 内部变量
  46. private ProcessLayout _processLayout;
  47. /// <summary>
  48. /// Loader Gantry运动数据
  49. /// </summary>
  50. private CommandMotionData _loaderGantryMotionData;
  51. /// <summary>
  52. /// Loader Elevator运动数据
  53. /// </summary>
  54. private CommandMotionData _loaderElevatorMotionData;
  55. /// <summary>
  56. /// Loader Transporter Gantry当前位置
  57. /// </summary>
  58. private double _loaderTransporterGantryPosition;
  59. /// <summary>
  60. /// Loader transporter Elevator当前位置
  61. /// </summary>
  62. private double _loaderTransporterElevatorPosition;
  63. /// <summary>
  64. /// Process Gantry运动数据
  65. /// </summary>
  66. private CommandMotionData _processGantryMotionData;
  67. /// <summary>
  68. /// Process Elevator运动数据
  69. /// </summary>
  70. private CommandMotionData _processElevatorMotionData;
  71. /// <summary>
  72. /// Process transporter Gantry当前位置
  73. /// </summary>
  74. private double _processTransporterGantryPosition;
  75. /// <summary>
  76. /// Process transporter Elevator当前位置
  77. /// </summary>
  78. private double _processTransporterElevatorPosition;
  79. /// <summary>
  80. /// UI水平距离
  81. /// </summary>
  82. private int _transporterLayoutHorizontalDistance;
  83. /// <summary>
  84. /// ui 水平比例
  85. /// </summary>
  86. private double _horizontalRatio;
  87. /// <summary>
  88. /// ui垂直比例
  89. /// </summary>
  90. private double _verticalRatio;
  91. /// <summary>
  92. /// Loader UI的位置
  93. /// </summary>
  94. private int _loaderPosition;
  95. /// <summary>
  96. /// Cell 工位最左侧的位置
  97. /// </summary>
  98. private double _stationMin;
  99. /// <summary>
  100. /// Process与Loader偏差距离
  101. /// </summary>
  102. private int _biasDistanceBetweenLoaderAndProcess;
  103. /// <summary>
  104. /// RT查询key集合
  105. /// </summary>
  106. private List<string> _rtDataKeys = new List<string>();
  107. /// <summary>
  108. /// rt查询key数值字典
  109. /// </summary>
  110. private Dictionary<string, object> _rtDataValueDic = new Dictionary<string, object>();
  111. /// <summary>
  112. /// 定时器
  113. /// </summary>
  114. private DispatcherTimer _timer;
  115. /// <summary>
  116. /// Process控件是否加载
  117. /// </summary>
  118. private bool _processControlLoaded;
  119. #endregion
  120. #region 属性
  121. public ProcessLayout ProcessLayout { get { return _processLayout; } set { SetProperty(ref _processLayout, value); } }
  122. public CommandMotionData LoaderGantryMotionData
  123. {
  124. get { return _loaderGantryMotionData; }
  125. set { SetProperty(ref _loaderGantryMotionData, value); }
  126. }
  127. public CommandMotionData LoaderElevatorMotionData
  128. {
  129. get { return _loaderElevatorMotionData; }
  130. set { SetProperty(ref _loaderElevatorMotionData, value); }
  131. }
  132. public double LoaderTransporterGantryPosition
  133. {
  134. get { return _loaderTransporterGantryPosition; }
  135. set { SetProperty(ref _loaderTransporterGantryPosition, value); }
  136. }
  137. public double LoaderTransporterElevatorPosition
  138. {
  139. get { return _loaderTransporterElevatorPosition; }
  140. set { SetProperty(ref _loaderTransporterElevatorPosition, value); }
  141. }
  142. public CommandMotionData ProcessGantryMotionData
  143. {
  144. get { return _processGantryMotionData; }
  145. set { SetProperty(ref _processGantryMotionData, value); }
  146. }
  147. public CommandMotionData ProcessElevatorMotionData
  148. {
  149. get { return _processElevatorMotionData; }
  150. set { SetProperty(ref _processElevatorMotionData, value); }
  151. }
  152. public double ProcessTransporterGantryPosition
  153. {
  154. get { return _processTransporterGantryPosition; }
  155. set { SetProperty(ref _processTransporterGantryPosition, value); }
  156. }
  157. public double ProcessTransporterElevatorPosition
  158. {
  159. get { return _processTransporterElevatorPosition; }
  160. set { SetProperty(ref _processTransporterElevatorPosition, value); }
  161. }
  162. public bool ProcessControlLoaded
  163. {
  164. get { return _processControlLoaded; }
  165. set { SetProperty(ref _processControlLoaded, value); }
  166. }
  167. #endregion
  168. public ProcessChamberViewModel()
  169. {
  170. }
  171. /// <summary>
  172. /// 加载数据
  173. /// </summary>
  174. public void LoadData(object obj)
  175. {
  176. if (obj==null)
  177. {
  178. return;
  179. }
  180. ProcessControlLoaded = true;
  181. _transporterLayoutHorizontalDistance=(int) QueryDataClient.Instance.Service.GetConfig("Transporter.TransporterLayoutHorizontalDistance");
  182. _loaderPosition = (int)QueryDataClient.Instance.Service.GetConfig("Transporter.TransporterLayoutLoaderPosition");
  183. _biasDistanceBetweenLoaderAndProcess= (int)QueryDataClient.Instance.Service.GetConfig("Transporter.BiasDistanceBetweenLoaderAndProcess");
  184. _rtDataKeys.Clear();
  185. _rtDataKeys.Add($"Station.{ModuleName.Transporter2}.Gantry");
  186. _rtDataKeys.Add($"Station.{ModuleName.Transporter1}.Gantry");
  187. _rtDataKeys.Add($"Station.{ModuleName.Transporter2}.Elevator");
  188. _rtDataKeys.Add($"Station.{ModuleName.Transporter1}.Elevator");
  189. _rtDataValueDic = QueryDataClient.Instance.Service.PollData(_rtDataKeys);
  190. if(_rtDataValueDic!=null)
  191. {
  192. BeckhoffStationAxis loaderTransporterAxis = CommonFunction.GetValue<BeckhoffStationAxis>(_rtDataValueDic, $"Station.{ModuleName.Transporter2}.Gantry");
  193. BeckhoffStationAxis processTransporterAxis = CommonFunction.GetValue<BeckhoffStationAxis>(_rtDataValueDic, $"Station.{ModuleName.Transporter1}.Gantry");
  194. var result = CalculateTransporterMaxMin(loaderTransporterAxis, processTransporterAxis);
  195. double distance = result.max-_biasDistanceBetweenLoaderAndProcess - result.min;
  196. _horizontalRatio = distance / _transporterLayoutHorizontalDistance;
  197. _stationMin = result.min;
  198. BeckhoffStationAxis loaderTransporterElevatorAxis= CommonFunction.GetValue<BeckhoffStationAxis>(_rtDataValueDic, $"Station.{ModuleName.Transporter2}.Elevator");
  199. BeckhoffStationAxis processTransporterElevatorAxis = CommonFunction.GetValue<BeckhoffStationAxis>(_rtDataValueDic, $"Station.{ModuleName.Transporter1}.Elevator");
  200. var verticalResult=CalculateTransporterMaxMin(loaderTransporterElevatorAxis, processTransporterElevatorAxis);
  201. double verticalDistance = verticalResult.max - verticalResult.min;
  202. _verticalRatio = verticalDistance / VERTICAL_DISTANCE;
  203. }
  204. InitialKeys();
  205. if (_timer == null)
  206. {
  207. _timer = new DispatcherTimer();
  208. _timer.Interval = TimeSpan.FromMilliseconds(100);
  209. _timer.Tick += Timer_Tick;
  210. }
  211. _timer.Start();
  212. }
  213. /// <summary>
  214. /// 隐藏
  215. /// </summary>
  216. public void Hide()
  217. {
  218. if(_timer!=null)
  219. {
  220. _timer.Stop();
  221. }
  222. }
  223. /// <summary>
  224. /// 定时器执行
  225. /// </summary>
  226. /// <param name="sender"></param>
  227. /// <param name="e"></param>
  228. private void Timer_Tick(object sender, EventArgs e)
  229. {
  230. if (_rtDataKeys.Count != 0)
  231. {
  232. _rtDataValueDic = QueryDataClient.Instance.Service.PollData(_rtDataKeys);
  233. if (_rtDataValueDic != null)
  234. {
  235. LoaderGantryMotionData = CommonFunction.GetValue<CommandMotionData>(_rtDataValueDic, $"{ModuleName.Transporter2}.Gantry.{MOTION_DATA}");
  236. if (LoaderGantryMotionData != null&&LoaderGantryMotionData.IsDataInitialized)
  237. {
  238. LoaderTransporterGantryPosition = _loaderPosition + (LoaderGantryMotionData.MotorPosition - _stationMin) / _horizontalRatio - TRANSPORTER_BOX_LENGTH+LOADER_BUFFER_HALF_LENGTH;
  239. }
  240. LoaderElevatorMotionData= CommonFunction.GetValue<CommandMotionData>(_rtDataValueDic, $"{ModuleName.Transporter2}.Elevator.{MOTION_DATA}");
  241. if(LoaderElevatorMotionData!=null&&LoaderElevatorMotionData.IsDataInitialized)
  242. {
  243. LoaderTransporterElevatorPosition = LoaderElevatorMotionData.MotorPosition / _verticalRatio;
  244. }
  245. ProcessGantryMotionData = CommonFunction.GetValue<CommandMotionData>(_rtDataValueDic, $"{ModuleName.Transporter1}.Gantry.{MOTION_DATA}");
  246. if (ProcessGantryMotionData != null&&ProcessGantryMotionData.IsDataInitialized)
  247. {
  248. ProcessTransporterGantryPosition = _loaderPosition+ (ProcessGantryMotionData.MotorPosition+_biasDistanceBetweenLoaderAndProcess - _stationMin) / _horizontalRatio - TRANSPORTER_BOX_LENGTH+LOADER_BUFFER_HALF_LENGTH;
  249. }
  250. ProcessElevatorMotionData = CommonFunction.GetValue<CommandMotionData>(_rtDataValueDic, $"{ModuleName.Transporter1}.Elevator.{MOTION_DATA}");
  251. if (ProcessElevatorMotionData != null && ProcessElevatorMotionData.IsDataInitialized)
  252. {
  253. ProcessTransporterElevatorPosition = ProcessElevatorMotionData.MotorPosition / _verticalRatio;
  254. }
  255. }
  256. }
  257. }
  258. /// <summary>
  259. /// 计算Tansporter水平最大值最小值
  260. /// </summary>
  261. /// <param name="loaderTransporterAxis"></param>
  262. /// <param name="processTransporterAxis"></param>
  263. /// <returns></returns>
  264. private (double max,double min) CalculateTransporterMaxMin(BeckhoffStationAxis loaderTransporterAxis,BeckhoffStationAxis processTransporterAxis)
  265. {
  266. double max = 0;
  267. double min = double.MaxValue;
  268. foreach(Station item in loaderTransporterAxis.Stations)
  269. {
  270. double position = double.Parse(item.Position);
  271. if(position > max)
  272. {
  273. max = position;
  274. }
  275. if(position<min)
  276. {
  277. min = position;
  278. }
  279. }
  280. foreach (Station item in processTransporterAxis.Stations)
  281. {
  282. double position = double.Parse(item.Position);
  283. if (position > max)
  284. {
  285. max = position;
  286. }
  287. if (position < min)
  288. {
  289. min = position;
  290. }
  291. }
  292. return (max,min);
  293. }
  294. /// <summary>
  295. /// 初始化Keys
  296. /// </summary>
  297. private void InitialKeys()
  298. {
  299. _rtDataKeys.Clear();
  300. _rtDataKeys.Add($"{ModuleName.Transporter2}.Gantry.{CURRENT_STATION}");
  301. _rtDataKeys.Add($"{ModuleName.Transporter2}.Gantry.{MOTION_DATA}");
  302. _rtDataKeys.Add($"{ModuleName.Transporter2}.Elevator.{CURRENT_STATION}");
  303. _rtDataKeys.Add($"{ModuleName.Transporter2}.Elevator.{MOTION_DATA}");
  304. _rtDataKeys.Add($"{ModuleName.Transporter1}.Gantry.{CURRENT_STATION}");
  305. _rtDataKeys.Add($"{ModuleName.Transporter1}.Gantry.{MOTION_DATA}");
  306. _rtDataKeys.Add($"{ModuleName.Transporter1}.Elevator.{CURRENT_STATION}");
  307. _rtDataKeys.Add($"{ModuleName.Transporter1}.Elevator.{MOTION_DATA}");
  308. }
  309. }
  310. }