Add joint-to-marker-choreonoid test