&ACCESS RV
DEFFCT E6POS FixA6Jump(TargetPos:IN)
    DECL E6POS TargetPos,NewPos
    DECL REAL dA6
    NewPos=TargetPos
    dA6 = TargetPos.A - $AXIS_ACT.A6

    WHILE dA6 > 180.0
        NewPos.A = NewPos.A - 360.0
        dA6 = TargetPos.A - $AXIS_ACT.A6
    ENDWHILE

    WHILE dA6 < -180.0
        NewPos.A = NewPos.A + 360.0
        dA6 = NewPos.A - $AXIS_ACT.A6
    ENDWHILE
    RETURN NewPos
ENDFCT