Αποστολή με SMS: Visibility-based Optimal Path and Motion Planning