Поправил ошибки в алгоритме.

Поправил ошибки в алгоритме.
А так же добавил пару классов (пока это все тесты).
Потом оформим как положено