272
Manual – IPOSplus®
18
Compiler programming frame
Compiler – Examples
/*=============================================
= Function: fnPositioning()
= Positioning
===============================================*/
fnPositioning()
{
// Instructions for entering the main state "Positioning"
// Define substate
lSubStatePositioning = POSITIONING_STOPPED;
// Acknowledge mode
_BitSet(lPE_StatusWord,11);
_BitSet(lPE_StatusWord,12);
// cyclical processing as long as the main state is set to "Positioning"
do
{
// Import PO data
_GetSys( tPA.BusType ,GS_PODATA );
switch (lSubStatePositioning)
{
case POSITIONING_STOPPED:
if (MY_START_POSITIONING)
{
tPosVelocities.CW = tPosVelocities.CCW = tPA.PO2;
_SetSys( SS_POSSPEED, tPosVelocities );
TargetPos = (lScalingNumerator * tPA.PO3)
/ lScalingDenominator;
lSubStatePositioning = POSITIONING_STARTED;
}
break;
case POSITIONING_STARTED:
if (MY_START_POSITIONING)
{
tPosVelocities.CW = tPosVelocities.CCW = tPA.PO2;
_SetSys( SS_POSSPEED, tPosVelocities );
TargetPos = (lScalingNumerator * tPA.PO3)
/ lScalingDenominator;
}
else
{
_AxisStop(AS_PSTOP);
lSubStatePositioning = POSITIONING_STOPPED;
}
break;
}
}while
(lGlobalStateMachine==POSITIONING);
// Instructions for leaving the main state "Positioning"
// Stopping the drive
if
(lSubStatePositioning==POSITIONING_STARTED)
_AxisStop(AS_PSTOP);
// Clear mode
_BitClear(lPE_StatusWord,11);
_BitClear(lPE_StatusWord,12);
}// End fnPositioning()
P
i
f
kVA
Hz
n
P
i
f
kVA
Hz
n