Fixed AxisPTP homing position error
This commit is contained in:
Binary file not shown.
@@ -62,7 +62,7 @@ VAR
|
|||||||
|
|
||||||
_lrTargetPosition : LREAL;
|
_lrTargetPosition : LREAL;
|
||||||
_lrRelativeDistance : LREAL;
|
_lrRelativeDistance : LREAL;
|
||||||
_lrHomingPos : LREAL;
|
_lrHomingPos : LREAL := Tc2_MC2.DEFAULT_HOME_POSITION;
|
||||||
_eHomingMode : MC_HomingMode := MC_HomingMode.MC_DefaultHoming;
|
_eHomingMode : MC_HomingMode := MC_HomingMode.MC_DefaultHoming;
|
||||||
_xCalibrationCam : BOOL;
|
_xCalibrationCam : BOOL;
|
||||||
|
|
||||||
@@ -424,6 +424,8 @@ END_IF
|
|||||||
|
|
||||||
CASE _eState OF
|
CASE _eState OF
|
||||||
E_AXIS_PTP_STATE.IDLE:
|
E_AXIS_PTP_STATE.IDLE:
|
||||||
|
_lrHomingPos := lrHomingPosition;
|
||||||
|
_eHomingMode := eHomingMode;
|
||||||
_eState := E_AXIS_PTP_STATE.START_HOMING;
|
_eState := E_AXIS_PTP_STATE.START_HOMING;
|
||||||
|
|
||||||
xBusy := TRUE;
|
xBusy := TRUE;
|
||||||
|
|||||||
Reference in New Issue
Block a user