Решил добавить в решение немного консервативной геометрии, надеюсь оцените ;)