|
@@ -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()
|