Trajectory Optimization Based on Interval Analysis