Chaudhuri, Rapti: Geometric Optimization for Map Based Path Planning