Изменения

Перейти к: навигация, поиск

Visibility graph и motion planning

595 байт убрано, 17:40, 15 февраля 2015
м
Псевдокод
===== Псевдокод =====
graph buildVisibilityGraph(Set<Segment> segments)
//все вершины препятствий, а также начальная и конечная вершины vertices = getVertices(segments) <tex> \cup\ \{Ss, T\ t\} </tex> //изначально в графе только вершины
graph = visibilityGraph(vertices)
'''for''' Vertex <tex>v</tex> '''in''' vertices
//добавляем в граф все видимые из нее вершины
'''for''' Vertex <tex>w</tex> '''in''' getVisibleVertices(<tex>v</tex>, segments)
visibilityGraph.addEdge(<tex>v</tex>, <tex>w</tex>)
Set<Vertex> getVisibleVertices(Vertex <tex>v</tex>, Set<Segment> segments)
Set<Vertex> answer
// Инициализируем статус
'''for''' Segment <tex>s</tex> '''in''' segments
'''if''' intersection intersect(<tex>s</tex> and ray from , <tex>vl </tex> to up exists)
status.add(<tex>s</tex>)
// Инициализируем множество вершин, которые нужно рассматривать
'''for''' Point <tex>w</tex> '''in''' segments
'''if''' <tex>v</tex>.x <tex>\le</tex> <tex>w</tex>.x
currentVertices.add(<tex>w</tex>)
sort(currentVertices) by angle
// Для каждой вершины проверяем, видима ли она и обновляем статус
'''for''' Point <tex>w</tex> '''in''' currentVertices
'''if''' intersection '''not''' intersect(<tex>vw</tex> and , status.closest not exists)
answer.add(<tex>w</tex>)
'''for''' Segment <tex>s</tex> ending in <tex>w</tex>
222
правки

Навигация