Я правильно Вас понял, что по Вашей задумке в условиях схода с маршрута Ёж должен как-то догадаться о всех предстоящих поворотах, чтобы построить Вам хоть насколько-то правдивый профиль грядущих высот? Или Вам нужен профиль высот маршрута, с которого Вы сошли и относительно которого в общем случае довольно затруднительно даже точку, где Вы находитесь, вычислить?