Constrained Initial Guidance Algorithm