Nonlinear Decoupling Control for a Robot Manipulator