空间一般6R机械手的位置反解的新算法,做机械手控制的可以借鉴一下