Первое, что нужно узнать: какие GUI-библиотеки/фреймворки можно использовать (Qt, wxWidgets, GTKmm, MFC, etc). Если нет, то страдать и проклинать преподавателя.
Если да, то написать сначала просмотрщик картинок - создать окно с кнопками, на котором можно рисовать картинку, масштабировать и двигать (BitBlt
- наш лучший друг). Затем ассоциировать с картинкой-картой точки маршрута, поверх которого можно размещать граф возможных путей. И искать кротчайший путь алгоритмом Дейкстры.
Есть исходники такой штуки, но на Qt, могу поделиться.