今のままだと、61～68行目を無限にループしてしまいます。前に提示したプログラムはただのサンプルなので、そのまま自分のプログラムに組み込んでも正しく動きません。 まずは全体の構造を見直してみた方が良いでしょう。 前もって設定しておくべき内容(初期化)と、ループ(メイン処理)内で実行する内容に分けてください。