A trajectory generator utilizing the A-star algorithm in conjunction with a Nonlinear Model Predictive Control solver to obtain a smooth trajectory that satisfies vehicle constraints.