File dense_linearizer.h¶
-
namespace sym
-
template<typename Scalar>
class DenseLinearizer Public Types
-
using LinearizationType = DenseLinearization<Scalar>
Public Functions
-
DenseLinearizer(const std::string &name, const std::vector<Factor<Scalar>> &factors, const std::vector<Key> &key_order = {}, bool include_jacobians = false, bool debug_checks = false)
Construct a Linearizer from factors and optional keys
- Parameters:
name – name of linearizer used for debug information
factors – Only stores a pointer, MUST be in scope for the lifetime of this object!
key_order – If provided, acts as an ordered set of keys that form the state vector to optimize. Can equal the set of all factor keys or a subset of all factor keys. If not provided, it is computed from all keys for all factors using a default ordering.
include_jacobians – Relinearize only allocates and fills out the jacobian if true.
debug_checks – Whether to perform additional sanity checks for NaNs. This uses additional compute but not additional memory except for logging.
-
bool IsInitialized() const
Returns whether Relinearize() has already been called once.
Matters because many calculations need to be called only on the first linearization that are then cached for subsequent use. Also, if Relinearize() has already been called, then the matrices in the linearization are expected to already be allocated to the right size.
-
const std::vector<Key> &Keys() const
The keys to optimize, in the order they appear in the state vector (i.e., in rhs).
-
const std::unordered_map<key_t, index_entry_t> &StateIndex() const
A map from all optimized keys in the problem to an index entry for the corresponding optimized values (where the offset is into the problem state vector, i.e., the rhs of a linearization).
Only read if IsInitialized() returns true (i.e., after the first call to Relinearize).
-
void Relinearize(const Values<Scalar> &values, DenseLinearization<Scalar> &linearization)
Update linearization at a new evaluation point. This is more efficient than reconstructing this object repeatedly. On the first call, it will allocate memory and perform analysis needed for efficient repeated relinearization.
On the first call to Relinearize, the matrices in linearization will be allocated and sized correctly. On subsequent calls, the matrices of linearization are expected to already be allocated and sized correctly.
TODO(aaron): This should be const except that it can initialize the object
Private Functions
-
void InitialLinearization(const Values<Scalar> &values, DenseLinearization<Scalar> &linearization)¶
Evaluates the linearizations of the factors at values into linearization, caching all values needed for relinearization along the way.
Specifically:
Calculates state_index_
Allocates all factor linearizations in linearized_dense_factors_
Calculates factor_indices_
Calculates factor_keyoffsets_
Sets is_initialized_ to true.
NOTE(brad): Things might break if you call it twice.
-
using LinearizationType = DenseLinearization<Scalar>
-
template<typename Scalar>