Model Predictive Static Programming Guidance Method with Trajectory Way-points Constraints