Zaimplementowany algorymt upraszczania trasy.
Jeden z ostatnich mam nadzieję.