Optimization Scheme for Redundant Manipulator with Continual Updating Pseudo-Inverse Jacobian