Finished implementing preliminary 2D flex carry controller. Works OK given decent initial conditions, inverse controller portion not implemented. Works OK with known features estimator from before, but there's a large initial transient that I don't care for.