コード例 #1
0
// This version requires YOU to add your beacons! You!
void VideoBasedTracker::addSensor(
    LedIdentifierPtr &&identifier, CameraParameters const &camParams,
    std::function<void(BeaconBasedPoseEstimator &)> const &beaconAdder,
    size_t requiredInliers, size_t permittedOutliers) {
    m_camParams = camParams;
    m_identifiers.emplace_back(std::move(identifier));
    m_estimators.emplace_back(new BeaconBasedPoseEstimator(
                                  camParams.createUndistortedVariant(), requiredInliers,
                                  permittedOutliers, m_params));
    m_led_groups.emplace_back();
    beaconAdder(*m_estimators.back());
    m_assertInvariants();
}