update

Linearized controls, implemented integrator to get rid of ss error, got
rid of delta as a state