いろいろと応用してるっぽいんで、やっぱり全体のソースが見れないと判断が難しいですねー…。
あとオマケですが、
IF SY>0.2 THEN V=SY
IF SY<-0.2 THEN V=-SY
IF SX<-0.2 THEN U=-SX
IF SX>0.2 THEN U=SX
の部分は、
IF ABS(SY) > 0.2 THEN V=-SV
IF ABS(SX) > 0.2 THEN U=SX
の2行で書けると思います。
てか上記のIFも間違ってそうな気も…。UもVも必ずプラスにしかならないコードになってますよ。