(Almost) finish optimal control state-of-the-art.