Nonlinear Model-Based New Stiffness Control