Browse Source

高温heater功能添加

lixiang 1 year ago
parent
commit
12bf5aaba7
1 changed files with 59 additions and 0 deletions
  1. 59 0
      Venus/Venus_RT/Devices/IODevices/IoHighTemperatureHeater.cs

+ 59 - 0
Venus/Venus_RT/Devices/IODevices/IoHighTemperatureHeater.cs

@@ -37,6 +37,26 @@ namespace Venus_RT.Devices.IODevices
         private readonly DIAccessor _diGoOriginFeedback;
         private readonly DOAccessor _doGoOriginOn;
 
+        private readonly AOAccessor _aoLiftServoPosition1;
+        private readonly AOAccessor _aoLiftServoPosition2;
+        private readonly AOAccessor _aoLiftServoPosition3;
+        private readonly AOAccessor _aoLiftServoPosition4;
+        private readonly AOAccessor _aoLiftServoPosition5;
+        private readonly AOAccessor _aoOriginSearchHighSpeed;
+
+        private readonly AOAccessor _aoOriginSearchLowSpeed;
+        private readonly AOAccessor _aoAbsMoveSpeed;
+        private readonly AOAccessor _aoMaximusMoveSpeed;
+
+        private readonly AOAccessor _aoSoftDownLimit;
+        private readonly AOAccessor _aoSoftUpLimit;
+
+
+
+
+
+
+
         private readonly DeviceTimer _originTimer = new DeviceTimer();
         private readonly DeviceTimer _position1Timer = new DeviceTimer();
         private readonly DeviceTimer _position2Timer = new DeviceTimer();
@@ -159,6 +179,26 @@ namespace Venus_RT.Devices.IODevices
             _diGoOriginFeedback = ParseDiNode("diGoOriginFeedback", node, ioModule);
             _doGoOriginOn = ParseDoNode("doGoOriginOn", node, ioModule);
 
+            _aoLiftServoPosition1 = ParseAoNode("aoLiftServoPosition1", node, ioModule);
+            _aoLiftServoPosition2 = ParseAoNode("aoLiftServoPosition2", node, ioModule);
+            _aoLiftServoPosition3 = ParseAoNode("aoLiftServoPosition3", node, ioModule);
+            _aoLiftServoPosition4 = ParseAoNode("aoLiftServoPosition4", node, ioModule);
+            _aoLiftServoPosition5 = ParseAoNode("aoLiftServoPosition5", node, ioModule);
+
+            _aoOriginSearchHighSpeed = ParseAoNode("aoOriginSearchHighSpeed", node, ioModule);
+            _aoOriginSearchLowSpeed = ParseAoNode("aoOriginSearchLowSpeed", node, ioModule);
+            _aoAbsMoveSpeed = ParseAoNode("aoAbsMoveSpeed", node, ioModule);
+            _aoMaximusMoveSpeed = ParseAoNode("aoMaximusMoveSpeed", node, ioModule);
+            _aoSoftDownLimit = ParseAoNode("aoSoftDownLimit", node, ioModule);
+            _aoSoftUpLimit = ParseAoNode("aoSoftUpLimit", node, ioModule);
+
+
+
+
+
+
+
+
         }
         public bool GotoPosition(HighTemperatureHeaterPosition highTemperatureHeaterPosition)
         {
@@ -218,6 +258,25 @@ namespace Venus_RT.Devices.IODevices
                 return true;
             });
             DATA.Subscribe($"{Module}.{Name}.DeviceData", () => DeviceData, SubscriptionAttribute.FLAG.IgnoreSaveDB);
+
+            _SetRealFloat(_aoLiftServoPosition1, 20);
+            _SetRealFloat(_aoLiftServoPosition2, -30);
+            _SetRealFloat(_aoLiftServoPosition3, -40);
+            _SetRealFloat(_aoLiftServoPosition4, 20);
+            _SetRealFloat(_aoLiftServoPosition5, 50);
+
+            _SetRealFloat(_aoOriginSearchHighSpeed, 10);
+            _SetRealFloat(_aoOriginSearchLowSpeed, 5);
+            _SetRealFloat(_aoAbsMoveSpeed, 10);
+            _SetRealFloat(_aoMaximusMoveSpeed, 20);
+            _SetRealFloat(_aoSoftDownLimit, 100);
+            _SetRealFloat(_aoSoftUpLimit, 300);
+
+
+
+
+
+
             return true;
         }
         public void Stop()