Реализация планирования локального пути: устранение раскачивания траектории