- joint number dof is 3, not 6, - remove wrong and useless linear interpolation in interpolate method.