Problematyczna linijka nie jest problemem, tylko źle umieszczona, czegoś też brakuje . Zapomniałeś też przywrócić niektóre zmienne do pierwotnej wartości.
Trochę pogrzebałem i poprawiłem, działa z dowolną ilością powtórzeń ( w zagłębianie się ).
Ilość powtórzeń - #6 - też można by obliczać w zależności od innych parametrów, a nie na sztywno.

Zanim pokażę poprawione, sam pomyśl