すごくきれいで見やすいソースコードですね! 今のだと座標がピッタリ同じで無いとだめなので、ABS(TX-SX)<16 && ABS(TY-SY)<16 みたいにするか、もしくはSPHITRCを使うといいですよ。