add joint2dof
add join2dof