4.6.3 KJOINT2的位移和角度锁止