Added optimized solution to state estimator for pset 13.