Merge remote-tracking branch 'origin/develop' into feature/pcg_performance
commit
ac9fcdcc1f
|
@ -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
|
||||
|
|
|
@ -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());
|
||||
}
|
||||
|
||||
|
|
|
@ -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());
|
||||
}
|
||||
|
||||
|
|
|
@ -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());
|
||||
}
|
||||
|
||||
|
|
|
@ -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());
|
||||
|
|
Loading…
Reference in New Issue