Applied Nonlinear Control J.E.Slotine