Fixed bug in moveKinematcCHain that creates strange behaviour.