Improve marker to joint optimization efficiency