Positionieren gefixt
This commit is contained in:
@@ -175,6 +175,7 @@ ACTION DoMachToRob:
|
||||
lCmdInterface.Robot.ToRobot.bSlayInSprayPos := States.CylinderPos.bSlayFw;
|
||||
lCmdInterface.Robot.ToRobot.bInPos0 := States.CylinderPos.bPos0;
|
||||
lCmdInterface.Robot.ToRobot.bInPos180 := States.CylinderPos.bPos180;
|
||||
lCmdInterface.Robot.ToRobot.uiRotationPos := LREAL_TO_UINT (MpFUB.AxBasic_X.Position);
|
||||
END_ACTION
|
||||
|
||||
ACTION DoAlarms:
|
||||
|
||||
@@ -155,7 +155,7 @@ PROGRAM _CYCLIC
|
||||
MpData.AxPar_X.Direction := mpAXIS_DIR_POSITIVE;
|
||||
MpData.AxPar_X.Acceleration := Parameter.rAccellDecell;
|
||||
MpData.AxPar_X.Deceleration := Parameter.rAccellDecell;
|
||||
MpData.AxPar_X.Velocity := 10.0 + USINT_TO_REAL (lCmdInterface.Robot.FromRobot.usRotationSpeed) * 2.0; // <EFBFBD>/s
|
||||
MpData.AxPar_X.Velocity := 10.0 + USINT_TO_REAL (lCmdInterface.Robot.FromRobot.usRotationSpeed) * 1.0; // <EFBFBD>/s
|
||||
MpData.AxPar_X.Position := UINT_TO_LREAL (lCmdInterface.Robot.FromRobot.uiRotationPos);
|
||||
MpFUB.AxBasic_X.MoveAbsolute := TRUE;
|
||||
IF MpFUB.AxBasic_X.CommandBusy THEN
|
||||
|
||||
Reference in New Issue
Block a user