当たり判定のサンプルです。 処理が遅い場合は、壁に当たらなかった場合はそこで当たり判定を中断してください(変数使ってフラグ建てるなど)。
これで、基本はめり込まないと思いますが、はじめからめり込んでいる場合には対処できません。