Working on dynamics inversion outer loop.