Visibility-based optimal path and motion planning. ([2014])