符号を取るSGNという関数を使えば楽ですよ。 ３６～４５行目は、 INC X,SGN(SX) DEC Y,SGN(SY) だけでいけると思います。