Ah a non-linear closed loop control system,very nice.
You will quickly find that non-linear closed loop control systems are all but completely intractable in the classical control systems sense,if you try to follow the normal design techniques they simply dont work.
Dunno how to solve that one,perhaps you should have used a linear system.