Added kinematic chain optimizer