Visibility-based Optimal Path and Motion Planning - Wang (Springer International Publishing, 2015)