計算方法は合っていると思います。 それに加えてZ軸も計算します。 そのままスプライトの座標に設定します。 それから、場所を 46行目くらいSPHOMEがあったあたりからに 変えてみてください。 また、SPUNLINK前後の SPHOMEとSPOFSもなくて大丈夫です。