IoHighTemperatureHeater.cs 27 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623
  1. using Aitex.Core.RT.DataCenter;
  2. using Aitex.Core.RT.Device;
  3. using Aitex.Core.RT.IOCore;
  4. using Aitex.Core.RT.Log;
  5. using Aitex.Core.RT.OperationCenter;
  6. using Aitex.Core.RT.SCCore;
  7. using Aitex.Core.Util;
  8. using MECF.Framework.Common.CommonData;
  9. using MECF.Framework.Common.CommonData.DeviceData;
  10. using System;
  11. using System.Threading.Tasks;
  12. using System.Xml;
  13. using Venus_Core;
  14. namespace Venus_RT.Devices.IODevices
  15. {
  16. public class IoHighTemperatureHeater : BaseDevice, IDevice
  17. {
  18. private readonly DIAccessor _diPowerOnFeedback;
  19. private readonly DOAccessor _doPowerOn;
  20. private readonly AIAccessor _aiTemperatureFeedback;
  21. private readonly AOAccessor _aoTemperatureSetPoint;
  22. private readonly DIAccessor _diGoPosition1Feedback;
  23. private readonly DOAccessor _doGoPosition1On;
  24. private readonly DIAccessor _diGoPosition2Feedback;
  25. private readonly DOAccessor _doGoPosition2On;
  26. private readonly DIAccessor _diGoPosition3Feedback;
  27. private readonly DOAccessor _doGoPosition3On;
  28. private readonly DIAccessor _diGoPosition4Feedback;
  29. private readonly DOAccessor _doGoPosition4On;
  30. private readonly DIAccessor _diGoPosition5Feedback;
  31. private readonly DOAccessor _doGoPosition5On;
  32. private readonly DIAccessor _diGoOriginFeedback;
  33. private readonly DOAccessor _doGoOriginOn;
  34. private readonly AOAccessor _aoLiftServoPosition1;
  35. private readonly AOAccessor _aoLiftServoPosition2;
  36. private readonly AOAccessor _aoLiftServoPosition3;
  37. private readonly AOAccessor _aoLiftServoPosition4;
  38. private readonly AOAccessor _aoLiftServoPosition5;
  39. private readonly AOAccessor _aoOriginSearchHighSpeed;
  40. private readonly AOAccessor _aoOriginSearchLowSpeed;
  41. private readonly AOAccessor _aoAbsMoveSpeed;
  42. private readonly AOAccessor _aoMaximusMoveSpeed;
  43. private readonly AOAccessor _aoSoftDownLimit;
  44. private readonly AOAccessor _aoSoftUpLimit;
  45. private readonly AOAccessor _aoRatio;
  46. private readonly DIAccessor _diDriverAlarm;
  47. private readonly DIAccessor _diPosiModuleAlarm;
  48. private readonly DIAccessor _diORGFailAlarm;
  49. private readonly DOAccessor _doResetLift;
  50. private readonly DeviceTimer _originTimer = new DeviceTimer();
  51. private readonly DeviceTimer _position1Timer = new DeviceTimer();
  52. private readonly DeviceTimer _position2Timer = new DeviceTimer();
  53. private readonly DeviceTimer _position3Timer = new DeviceTimer();
  54. private readonly DeviceTimer _position4Timer = new DeviceTimer();
  55. private readonly DeviceTimer _position5Timer = new DeviceTimer();
  56. private int _goPositionTime = 60 * 1000;
  57. private float HighTemperatureHeaterTemperatureSetPoint;
  58. private string HighTemperatureHeaterPositipnSetPoint;
  59. private float HighTemperatureHeaterRatioSetPoint;
  60. private float _maxTemperatureSetPoint;
  61. private float _minTemperatureSetPoint;
  62. private float _maxRatioSetPoint;
  63. private float _minRatioSetPoint;
  64. private int _clearAlarmCounter;
  65. private AITHighTemperatureHeaterData DeviceData
  66. {
  67. get
  68. {
  69. return new AITHighTemperatureHeaterData
  70. {
  71. Module = Module,
  72. DeviceName = Name,
  73. DisplayName = Display,
  74. HighTemperatureHeaterPositionFeedBack = CurrentPosition.ToString(),
  75. HighTemperatureHeaterIsonFeedBack = HighTemperatureHeaterIsOn,
  76. HighTemperatureHeaterTemperatureFeedBack = HighTemperatureHighHeaterTemperature,
  77. HighTemperatureHeaterRatioFeedBack = HighTemperatureHeaterRatio,
  78. HighTemperatureHeaterPositionSetPoint = HighTemperatureHeaterPositipnSetPoint,
  79. HighTemperatureHeaterTemperatureSetPoint = HighTemperatureHeaterTemperatureSetPoint,
  80. HighTemperatureHeaterRatioSetPoint = HighTemperatureHeaterRatioSetPoint,
  81. LiftIsAlarm = IsDriverAlarm || IsPosiModuleAlarm || IsORGFailAlarm
  82. };
  83. }
  84. }
  85. public bool IsDriverAlarm => _diDriverAlarm.Value;
  86. public bool IsPosiModuleAlarm => _diPosiModuleAlarm.Value;
  87. public bool IsORGFailAlarm => _diORGFailAlarm.Value;
  88. public HighTemperatureHeaterPosition CurrentPosition
  89. {
  90. get
  91. {
  92. if (_diDriverAlarm.Value || _diPosiModuleAlarm.Value || _diORGFailAlarm.Value)
  93. {
  94. return HighTemperatureHeaterPosition.UnKnow;
  95. }
  96. if (_diGoOriginFeedback.Value == true && _diGoPosition1Feedback.Value == false && _diGoPosition2Feedback.Value == false && _diGoPosition3Feedback.Value == false && _diGoPosition4Feedback.Value == false && _diGoPosition5Feedback.Value == false)
  97. {
  98. return HighTemperatureHeaterPosition.Origin;
  99. }
  100. if (_diGoOriginFeedback.Value == false && _diGoPosition1Feedback.Value == true && _diGoPosition2Feedback.Value == false && _diGoPosition3Feedback.Value == false && _diGoPosition4Feedback.Value == false && _diGoPosition5Feedback.Value == false)
  101. {
  102. return HighTemperatureHeaterPosition.Position1;
  103. }
  104. else if (_diGoOriginFeedback.Value == false && _diGoPosition1Feedback.Value == false && _diGoPosition2Feedback.Value == true && _diGoPosition3Feedback.Value == false && _diGoPosition4Feedback.Value == false && _diGoPosition5Feedback.Value == false)
  105. {
  106. return HighTemperatureHeaterPosition.Position2;
  107. }
  108. else if (_diGoOriginFeedback.Value == false && _diGoPosition1Feedback.Value == false && _diGoPosition2Feedback.Value == false && _diGoPosition3Feedback.Value == true && _diGoPosition4Feedback.Value == false && _diGoPosition5Feedback.Value == false)
  109. {
  110. return HighTemperatureHeaterPosition.Position3;
  111. }
  112. else if (_diGoOriginFeedback.Value == false && _diGoPosition1Feedback.Value == false && _diGoPosition2Feedback.Value == false && _diGoPosition3Feedback.Value == false && _diGoPosition4Feedback.Value == true && _diGoPosition5Feedback.Value == false)
  113. {
  114. return HighTemperatureHeaterPosition.Position4;
  115. }
  116. else if (_diGoOriginFeedback.Value == false && _diGoPosition1Feedback.Value == false && _diGoPosition2Feedback.Value == false && _diGoPosition3Feedback.Value == false && _diGoPosition4Feedback.Value == false && _diGoPosition5Feedback.Value == true)
  117. {
  118. return HighTemperatureHeaterPosition.Position5;
  119. }
  120. else
  121. {
  122. return HighTemperatureHeaterPosition.UnKnow;
  123. }
  124. }
  125. }
  126. public bool HighTemperatureHeaterIsOn
  127. {
  128. get
  129. {
  130. if (_diPowerOnFeedback.Value == true && _doPowerOn.Value == true)
  131. {
  132. return true;
  133. }
  134. else
  135. {
  136. return false;
  137. }
  138. }
  139. set
  140. {
  141. SC.SetItemValue($"{Module}.HighTemperatureHeater.IsOn", value);
  142. }
  143. }
  144. public float HighTemperatureHighHeaterTemperature
  145. {
  146. get
  147. {
  148. if (_aiTemperatureFeedback == null) return -1;
  149. return _GetRealFloat(_aiTemperatureFeedback);
  150. }
  151. set
  152. {
  153. if (value <= _maxTemperatureSetPoint && value >= _minTemperatureSetPoint)
  154. {
  155. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $" Set Temperature to {value}");
  156. HighTemperatureHeaterTemperatureSetPoint = value;
  157. SC.SetItemValue($"{Module}.HighTemperatureHeater.Temperature", value);
  158. }
  159. else
  160. {
  161. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"高温Heater设定温度失败,由于设定温度{value}不在区间[{_minTemperatureSetPoint},{_maxTemperatureSetPoint}]");
  162. }
  163. }
  164. }
  165. public float HighTemperatureHeaterRatio
  166. {
  167. get
  168. {
  169. if (_aoRatio == null) return -1;
  170. return _GetRealFloat(_aoRatio);
  171. }
  172. set
  173. {
  174. if (value <= _maxRatioSetPoint && value >= _minRatioSetPoint)
  175. {
  176. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $" Set Ratio to {value}");
  177. HighTemperatureHeaterRatioSetPoint = value;
  178. SC.SetItemValue($"{Module}.HighTemperatureHeater.Ratio", value);
  179. }
  180. else
  181. {
  182. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"高温Heater设定Ratio失败,由于设定温度{value}不在区间[{_minRatioSetPoint},{_maxRatioSetPoint}]");
  183. }
  184. }
  185. }
  186. public IoHighTemperatureHeater(string module, XmlElement node, string ioModule = "")
  187. {
  188. base.Module = module;
  189. base.Name = node.GetAttribute("id");
  190. base.Display = node.GetAttribute("display");
  191. base.DeviceID = node.GetAttribute("schematicId");
  192. _diPowerOnFeedback = ParseDiNode("diPowerOnFeedback", node, ioModule);
  193. _doPowerOn = ParseDoNode("doPowerOn", node, ioModule);
  194. _aiTemperatureFeedback = ParseAiNode("aiTemperatureFeedback", node, ioModule);
  195. _aoTemperatureSetPoint = ParseAoNode("aoTemperatureSetPoint", node, ioModule);
  196. _diGoPosition1Feedback = ParseDiNode("diGoPosition1Feedback", node, ioModule);
  197. _doGoPosition1On = ParseDoNode("doGoPosition1On", node, ioModule);
  198. _diGoPosition2Feedback = ParseDiNode("diGoPosition2Feedback", node, ioModule);
  199. _doGoPosition2On = ParseDoNode("doGoPosition2On", node, ioModule);
  200. _diGoPosition3Feedback = ParseDiNode("diGoPosition3Feedback", node, ioModule);
  201. _doGoPosition3On = ParseDoNode("doGoPosition3On", node, ioModule);
  202. _diGoPosition4Feedback = ParseDiNode("diGoPosition4Feedback", node, ioModule);
  203. _doGoPosition4On = ParseDoNode("doGoPosition4On", node, ioModule);
  204. _diGoPosition5Feedback = ParseDiNode("diGoPosition5Feedback", node, ioModule);
  205. _doGoPosition5On = ParseDoNode("doGoPosition5On", node, ioModule);
  206. _diGoOriginFeedback = ParseDiNode("diGoOriginFeedback", node, ioModule);
  207. _doGoOriginOn = ParseDoNode("doGoOriginOn", node, ioModule);
  208. _aoLiftServoPosition1 = ParseAoNode("aoLiftServoPosition1", node, ioModule);
  209. _aoLiftServoPosition2 = ParseAoNode("aoLiftServoPosition2", node, ioModule);
  210. _aoLiftServoPosition3 = ParseAoNode("aoLiftServoPosition3", node, ioModule);
  211. _aoLiftServoPosition4 = ParseAoNode("aoLiftServoPosition4", node, ioModule);
  212. _aoLiftServoPosition5 = ParseAoNode("aoLiftServoPosition5", node, ioModule);
  213. _aoOriginSearchHighSpeed = ParseAoNode("aoOriginSearchHighSpeed", node, ioModule);
  214. _aoOriginSearchLowSpeed = ParseAoNode("aoOriginSearchLowSpeed", node, ioModule);
  215. _aoAbsMoveSpeed = ParseAoNode("aoAbsMoveSpeed", node, ioModule);
  216. _aoMaximusMoveSpeed = ParseAoNode("aoMaximusMoveSpeed", node, ioModule);
  217. _aoSoftDownLimit = ParseAoNode("aoSoftDownLimit", node, ioModule);
  218. _aoSoftUpLimit = ParseAoNode("aoSoftUpLimit", node, ioModule);
  219. _aoRatio = ParseAoNode("aoRatio", node, ioModule);
  220. _maxTemperatureSetPoint = Convert.ToSingle(SC.GetConfigItem($"{module}.HighTemperatureHeater.Temperature").Max);
  221. _minTemperatureSetPoint = Convert.ToSingle(SC.GetConfigItem($"{module}.HighTemperatureHeater.Temperature").Min);
  222. _maxRatioSetPoint = Convert.ToSingle(SC.GetConfigItem($"{module}.HighTemperatureHeater.Ratio").Max);
  223. _minRatioSetPoint = Convert.ToSingle(SC.GetConfigItem($"{module}.HighTemperatureHeater.Ratio").Min);
  224. _diDriverAlarm = ParseDiNode("diDriverAlarm", node, ioModule);
  225. _diPosiModuleAlarm = ParseDiNode("diPosiModuleAlarm", node, ioModule);
  226. _diORGFailAlarm = ParseDiNode("diORGFailAlarm", node, ioModule);
  227. _doResetLift = ParseDoNode("doResetLift", node, ioModule);
  228. }
  229. public bool GotoPosition(HighTemperatureHeaterPosition highTemperatureHeaterPosition)
  230. {
  231. if (!LiftHardwareIsOK())
  232. {
  233. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Alarm,can not go to {highTemperatureHeaterPosition}");
  234. return false;
  235. }
  236. if (highTemperatureHeaterPosition != HighTemperatureHeaterPosition.Origin && !LiftSoftwareIsOK())
  237. {
  238. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Alarm,can not go to {highTemperatureHeaterPosition}");
  239. return false;
  240. }
  241. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} start to {highTemperatureHeaterPosition.ToString()}");
  242. HighTemperatureHeaterPositipnSetPoint = highTemperatureHeaterPosition.ToString();
  243. switch (highTemperatureHeaterPosition)
  244. {
  245. case HighTemperatureHeaterPosition.Origin:
  246. _doGoOriginOn.Value = true;
  247. _originTimer.Start(_goPositionTime);
  248. break;
  249. case HighTemperatureHeaterPosition.Position1:
  250. _doGoPosition1On.Value = true;
  251. _position1Timer.Start(_goPositionTime);
  252. break;
  253. case HighTemperatureHeaterPosition.Position2:
  254. _doGoPosition2On.Value = true;
  255. _position2Timer.Start(_goPositionTime);
  256. break;
  257. case HighTemperatureHeaterPosition.Position3:
  258. _doGoPosition3On.Value = true;
  259. _position3Timer.Start(_goPositionTime);
  260. break;
  261. case HighTemperatureHeaterPosition.Position4:
  262. _doGoPosition4On.Value = true;
  263. _position4Timer.Start(_goPositionTime);
  264. break;
  265. case HighTemperatureHeaterPosition.Position5:
  266. _doGoPosition5On.Value = true;
  267. _position5Timer.Start(_goPositionTime);
  268. break;
  269. }
  270. return true;
  271. }
  272. public bool Initialize()
  273. {
  274. OP.Subscribe($"{Module}.{Name}.GotoPosition", (cmd, args) =>
  275. {
  276. var currentPosition = (HighTemperatureHeaterPosition)Enum.Parse(typeof(HighTemperatureHeaterPosition), args[0].ToString());
  277. GotoPosition(currentPosition);
  278. return true;
  279. });
  280. OP.Subscribe($"{Module}.{Name}.SwitchHighTemperatureHeater", (cmd, args) =>
  281. {
  282. HighTemperatureHeaterIsOn = Convert.ToBoolean(args[0].ToString());
  283. return true;
  284. });
  285. OP.Subscribe($"{Module}.{Name}.SetHighTemperatureHeaterTemperature", (cmd, args) =>
  286. {
  287. HighTemperatureHighHeaterTemperature = Convert.ToSingle(args[0]);
  288. return true;
  289. });
  290. OP.Subscribe($"{Module}.{Name}.SetHighTemperatureHeaterRatio", (cmd, args) =>
  291. {
  292. HighTemperatureHeaterRatio = Convert.ToSingle(args[0]);
  293. return true;
  294. });
  295. OP.Subscribe($"{Module}.{Name}.ResetHighTemperatureHeater", (cmd, args) =>
  296. {
  297. ResetSignal();
  298. return true;
  299. });
  300. DATA.Subscribe($"{Module}.{Name}.DeviceData", () => DeviceData, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  301. DATA.Subscribe($"{Module}.{Name}.Temperature", () => DeviceData.HighTemperatureHeaterTemperatureFeedBack);
  302. DATA.Subscribe($"{Module}.{Name}.Position", () => (int)CurrentPosition - 1);
  303. DATA.Subscribe($"{Module}.{Name}.IsOn", () => DeviceData.HighTemperatureHeaterIsonFeedBack);
  304. DATA.Subscribe($"{Module}.{Name}.TemperatureSetPoint", () => DeviceData.HighTemperatureHeaterTemperatureSetPoint);
  305. DATA.Subscribe($"{Module}.{Name}.Power_Output", () => GetAiValue($"{Module}.AI_CHB_M-HT_Reference_Power_Output"));
  306. DATA.Subscribe($"{Module}.{Name}.MaxPower", () => GetAiValue($"{Module}.AI_CHB_M-HT_Max_Power"));
  307. DATA.Subscribe($"{Module}.{Name}.MinPower", () => GetAiValue($"{Module}.AI_CHB_M-HT_Min_Power"));
  308. DATA.Subscribe($"{Module}.{Name}.Speed", () => GetAiValue($"{Module}.AI_CHB_M-HT_Current_Speed"));
  309. DATA.Subscribe($"{Module}.{Name}.Posi_Mm", () => GetAiValue($"{Module}.AI_Lift_Servo_Current_Posi_Mm"));
  310. DATA.Subscribe($"{Module}.{Name}.TM_Temp", () => GetAiValue($"{Module}.AI_CHB_M-HT_Control_TM_Temp"));
  311. DATA.Subscribe($"{Module}.{Name}.Ratio", () => HighTemperatureHeaterRatio);
  312. _SetRealFloat(_aoLiftServoPosition1, 20);
  313. _SetRealFloat(_aoLiftServoPosition2, -30);
  314. _SetRealFloat(_aoLiftServoPosition3, -40);
  315. _SetRealFloat(_aoLiftServoPosition4, 20);
  316. _SetRealFloat(_aoLiftServoPosition5, 50);
  317. _SetRealFloat(_aoOriginSearchHighSpeed, 10);
  318. _SetRealFloat(_aoOriginSearchLowSpeed, 5);
  319. _SetRealFloat(_aoAbsMoveSpeed, 10);
  320. _SetRealFloat(_aoMaximusMoveSpeed, 20);
  321. _SetRealFloat(_aoSoftDownLimit, 100);
  322. _SetRealFloat(_aoSoftUpLimit, 300);
  323. return true;
  324. }
  325. public void Stop()
  326. {
  327. }
  328. public void Terminate()
  329. {
  330. }
  331. public void Monitor()
  332. {
  333. if (_originTimer.IsTimeout())
  334. {
  335. _originTimer.Stop();
  336. if (_diGoOriginFeedback.Value == false)
  337. {
  338. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到原点");
  339. }
  340. }
  341. else if (_originTimer.IsIdle() == false)
  342. {
  343. if (_diGoOriginFeedback.Value == true)
  344. {
  345. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Origin");
  346. _doGoOriginOn.Value = false;
  347. _originTimer.Stop();
  348. }
  349. }
  350. if (_position1Timer.IsTimeout())
  351. {
  352. _position1Timer.Stop();
  353. if (_diGoPosition1Feedback.Value == false)
  354. {
  355. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到Position1");
  356. }
  357. }
  358. else if (_position1Timer.IsIdle() == false)
  359. {
  360. if (_diGoPosition1Feedback.Value == true)
  361. {
  362. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Position1");
  363. _doGoPosition1On.Value = false;
  364. _position1Timer.Stop();
  365. }
  366. }
  367. if (_position2Timer.IsTimeout())
  368. {
  369. _position2Timer.Stop();
  370. if (_diGoPosition2Feedback.Value == false)
  371. {
  372. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到Position2");
  373. }
  374. }
  375. else if (_position2Timer.IsIdle() == false)
  376. {
  377. if (_diGoPosition2Feedback.Value == true)
  378. {
  379. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Position2");
  380. _doGoPosition2On.Value = false;
  381. _position2Timer.Stop();
  382. }
  383. }
  384. if (_position3Timer.IsTimeout())
  385. {
  386. _position3Timer.Stop();
  387. if (_diGoPosition3Feedback.Value == false)
  388. {
  389. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到Position3");
  390. }
  391. }
  392. else if (_position3Timer.IsIdle() == false)
  393. {
  394. if (_diGoPosition3Feedback.Value == true)
  395. {
  396. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Position3");
  397. _doGoPosition3On.Value = false;
  398. _position3Timer.Stop();
  399. }
  400. }
  401. if (_position4Timer.IsTimeout())
  402. {
  403. _position4Timer.Stop();
  404. if (_diGoPosition4Feedback.Value == false)
  405. {
  406. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到Position4");
  407. }
  408. }
  409. else if (_position4Timer.IsIdle() == false)
  410. {
  411. if (_diGoPosition4Feedback.Value == true)
  412. {
  413. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Position4");
  414. _doGoPosition4On.Value = false;
  415. _position4Timer.Stop();
  416. }
  417. }
  418. if (_position5Timer.IsTimeout())
  419. {
  420. _position5Timer.Stop();
  421. if (_diGoPosition5Feedback.Value == false)
  422. {
  423. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到Position5");
  424. }
  425. }
  426. else if (_position5Timer.IsIdle() == false)
  427. {
  428. if (_diGoPosition5Feedback.Value == true)
  429. {
  430. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Position5");
  431. _doGoPosition5On.Value = false;
  432. _position5Timer.Stop();
  433. }
  434. }
  435. var position1Value = (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPosition1") + (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPositionOffset");
  436. var position2Value = (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPosition2") + (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPositionOffset");
  437. var position3Value = (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPosition3") + (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPositionOffset");
  438. var position4Value = (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPosition4") + (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPositionOffset");
  439. var position5Value = (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPosition5") + (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPositionOffset");
  440. _SetRealFloat(_aoLiftServoPosition1, position1Value);
  441. _SetRealFloat(_aoLiftServoPosition2, position2Value);
  442. _SetRealFloat(_aoLiftServoPosition3, position3Value);
  443. _SetRealFloat(_aoLiftServoPosition4, position4Value);
  444. _SetRealFloat(_aoLiftServoPosition5, position5Value);
  445. _SetRealFloat(_aoOriginSearchHighSpeed, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.OriginSearchHighSpeed"));
  446. _SetRealFloat(_aoOriginSearchLowSpeed, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.OriginSearchLowSpeed"));
  447. _SetRealFloat(_aoAbsMoveSpeed, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.AbsMoveSpeed"));
  448. _SetRealFloat(_aoMaximusMoveSpeed, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.MaximusMoveSpeed"));
  449. _SetRealFloat(_aoSoftDownLimit, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.SoftDownLimit"));
  450. _SetRealFloat(_aoSoftUpLimit, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.SoftUpLimit"));
  451. _SetRealFloat(_aoTemperatureSetPoint, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.Temperature"));
  452. _SetRealFloat(_aoRatio, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.Ratio"));
  453. _doPowerOn.Value = SC.GetValue<bool>($"{Module}.HighTemperatureHeater.IsOn");
  454. }
  455. public bool LiftIsOK()
  456. {
  457. if (IsDriverAlarm)
  458. {
  459. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Driver Alarm");
  460. return false;
  461. }
  462. if (IsPosiModuleAlarm)
  463. {
  464. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Position Module Alarm");
  465. return false;
  466. }
  467. if (IsORGFailAlarm)
  468. {
  469. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo ORG Fail Alarm");
  470. return false;
  471. }
  472. return true;
  473. }
  474. private bool LiftHardwareIsOK()
  475. {
  476. if (IsDriverAlarm)
  477. {
  478. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Driver Alarm");
  479. return false;
  480. }
  481. if (IsPosiModuleAlarm)
  482. {
  483. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Position Module Alarm");
  484. return false;
  485. }
  486. return true;
  487. }
  488. private bool LiftSoftwareIsOK()
  489. {
  490. if (IsORGFailAlarm)
  491. {
  492. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo ORG Fail Alarm");
  493. return false;
  494. }
  495. return true;
  496. }
  497. public async void ResetSignal()
  498. {
  499. if (_doResetLift.Value == true)
  500. {
  501. _doResetLift.Value = false;
  502. await Task.Delay(200);
  503. }
  504. _doResetLift.Value = true;
  505. await Task.Delay(1000);
  506. _doResetLift.Value = false;
  507. _clearAlarmCounter = 0;
  508. while (IsDriverAlarm || IsPosiModuleAlarm)
  509. {
  510. _clearAlarmCounter += 1;
  511. if (_clearAlarmCounter > 5)
  512. {
  513. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Clear Alarm Failed");
  514. return;
  515. }
  516. else
  517. {
  518. LOG.Write(eEvent.INFO_PM, Module, $"{Name} Clearing Alarm,Please wait");
  519. }
  520. await Task.Delay(1000);
  521. }
  522. GotoPosition(HighTemperatureHeaterPosition.Origin);
  523. }
  524. public void Reset()
  525. {
  526. }
  527. }
  528. }