Ето и примерна имплементация:
Тествайте решението си тук: https://judge.softuni.org/Contests/Practice/Index/514#14.