Optimal constrained multi-criteria trajectory planning for ship maneuvering and control