Go to the documentation of this file.
26 std::cout <<
"Nr iterations: " <<
iterations <<
'\n'
30 <<
"error: " <<
error << std::endl;
36 std::cout <<
" smoother lag: " <<
smootherLag_ << std::endl;
50 KeyTimestampMap::iterator keyIter =
keyTimestampMap_.find(key_timestamp.first);
55 std::pair<TimestampKeyMap::iterator,TimestampKeyMap::iterator>
range =
timestampKeyMap_.equal_range(keyIter->second);
56 TimestampKeyMap::iterator timeIter =
range.first;
57 while(timeIter->second != key_timestamp.first) {
63 timestampKeyMap_.insert(TimestampKeyMap::value_type(key_timestamp.second, key_timestamp.first));
65 keyIter->second = key_timestamp.second;
70 timestampKeyMap_.insert(TimestampKeyMap::value_type(key_timestamp.second, key_timestamp.first));
116 TimestampKeyMap::const_iterator begin =
timestampKeyMap_.upper_bound(timestamp);
const KeyTimestampMap & timestamps() const
void eraseKeyTimestampMap(const KeyVector &keys)
FastVector< Key > KeyVector
Define collection type once and for all - also used in wrappers.
size_t linearVariables
The number of variables that must keep a constant linearization point.
Double_ range(const Point2_ &p, const Point2_ &q)
TimestampKeyMap timestampKeyMap_
KeyVector findKeysAfter(double timestamp) const
std::function< std::string(Key)> KeyFormatter
Typedef for a function to format a key, i.e. to convert it to a string.
double getCurrentTimestamp() const
size_t iterations
The number of optimizer iterations performed.
size_t intermediateSteps
The number of intermediate steps performed within the optimization. For L-M, this is the number of la...
double error
The final factor graph error.
const gtsam::Symbol key('X', 0)
Base class for a fixed-lag smoother. This mimics the basic interface to iSAM2.
virtual bool equals(const FixedLagSmoother &rhs, double tol=1e-9) const
std::map< Key, double > KeyTimestampMap
Typedef for a Key-Timestamp map/database.
iterator iter(handle obj)
size_t nonlinearVariables
The number of variables that can be relinearized.
KeyTimestampMap keyTimestampMap_
static const EIGEN_DEPRECATED end_t end
KeyVector findKeysBefore(double timestamp) const
virtual void print(const std::string &s="FixedLagSmoother:\n", const KeyFormatter &keyFormatter=DefaultKeyFormatter) const
std::uint64_t Key
Integer nonlinear key type.
bool equal(const T &obj1, const T &obj2, double tol)
void updateKeyTimestampMap(const KeyTimestampMap &newTimestamps)
gtsam
Author(s):
autogenerated on Fri Nov 1 2024 03:32:32