Enhance joint-to-marker-choreonoid test