Fixed kinematic_interface to make it general