Added the start of a state estimation and more robust policy generation framework.