Study on redundancy resolution algorithm of humanoid