Implementation of kinematic chains with geometry