Adding my node for inverse and forward kinematics