still tweaking gains for feedback. in a stable state now