Merge remote-tracking branch 'origin/develop' into feature/pcg_performance

release/4.3a0
Frank Dellaert 2019-04-11 18:18:07 -04:00
commit ac9fcdcc1f
5 changed files with 4 additions and 5 deletions

View File

@ -25,7 +25,7 @@ namespace gtsam {
/* ************************************************************************* */
template<class FG>
void VariableIndex::augment(const FG& factors,
boost::optional<const FastVector<size_t>&> newFactorIndices) {
boost::optional<const FactorIndices&> newFactorIndices) {
gttic(VariableIndex_augment);
// Augment index for each factor

View File

@ -309,7 +309,7 @@ void BatchFixedLagSmoother::marginalize(const KeyVector& marginalizeKeys) {
set<size_t> removedFactorSlots;
const VariableIndex variableIndex(factors_);
for(Key key: marginalizeKeys) {
const FastVector<size_t>& slots = variableIndex[key];
const auto& slots = variableIndex[key];
removedFactorSlots.insert(slots.begin(), slots.end());
}

View File

@ -536,7 +536,7 @@ void ConcurrentBatchFilter::moveSeparator(const FastList<Key>& keysToMove) {
std::vector<size_t> removedFactorSlots;
VariableIndex variableIndex(factors_);
for(Key key: keysToMove) {
const FastVector<size_t>& slots = variableIndex[key];
const auto& slots = variableIndex[key];
removedFactorSlots.insert(removedFactorSlots.end(), slots.begin(), slots.end());
}

View File

@ -291,7 +291,7 @@ FactorIndices ConcurrentIncrementalFilter::FindAdjacentFactors(const ISAM2& isam
FactorIndices removedFactorSlots;
const VariableIndex& variableIndex = isam2.getVariableIndex();
for(Key key: keys) {
const FastVector<size_t>& slots = variableIndex[key];
const auto& slots = variableIndex[key];
removedFactorSlots.insert(removedFactorSlots.end(), slots.begin(), slots.end());
}

View File

@ -354,7 +354,6 @@ namespace gtsam { namespace partition {
const std::vector<int>& dictionary, GenericGraph3D& reducedGraph) {
typedef size_t CameraKey;
typedef pair<CameraKey, CameraKey> CameraPair;
typedef size_t LandmarkKey;
// get a mapping from each landmark to its connected cameras
vector<vector<LandmarkKey> > cameraToLandmarks(dictionary.size());