Control and Stability Analysis of Multi-Joint Manipulator under Constraints Based on Riemannian Geometry