blob: 61e76f83f1282e322e2efc02367668be3fc508fa [file] [log] [blame]
Keir Mierle8ebb0732012-04-30 23:09:08 -07001// Ceres Solver - A fast non-linear least squares minimizer
Keir Mierle7492b0d2015-03-17 22:30:16 -07002// Copyright 2015 Google Inc. All rights reserved.
3// http://ceres-solver.org/
Keir Mierle8ebb0732012-04-30 23:09:08 -07004//
5// Redistribution and use in source and binary forms, with or without
6// modification, are permitted provided that the following conditions are met:
7//
8// * Redistributions of source code must retain the above copyright notice,
9// this list of conditions and the following disclaimer.
10// * Redistributions in binary form must reproduce the above copyright notice,
11// this list of conditions and the following disclaimer in the documentation
12// and/or other materials provided with the distribution.
13// * Neither the name of Google Inc. nor the names of its contributors may be
14// used to endorse or promote products derived from this software without
15// specific prior written permission.
16//
17// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
18// AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19// IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20// ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
21// LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
22// CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23// SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
24// INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
25// CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
26// ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
27// POSSIBILITY OF SUCH DAMAGE.
28//
29// Author: sameeragarwal@google.com (Sameer Agarwal)
30// keir@google.com (Keir Mierle)
31
32#ifndef CERES_INTERNAL_EVALUATOR_H_
33#define CERES_INTERNAL_EVALUATOR_H_
34
Sameer Agarwal509f68c2013-02-20 01:39:03 -080035#include <map>
Sameer Agarwal446487c2022-02-12 08:11:33 -080036#include <memory>
Keir Mierle8ebb0732012-04-30 23:09:08 -070037#include <string>
Sameer Agarwal4997cbc2012-07-02 12:44:34 -070038#include <vector>
Sameer Agarwalbdd87c02013-01-29 16:24:31 -080039
Mike Vitusf408f892018-02-22 10:28:39 -080040#include "ceres/context_impl.h"
Sameer Agarwalbdd87c02013-01-29 16:24:31 -080041#include "ceres/execution_summary.h"
Sergiu Deitschf90833f2022-02-07 23:43:19 +010042#include "ceres/internal/disable_warnings.h"
43#include "ceres/internal/export.h"
Keir Mierle8ebb0732012-04-30 23:09:08 -070044#include "ceres/types.h"
45
46namespace ceres {
Sameer Agarwal4997cbc2012-07-02 12:44:34 -070047
Sameer Agarwald3ace022012-09-23 18:19:49 -070048struct CRSMatrix;
Keir Mierle7bdceb42018-01-10 17:14:57 -080049class EvaluationCallback;
Sameer Agarwal4997cbc2012-07-02 12:44:34 -070050
Keir Mierle8ebb0732012-04-30 23:09:08 -070051namespace internal {
52
53class Program;
54class SparseMatrix;
55
56// The Evaluator interface offers a way to interact with a least squares cost
57// function that is useful for an optimizer that wants to minimize the least
58// squares objective. This insulates the optimizer from issues like Jacobian
Sameer Agarwal125a0e92021-12-28 07:05:03 -080059// storage, manifolds, etc.
Sergiu Deitschf90833f2022-02-07 23:43:19 +010060class CERES_NO_EXPORT Evaluator {
Keir Mierle8ebb0732012-04-30 23:09:08 -070061 public:
62 virtual ~Evaluator();
63
64 struct Options {
Sameer Agarwal9814a912018-04-06 08:38:11 -070065 int num_threads = 1;
66 int num_eliminate_blocks = -1;
67 LinearSolverType linear_solver_type = DENSE_QR;
Sameer Agarwalf6f2f0d2022-08-16 15:46:22 -070068 SparseLinearAlgebraLibraryType sparse_linear_algebra_library_type =
69 NO_SPARSE;
Sameer Agarwal9814a912018-04-06 08:38:11 -070070 bool dynamic_sparsity = false;
71 ContextImpl* context = nullptr;
72 EvaluationCallback* evaluation_callback = nullptr;
Keir Mierle8ebb0732012-04-30 23:09:08 -070073 };
74
Sameer Agarwalae652192022-02-02 13:17:29 -080075 static std::unique_ptr<Evaluator> Create(const Options& options,
76 Program* program,
77 std::string* error);
Keir Mierle8ebb0732012-04-30 23:09:08 -070078
79 // Build and return a sparse matrix for storing and working with the Jacobian
80 // of the objective function. The jacobian has dimensions
81 // NumEffectiveParameters() by NumParameters(), and is typically extremely
82 // sparse. Since the sparsity pattern of the Jacobian remains constant over
83 // the lifetime of the optimization problem, this method is used to
84 // instantiate a SparseMatrix object with the appropriate sparsity structure
85 // (which can be an expensive operation) and then reused by the optimization
86 // algorithm and the various linear solvers.
87 //
88 // It is expected that the classes implementing this interface will be aware
89 // of their client's requirements for the kind of sparse matrix storage and
90 // layout that is needed for an efficient implementation. For example
91 // CompressedRowOptimizationProblem creates a compressed row representation of
92 // the jacobian for use with CHOLMOD, where as BlockOptimizationProblem
93 // creates a BlockSparseMatrix representation of the jacobian for use in the
94 // Schur complement based methods.
Sameer Agarwalae652192022-02-02 13:17:29 -080095 virtual std::unique_ptr<SparseMatrix> CreateJacobian() const = 0;
Keir Mierle8ebb0732012-04-30 23:09:08 -070096
Sameer Agarwal039ff072013-02-26 09:15:39 -080097 // Options struct to control Evaluator::Evaluate;
98 struct EvaluateOptions {
Sameer Agarwal039ff072013-02-26 09:15:39 -080099 // If false, the loss function correction is not applied to the
100 // residual blocks.
Sameer Agarwal9814a912018-04-06 08:38:11 -0700101 bool apply_loss_function = true;
Keir Mierle7bdceb42018-01-10 17:14:57 -0800102
103 // If false, this evaluation point is the same as the last one.
Sameer Agarwal9814a912018-04-06 08:38:11 -0700104 bool new_evaluation_point = true;
Sameer Agarwal039ff072013-02-26 09:15:39 -0800105 };
106
Keir Mierle8ebb0732012-04-30 23:09:08 -0700107 // Evaluate the cost function for the given state. Returns the cost,
108 // residuals, and jacobian in the corresponding arguments. Both residuals and
Sameer Agarwalae652192022-02-02 13:17:29 -0800109 // jacobian are optional; to avoid computing them, pass nullptr.
Keir Mierle8ebb0732012-04-30 23:09:08 -0700110 //
Sameer Agarwalae652192022-02-02 13:17:29 -0800111 // If non-nullptr, the Jacobian must have a suitable sparsity pattern; only
112 // the values array of the jacobian is modified.
Keir Mierle8ebb0732012-04-30 23:09:08 -0700113 //
114 // state is an array of size NumParameters(), cost is a pointer to a single
115 // double, and residuals is an array of doubles of size NumResiduals().
Sameer Agarwal039ff072013-02-26 09:15:39 -0800116 virtual bool Evaluate(const EvaluateOptions& evaluate_options,
117 const double* state,
Keir Mierle8ebb0732012-04-30 23:09:08 -0700118 double* cost,
119 double* residuals,
Keir Mierlef44907f2012-07-06 13:52:32 -0700120 double* gradient,
Keir Mierle8ebb0732012-04-30 23:09:08 -0700121 SparseMatrix* jacobian) = 0;
122
Sameer Agarwal039ff072013-02-26 09:15:39 -0800123 // Variant of Evaluator::Evaluate where the user wishes to use the
124 // default EvaluateOptions struct. This is mostly here as a
125 // convenience method.
Sameer Agarwal6fb10242013-02-26 22:20:18 -0800126 bool Evaluate(const double* state,
127 double* cost,
128 double* residuals,
129 double* gradient,
130 SparseMatrix* jacobian) {
Nikolaus Demmel7b8f6752020-09-20 21:45:24 +0200131 return Evaluate(
132 EvaluateOptions(), state, cost, residuals, gradient, jacobian);
Sameer Agarwal039ff072013-02-26 09:15:39 -0800133 }
134
Keir Mierle8ebb0732012-04-30 23:09:08 -0700135 // Make a change delta (of size NumEffectiveParameters()) to state (of size
136 // NumParameters()) and store the result in state_plus_delta.
137 //
Sameer Agarwal125a0e92021-12-28 07:05:03 -0800138 // In the case that there are no manifolds used, this is equivalent to
Keir Mierle8ebb0732012-04-30 23:09:08 -0700139 //
140 // state_plus_delta[i] = state[i] + delta[i] ;
141 //
Sameer Agarwal125a0e92021-12-28 07:05:03 -0800142 // however, the mapping is more complicated in the case of manifolds
Keir Mierle8ebb0732012-04-30 23:09:08 -0700143 // like quaternions. This is the same as the "Plus()" operation in
Sameer Agarwal125a0e92021-12-28 07:05:03 -0800144 // manifold.h, but operating over the entire state vector for a
Keir Mierle8ebb0732012-04-30 23:09:08 -0700145 // problem.
146 virtual bool Plus(const double* state,
147 const double* delta,
148 double* state_plus_delta) const = 0;
149
150 // The number of parameters in the optimization problem.
151 virtual int NumParameters() const = 0;
152
153 // This is the effective number of parameters that the optimizer may adjust.
Sameer Agarwal125a0e92021-12-28 07:05:03 -0800154 // This applies when there are manifolds on some of the parameters.
Nikolaus Demmel7b8f6752020-09-20 21:45:24 +0200155 virtual int NumEffectiveParameters() const = 0;
Keir Mierle8ebb0732012-04-30 23:09:08 -0700156
157 // The number of residuals in the optimization problem.
158 virtual int NumResiduals() const = 0;
Sameer Agarwalbdd87c02013-01-29 16:24:31 -0800159
Sameer Agarwal42a84b82013-02-01 12:22:53 -0800160 // The following two methods return copies instead of references so
161 // that the base class implementation does not have to worry about
162 // life time issues. Further, these calls are not expected to be
163 // frequent or performance sensitive.
Sameer Agarwal2145c102018-02-05 16:35:06 -0800164 virtual std::map<std::string, CallStatistics> Statistics() const {
Sergiu Deitschc8658c82022-02-20 02:22:17 +0100165 return {};
Sameer Agarwal42a84b82013-02-01 12:22:53 -0800166 }
Keir Mierle8ebb0732012-04-30 23:09:08 -0700167};
168
169} // namespace internal
170} // namespace ceres
171
Sergiu Deitschf90833f2022-02-07 23:43:19 +0100172#include "ceres/internal/reenable_warnings.h"
173
Keir Mierle8ebb0732012-04-30 23:09:08 -0700174#endif // CERES_INTERNAL_EVALUATOR_H_