IoHighTemperatureHeater.cs 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610
  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. HighTemperatureHeaterTemperatureSetPoint = value;
  156. SC.SetItemValue($"{Module}.HighTemperatureHeater.Temperature", value);
  157. }
  158. else
  159. {
  160. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"高温Heater设定温度失败,由于设定温度{value}不在区间[{_minTemperatureSetPoint},{_maxTemperatureSetPoint}]");
  161. }
  162. }
  163. }
  164. public float HighTemperatureHeaterRatio
  165. {
  166. get
  167. {
  168. if (_aoRatio == null) return -1;
  169. return _GetRealFloat(_aoRatio);
  170. }
  171. set
  172. {
  173. if (value <= _maxRatioSetPoint && value >= _minRatioSetPoint)
  174. {
  175. HighTemperatureHeaterRatioSetPoint = value;
  176. SC.SetItemValue($"{Module}.HighTemperatureHeater.Ratio", value);
  177. }
  178. else
  179. {
  180. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"高温Heater设定Ratio失败,由于设定温度{value}不在区间[{_minRatioSetPoint},{_maxRatioSetPoint}]");
  181. }
  182. }
  183. }
  184. public IoHighTemperatureHeater(string module, XmlElement node, string ioModule = "")
  185. {
  186. base.Module = module;
  187. base.Name = node.GetAttribute("id");
  188. base.Display = node.GetAttribute("display");
  189. base.DeviceID = node.GetAttribute("schematicId");
  190. _diPowerOnFeedback = ParseDiNode("diPowerOnFeedback", node, ioModule);
  191. _doPowerOn = ParseDoNode("doPowerOn", node, ioModule);
  192. _aiTemperatureFeedback = ParseAiNode("aiTemperatureFeedback", node, ioModule);
  193. _aoTemperatureSetPoint = ParseAoNode("aoTemperatureSetPoint", node, ioModule);
  194. _diGoPosition1Feedback = ParseDiNode("diGoPosition1Feedback", node, ioModule);
  195. _doGoPosition1On = ParseDoNode("doGoPosition1On", node, ioModule);
  196. _diGoPosition2Feedback = ParseDiNode("diGoPosition2Feedback", node, ioModule);
  197. _doGoPosition2On = ParseDoNode("doGoPosition2On", node, ioModule);
  198. _diGoPosition3Feedback = ParseDiNode("diGoPosition3Feedback", node, ioModule);
  199. _doGoPosition3On = ParseDoNode("doGoPosition3On", node, ioModule);
  200. _diGoPosition4Feedback = ParseDiNode("diGoPosition4Feedback", node, ioModule);
  201. _doGoPosition4On = ParseDoNode("doGoPosition4On", node, ioModule);
  202. _diGoPosition5Feedback = ParseDiNode("diGoPosition5Feedback", node, ioModule);
  203. _doGoPosition5On = ParseDoNode("doGoPosition5On", node, ioModule);
  204. _diGoOriginFeedback = ParseDiNode("diGoOriginFeedback", node, ioModule);
  205. _doGoOriginOn = ParseDoNode("doGoOriginOn", node, ioModule);
  206. _aoLiftServoPosition1 = ParseAoNode("aoLiftServoPosition1", node, ioModule);
  207. _aoLiftServoPosition2 = ParseAoNode("aoLiftServoPosition2", node, ioModule);
  208. _aoLiftServoPosition3 = ParseAoNode("aoLiftServoPosition3", node, ioModule);
  209. _aoLiftServoPosition4 = ParseAoNode("aoLiftServoPosition4", node, ioModule);
  210. _aoLiftServoPosition5 = ParseAoNode("aoLiftServoPosition5", node, ioModule);
  211. _aoOriginSearchHighSpeed = ParseAoNode("aoOriginSearchHighSpeed", node, ioModule);
  212. _aoOriginSearchLowSpeed = ParseAoNode("aoOriginSearchLowSpeed", node, ioModule);
  213. _aoAbsMoveSpeed = ParseAoNode("aoAbsMoveSpeed", node, ioModule);
  214. _aoMaximusMoveSpeed = ParseAoNode("aoMaximusMoveSpeed", node, ioModule);
  215. _aoSoftDownLimit = ParseAoNode("aoSoftDownLimit", node, ioModule);
  216. _aoSoftUpLimit = ParseAoNode("aoSoftUpLimit", node, ioModule);
  217. _aoRatio = ParseAoNode("aoRatio", node, ioModule);
  218. _maxTemperatureSetPoint = Convert.ToSingle(SC.GetConfigItem($"{module}.HighTemperatureHeater.Temperature").Max);
  219. _minTemperatureSetPoint = Convert.ToSingle(SC.GetConfigItem($"{module}.HighTemperatureHeater.Temperature").Min);
  220. _maxRatioSetPoint = Convert.ToSingle(SC.GetConfigItem($"{module}.HighTemperatureHeater.Ratio").Max);
  221. _minRatioSetPoint = Convert.ToSingle(SC.GetConfigItem($"{module}.HighTemperatureHeater.Ratio").Min);
  222. _diDriverAlarm = ParseDiNode("diDriverAlarm", node, ioModule);
  223. _diPosiModuleAlarm = ParseDiNode("diPosiModuleAlarm", node, ioModule);
  224. _diORGFailAlarm = ParseDiNode("diORGFailAlarm", node, ioModule);
  225. _doResetLift = ParseDoNode("doResetLift", node, ioModule);
  226. }
  227. public bool GotoPosition(HighTemperatureHeaterPosition highTemperatureHeaterPosition)
  228. {
  229. if (!LiftHardwareIsOK())
  230. {
  231. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Alarm,can not go to {highTemperatureHeaterPosition}");
  232. return false;
  233. }
  234. if (highTemperatureHeaterPosition != HighTemperatureHeaterPosition.Origin && !LiftSoftwareIsOK())
  235. {
  236. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Alarm,can not go to {highTemperatureHeaterPosition}");
  237. return false;
  238. }
  239. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} start to {highTemperatureHeaterPosition.ToString()}");
  240. HighTemperatureHeaterPositipnSetPoint = highTemperatureHeaterPosition.ToString();
  241. switch (highTemperatureHeaterPosition)
  242. {
  243. case HighTemperatureHeaterPosition.Origin:
  244. _doGoOriginOn.Value = true;
  245. _originTimer.Start(_goPositionTime);
  246. break;
  247. case HighTemperatureHeaterPosition.Position1:
  248. _doGoPosition1On.Value = true;
  249. _position1Timer.Start(_goPositionTime);
  250. break;
  251. case HighTemperatureHeaterPosition.Position2:
  252. _doGoPosition2On.Value = true;
  253. _position2Timer.Start(_goPositionTime);
  254. break;
  255. case HighTemperatureHeaterPosition.Position3:
  256. _doGoPosition3On.Value = true;
  257. _position3Timer.Start(_goPositionTime);
  258. break;
  259. case HighTemperatureHeaterPosition.Position4:
  260. _doGoPosition4On.Value = true;
  261. _position4Timer.Start(_goPositionTime);
  262. break;
  263. case HighTemperatureHeaterPosition.Position5:
  264. _doGoPosition5On.Value = true;
  265. _position5Timer.Start(_goPositionTime);
  266. break;
  267. }
  268. return true;
  269. }
  270. public bool Initialize()
  271. {
  272. OP.Subscribe($"{Module}.{Name}.GotoPosition", (cmd, args) =>
  273. {
  274. var currentPosition = (HighTemperatureHeaterPosition)Enum.Parse(typeof(HighTemperatureHeaterPosition), args[0].ToString());
  275. GotoPosition(currentPosition);
  276. return true;
  277. });
  278. OP.Subscribe($"{Module}.{Name}.SwitchHighTemperatureHeater", (cmd, args) =>
  279. {
  280. HighTemperatureHeaterIsOn = Convert.ToBoolean(args[0].ToString());
  281. return true;
  282. });
  283. OP.Subscribe($"{Module}.{Name}.SetHighTemperatureHeaterTemperature", (cmd, args) =>
  284. {
  285. HighTemperatureHighHeaterTemperature = Convert.ToSingle(args[0]);
  286. return true;
  287. });
  288. OP.Subscribe($"{Module}.{Name}.SetHighTemperatureHeaterRatio", (cmd, args) =>
  289. {
  290. HighTemperatureHeaterRatio = Convert.ToSingle(args[0]);
  291. return true;
  292. });
  293. OP.Subscribe($"{Module}.{Name}.ResetHighTemperatureHeater", (cmd, args) =>
  294. {
  295. ResetSignal();
  296. return true;
  297. });
  298. DATA.Subscribe($"{Module}.{Name}.DeviceData", () => DeviceData, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  299. DATA.Subscribe($"{Module}.{Name}.Temperature", () => DeviceData.HighTemperatureHeaterTemperatureFeedBack);
  300. DATA.Subscribe($"{Module}.{Name}.Position", () => (int)CurrentPosition - 1);
  301. DATA.Subscribe($"{Module}.{Name}.IsOn", () => DeviceData.HighTemperatureHeaterIsonFeedBack);
  302. DATA.Subscribe($"{Module}.{Name}.TemperatureSetPoint", () => DeviceData.HighTemperatureHeaterTemperatureSetPoint);
  303. DATA.Subscribe($"{Module}.{Name}.AI_CHB_M-HT_Reference_Power_Output", () => GetAiValue($"{Module}.AI_CHB_M-HT_Reference_Power_Output"));
  304. DATA.Subscribe($"{Module}.{Name}.AI_CHB_M-HT_Max_Power", () => GetAiValue($"{Module}.AI_CHB_M-HT_Max_Power"));
  305. DATA.Subscribe($"{Module}.{Name}.AI_CHB_M-HT_Min_Power", () => GetAiValue($"{Module}.AI_CHB_M-HT_Min_Power"));
  306. DATA.Subscribe($"{Module}.{Name}.AI_CHB_M-HT_Current_Speed", () => GetAiValue($"{Module}.AI_CHB_M-HT_Current_Speed"));
  307. DATA.Subscribe($"{Module}.{Name}.AI_Lift_Servo_Current_Posi_Mm", () => GetAiValue($"{Module}.AI_Lift_Servo_Current_Posi_Mm"));
  308. _SetRealFloat(_aoLiftServoPosition1, 20);
  309. _SetRealFloat(_aoLiftServoPosition2, -30);
  310. _SetRealFloat(_aoLiftServoPosition3, -40);
  311. _SetRealFloat(_aoLiftServoPosition4, 20);
  312. _SetRealFloat(_aoLiftServoPosition5, 50);
  313. _SetRealFloat(_aoOriginSearchHighSpeed, 10);
  314. _SetRealFloat(_aoOriginSearchLowSpeed, 5);
  315. _SetRealFloat(_aoAbsMoveSpeed, 10);
  316. _SetRealFloat(_aoMaximusMoveSpeed, 20);
  317. _SetRealFloat(_aoSoftDownLimit, 100);
  318. _SetRealFloat(_aoSoftUpLimit, 300);
  319. return true;
  320. }
  321. public void Stop()
  322. {
  323. }
  324. public void Terminate()
  325. {
  326. }
  327. public void Monitor()
  328. {
  329. if (_originTimer.IsTimeout())
  330. {
  331. _originTimer.Stop();
  332. if (_diGoOriginFeedback.Value == false)
  333. {
  334. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到原点");
  335. }
  336. }
  337. else if (_originTimer.IsIdle() == false)
  338. {
  339. if (_diGoOriginFeedback.Value == true)
  340. {
  341. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Origin");
  342. _doGoOriginOn.Value = false;
  343. _originTimer.Stop();
  344. }
  345. }
  346. if (_position1Timer.IsTimeout())
  347. {
  348. _position1Timer.Stop();
  349. if (_diGoPosition1Feedback.Value == false)
  350. {
  351. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到Position1");
  352. }
  353. }
  354. else if (_position1Timer.IsIdle() == false)
  355. {
  356. if (_diGoPosition1Feedback.Value == true)
  357. {
  358. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Position1");
  359. _doGoPosition1On.Value = false;
  360. _position1Timer.Stop();
  361. }
  362. }
  363. if (_position2Timer.IsTimeout())
  364. {
  365. _position2Timer.Stop();
  366. if (_diGoPosition2Feedback.Value == false)
  367. {
  368. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到Position2");
  369. }
  370. }
  371. else if (_position2Timer.IsIdle() == false)
  372. {
  373. if (_diGoPosition2Feedback.Value == true)
  374. {
  375. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Position2");
  376. _doGoPosition2On.Value = false;
  377. _position2Timer.Stop();
  378. }
  379. }
  380. if (_position3Timer.IsTimeout())
  381. {
  382. _position3Timer.Stop();
  383. if (_diGoPosition3Feedback.Value == false)
  384. {
  385. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到Position3");
  386. }
  387. }
  388. else if (_position3Timer.IsIdle() == false)
  389. {
  390. if (_diGoPosition3Feedback.Value == true)
  391. {
  392. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Position3");
  393. _doGoPosition3On.Value = false;
  394. _position3Timer.Stop();
  395. }
  396. }
  397. if (_position4Timer.IsTimeout())
  398. {
  399. _position4Timer.Stop();
  400. if (_diGoPosition4Feedback.Value == false)
  401. {
  402. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到Position4");
  403. }
  404. }
  405. else if (_position4Timer.IsIdle() == false)
  406. {
  407. if (_diGoPosition4Feedback.Value == true)
  408. {
  409. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Position4");
  410. _doGoPosition4On.Value = false;
  411. _position4Timer.Stop();
  412. }
  413. }
  414. if (_position5Timer.IsTimeout())
  415. {
  416. _position5Timer.Stop();
  417. if (_diGoPosition5Feedback.Value == false)
  418. {
  419. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} {_goPositionTime / 1000} s 内未到Position5");
  420. }
  421. }
  422. else if (_position5Timer.IsIdle() == false)
  423. {
  424. if (_diGoPosition5Feedback.Value == true)
  425. {
  426. LOG.Write(eEvent.INFO_HighTemperatureHeater, Module, $"{Name} to Position5");
  427. _doGoPosition5On.Value = false;
  428. _position5Timer.Stop();
  429. }
  430. }
  431. _SetRealFloat(_aoLiftServoPosition1, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPosition1"));
  432. _SetRealFloat(_aoLiftServoPosition2, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPosition2"));
  433. _SetRealFloat(_aoLiftServoPosition3, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPosition3"));
  434. _SetRealFloat(_aoLiftServoPosition4, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPosition4"));
  435. _SetRealFloat(_aoLiftServoPosition5, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.LiftServoPosition5"));
  436. _SetRealFloat(_aoOriginSearchHighSpeed, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.OriginSearchHighSpeed"));
  437. _SetRealFloat(_aoOriginSearchLowSpeed, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.OriginSearchLowSpeed"));
  438. _SetRealFloat(_aoAbsMoveSpeed, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.AbsMoveSpeed"));
  439. _SetRealFloat(_aoMaximusMoveSpeed, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.MaximusMoveSpeed"));
  440. _SetRealFloat(_aoSoftDownLimit, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.SoftDownLimit"));
  441. _SetRealFloat(_aoSoftUpLimit, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.SoftUpLimit"));
  442. _SetRealFloat(_aoTemperatureSetPoint, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.Temperature"));
  443. _SetRealFloat(_aoRatio, (float)SC.GetValue<double>($"{Module}.HighTemperatureHeater.Ratio"));
  444. _doPowerOn.Value = SC.GetValue<bool>($"{Module}.HighTemperatureHeater.IsOn");
  445. }
  446. public bool LiftIsOK()
  447. {
  448. if (IsDriverAlarm)
  449. {
  450. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Driver Alarm");
  451. return false;
  452. }
  453. if (IsPosiModuleAlarm)
  454. {
  455. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Position Module Alarm");
  456. return false;
  457. }
  458. if (IsORGFailAlarm)
  459. {
  460. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo ORG Fail Alarm");
  461. return false;
  462. }
  463. return true;
  464. }
  465. private bool LiftHardwareIsOK()
  466. {
  467. if (IsDriverAlarm)
  468. {
  469. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Driver Alarm");
  470. return false;
  471. }
  472. if (IsPosiModuleAlarm)
  473. {
  474. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo Position Module Alarm");
  475. return false;
  476. }
  477. return true;
  478. }
  479. private bool LiftSoftwareIsOK()
  480. {
  481. if (IsORGFailAlarm)
  482. {
  483. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Lift Servo ORG Fail Alarm");
  484. return false;
  485. }
  486. return true;
  487. }
  488. public async void ResetSignal()
  489. {
  490. if (_doResetLift.Value == true)
  491. {
  492. _doResetLift.Value = false;
  493. await Task.Delay(200);
  494. }
  495. _doResetLift.Value = true;
  496. await Task.Delay(1000);
  497. _doResetLift.Value = false;
  498. _clearAlarmCounter = 0;
  499. while (IsDriverAlarm || IsPosiModuleAlarm)
  500. {
  501. _clearAlarmCounter += 1;
  502. if (_clearAlarmCounter > 5)
  503. {
  504. LOG.Write(eEvent.ERR_HighTemperatureHeater, Module, $"{Name} Clear Alarm Failed");
  505. return;
  506. }
  507. else
  508. {
  509. LOG.Write(eEvent.INFO_PM, Module, $"{Name} Clearing Alarm,Please wait");
  510. }
  511. await Task.Delay(1000);
  512. }
  513. GotoPosition(HighTemperatureHeaterPosition.Origin);
  514. }
  515. public void Reset()
  516. {
  517. }
  518. }
  519. }