- Corrected Vertex calculation of obstacle