most of ilqg in place. adding deltaMatrix now
deltaMatrix doesn't make it work