implementing iLQG as described in Todorov's paper. Integrating fin_diff from UWash iLQG package.