Merged from RobustOptimizer
Compiled cost_zeta.m
Set TolX to 1e-4
Add a new KalmanGain (FeedbackGain.m)