18 lines
404 B
Plaintext
18 lines
404 B
Plaintext
&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 |
