mirror of
https://github.com/ceres-solver/ceres-solver.git
synced 2026-08-29 16:40:38 +08:00
b158515089
Main focus of this change is to parallelize remaining operations (most of them are operations on vectors) in code-path utilized with iterative Schur complement. Parallelization is handled using lazy evaluation of Eigen expressions. On linux pc with intel 8176 processor parallelization of vector operations has the following effect: Running ./bin/parallel_vector_operations_benchmark Run on (112 X 3200.32 MHz CPU s) CPU Caches: L1 Data 32 KiB (x56) L1 Instruction 32 KiB (x56) L2 Unified 1024 KiB (x56) L3 Unified 39424 KiB (x2) Load Average: 3.30, 8.41, 11.82 ----------------------------------- Benchmark Time ----------------------------------- SetZero 10009532 ns SetZeroParallel/1 10024139 ns ... SetZeroParallel/16 877606 ns Negate 4978856 ns NegateParallel/1 5145413 ns ... NegateParallel/16 721823 ns Assign 10731408 ns AssignParallel/1 10749944 ns ... AssignParallel/16 1829381 ns D2X 15214399 ns D2XParallel/1 15623245 ns ... D2XParallel/16 2687060 ns DivideSqrt 8220050 ns DivideSqrtParallel/1 9088467 ns ... DivideSqrtParallel/16 905569 ns Clamp 3502010 ns ClampParallel/1 4507897 ns ... ClampParallel/16 759576 ns Norm 4426782 ns NormParallel/1 4442805 ns ... NormParallel/16 430290 ns Dot 9023276 ns DotParallel/1 9031304 ns ... DotParallel/16 1157267 ns Axpby 14608289 ns AxpbyParallel/1 14570825 ns ... AxpbyParallel/16 2672220 ns ----------------------------------- Multi-threading of vector operations in ISC and program evaluation results into the following improvement: Running ./bin/evaluation_benchmark -------------------------------------------------------------------------------------- Benchmark this2fd81de-------------------------------------------------------------------------------------- Residuals<problem-13682-4456117-pre.txt>/1 4136 ms 4292 ms Residuals<problem-13682-4456117-pre.txt>/2 2919 ms 2670 ms Residuals<problem-13682-4456117-pre.txt>/4 2065 ms 2198 ms Residuals<problem-13682-4456117-pre.txt>/8 1458 ms 1609 ms Residuals<problem-13682-4456117-pre.txt>/16 1152 ms 1227 ms ResidualsAndJacobian<problem-13682-4456117-pre.txt>/1 19759 ms 20084 ms ResidualsAndJacobian<problem-13682-4456117-pre.txt>/2 10921 ms 10977 ms ResidualsAndJacobian<problem-13682-4456117-pre.txt>/4 6220 ms 6941 ms ResidualsAndJacobian<problem-13682-4456117-pre.txt>/8 3490 ms 4398 ms ResidualsAndJacobian<problem-13682-4456117-pre.txt>/16 2277 ms 3172 ms Plus<problem-13682-4456117-pre.txt>/1 339 ms 322 ms Plus<problem-13682-4456117-pre.txt>/2 220 ms Plus<problem-13682-4456117-pre.txt>/4 128 ms Plus<problem-13682-4456117-pre.txt>/8 78.0 ms Plus<problem-13682-4456117-pre.txt>/16 49.8 ms ISCRightMultiplyAndAccumulate<problem-13682-4456117-pre.txt>/1 2434 ms 2478 ms ISCRightMultiplyAndAccumulate<problem-13682-4456117-pre.txt>/2 2706 ms 2688 ms ISCRightMultiplyAndAccumulate<problem-13682-4456117-pre.txt>/4 1430 ms 1548 ms ISCRightMultiplyAndAccumulate<problem-13682-4456117-pre.txt>/8 742 ms 883 ms ISCRightMultiplyAndAccumulate<problem-13682-4456117-pre.txt>/16 438 ms 555 ms ISCRightMultiplyAndAccumulateDiag<problem-13682-4456117-pre.txt>/1 2438 ms 2481 ms ISCRightMultiplyAndAccumulateDiag<problem-13682-4456117-pre.txt>/2 2565 ms 2790 ms ISCRightMultiplyAndAccumulateDiag<problem-13682-4456117-pre.txt>/4 1434 ms 1551 ms ISCRightMultiplyAndAccumulateDiag<problem-13682-4456117-pre.txt>/8 765 ms 892 ms ISCRightMultiplyAndAccumulateDiag<problem-13682-4456117-pre.txt>/16 435 ms 559 ms JacobianSquaredColumnNorm<problem-13682-4456117-pre.txt>/1 1278 ms JacobianSquaredColumnNorm<problem-13682-4456117-pre.txt>/2 1555 ms JacobianSquaredColumnNorm<problem-13682-4456117-pre.txt>/4 833 ms JacobianSquaredColumnNorm<problem-13682-4456117-pre.txt>/8 459 ms JacobianSquaredColumnNorm<problem-13682-4456117-pre.txt>/16 250 ms JacobianScaleColumns<problem-13682-4456117-pre.txt>/1 1468 ms JacobianScaleColumns<problem-13682-4456117-pre.txt>/2 1871 ms JacobianScaleColumns<problem-13682-4456117-pre.txt>/4 957 ms JacobianScaleColumns<problem-13682-4456117-pre.txt>/8 528 ms JacobianScaleColumns<problem-13682-4456117-pre.txt>/16 294 ms End-to-end improvements with bundle_adjuster invoked with ./bin/bundle_adjuster --num_threads 28 --num_iterations 40 \ --linear_solver iterative_schur \ --preconditioner jacobi --input --------------------------------------------- Problem this2fd81de--------------------------------------------- problem-13682-4456117-pre.txt 508.6 892.7 problem-1778-993923-pre.txt 763.8 1129.9 problem-1723-156502-pre.txt 6.3 14.4 problem-356-226730-pre.txt 76.3 116.2 problem-257-65132-pre.txt 38.6 52.0 Change-Id: Ie31cc5015f13fa479c16ffb5ce48c9b880990d49
202 lines
8.3 KiB
C++
202 lines
8.3 KiB
C++
// Ceres Solver - A fast non-linear least squares minimizer
|
|
// Copyright 2015 Google Inc. All rights reserved.
|
|
// http://ceres-solver.org/
|
|
//
|
|
// Redistribution and use in source and binary forms, with or without
|
|
// modification, are permitted provided that the following conditions are met:
|
|
//
|
|
// * Redistributions of source code must retain the above copyright notice,
|
|
// this list of conditions and the following disclaimer.
|
|
// * Redistributions in binary form must reproduce the above copyright notice,
|
|
// this list of conditions and the following disclaimer in the documentation
|
|
// and/or other materials provided with the distribution.
|
|
// * Neither the name of Google Inc. nor the names of its contributors may be
|
|
// used to endorse or promote products derived from this software without
|
|
// specific prior written permission.
|
|
//
|
|
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
// AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
// IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
// ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
|
// LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
// CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
// SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
// INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
// CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
// ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
// POSSIBILITY OF SUCH DAMAGE.
|
|
//
|
|
// Author: sameeragarwal@google.com (Sameer Agarwal)
|
|
|
|
#ifndef CERES_INTERNAL_MINIMIZER_H_
|
|
#define CERES_INTERNAL_MINIMIZER_H_
|
|
|
|
#include <memory>
|
|
#include <string>
|
|
#include <vector>
|
|
|
|
#include "ceres/internal/disable_warnings.h"
|
|
#include "ceres/internal/export.h"
|
|
#include "ceres/iteration_callback.h"
|
|
#include "ceres/solver.h"
|
|
|
|
namespace ceres::internal {
|
|
|
|
class Evaluator;
|
|
class SparseMatrix;
|
|
class TrustRegionStrategy;
|
|
class CoordinateDescentMinimizer;
|
|
class LinearSolver;
|
|
class ContextImpl;
|
|
|
|
// Interface for non-linear least squares solvers.
|
|
class CERES_NO_EXPORT Minimizer {
|
|
public:
|
|
// Options struct to control the behaviour of the Minimizer. Please
|
|
// see solver.h for detailed information about the meaning and
|
|
// default values of each of these parameters.
|
|
struct Options {
|
|
Options() { Init(Solver::Options()); }
|
|
|
|
explicit Options(const Solver::Options& options) { Init(options); }
|
|
|
|
void Init(const Solver::Options& options) {
|
|
num_threads = options.num_threads;
|
|
max_num_iterations = options.max_num_iterations;
|
|
max_solver_time_in_seconds = options.max_solver_time_in_seconds;
|
|
max_step_solver_retries = 5;
|
|
gradient_tolerance = options.gradient_tolerance;
|
|
parameter_tolerance = options.parameter_tolerance;
|
|
function_tolerance = options.function_tolerance;
|
|
min_relative_decrease = options.min_relative_decrease;
|
|
eta = options.eta;
|
|
jacobi_scaling = options.jacobi_scaling;
|
|
use_nonmonotonic_steps = options.use_nonmonotonic_steps;
|
|
max_consecutive_nonmonotonic_steps =
|
|
options.max_consecutive_nonmonotonic_steps;
|
|
trust_region_problem_dump_directory =
|
|
options.trust_region_problem_dump_directory;
|
|
trust_region_minimizer_iterations_to_dump =
|
|
options.trust_region_minimizer_iterations_to_dump;
|
|
trust_region_problem_dump_format_type =
|
|
options.trust_region_problem_dump_format_type;
|
|
max_num_consecutive_invalid_steps =
|
|
options.max_num_consecutive_invalid_steps;
|
|
min_trust_region_radius = options.min_trust_region_radius;
|
|
line_search_direction_type = options.line_search_direction_type;
|
|
line_search_type = options.line_search_type;
|
|
nonlinear_conjugate_gradient_type =
|
|
options.nonlinear_conjugate_gradient_type;
|
|
max_lbfgs_rank = options.max_lbfgs_rank;
|
|
use_approximate_eigenvalue_bfgs_scaling =
|
|
options.use_approximate_eigenvalue_bfgs_scaling;
|
|
line_search_interpolation_type = options.line_search_interpolation_type;
|
|
min_line_search_step_size = options.min_line_search_step_size;
|
|
line_search_sufficient_function_decrease =
|
|
options.line_search_sufficient_function_decrease;
|
|
max_line_search_step_contraction =
|
|
options.max_line_search_step_contraction;
|
|
min_line_search_step_contraction =
|
|
options.min_line_search_step_contraction;
|
|
max_num_line_search_step_size_iterations =
|
|
options.max_num_line_search_step_size_iterations;
|
|
max_num_line_search_direction_restarts =
|
|
options.max_num_line_search_direction_restarts;
|
|
line_search_sufficient_curvature_decrease =
|
|
options.line_search_sufficient_curvature_decrease;
|
|
max_line_search_step_expansion = options.max_line_search_step_expansion;
|
|
inner_iteration_tolerance = options.inner_iteration_tolerance;
|
|
is_silent = (options.logging_type == SILENT);
|
|
is_constrained = false;
|
|
callbacks = options.callbacks;
|
|
}
|
|
|
|
int max_num_iterations;
|
|
double max_solver_time_in_seconds;
|
|
int num_threads;
|
|
ContextImpl* context = nullptr;
|
|
|
|
// Number of times the linear solver should be retried in case of
|
|
// numerical failure. The retries are done by exponentially scaling up
|
|
// mu at each retry. This leads to stronger and stronger
|
|
// regularization making the linear least squares problem better
|
|
// conditioned at each retry.
|
|
int max_step_solver_retries;
|
|
double gradient_tolerance;
|
|
double parameter_tolerance;
|
|
double function_tolerance;
|
|
double min_relative_decrease;
|
|
double eta;
|
|
bool jacobi_scaling;
|
|
bool use_nonmonotonic_steps;
|
|
int max_consecutive_nonmonotonic_steps;
|
|
std::vector<int> trust_region_minimizer_iterations_to_dump;
|
|
DumpFormatType trust_region_problem_dump_format_type;
|
|
std::string trust_region_problem_dump_directory;
|
|
int max_num_consecutive_invalid_steps;
|
|
double min_trust_region_radius;
|
|
LineSearchDirectionType line_search_direction_type;
|
|
LineSearchType line_search_type;
|
|
NonlinearConjugateGradientType nonlinear_conjugate_gradient_type;
|
|
int max_lbfgs_rank;
|
|
bool use_approximate_eigenvalue_bfgs_scaling;
|
|
LineSearchInterpolationType line_search_interpolation_type;
|
|
double min_line_search_step_size;
|
|
double line_search_sufficient_function_decrease;
|
|
double max_line_search_step_contraction;
|
|
double min_line_search_step_contraction;
|
|
int max_num_line_search_step_size_iterations;
|
|
int max_num_line_search_direction_restarts;
|
|
double line_search_sufficient_curvature_decrease;
|
|
double max_line_search_step_expansion;
|
|
double inner_iteration_tolerance;
|
|
|
|
// If true, then all logging is disabled.
|
|
bool is_silent;
|
|
|
|
// Use a bounds constrained optimization algorithm.
|
|
bool is_constrained;
|
|
|
|
// List of callbacks that are executed by the Minimizer at the end
|
|
// of each iteration.
|
|
//
|
|
// The Options struct does not own these pointers.
|
|
std::vector<IterationCallback*> callbacks;
|
|
|
|
// Object responsible for evaluating the cost, residuals and
|
|
// Jacobian matrix.
|
|
std::shared_ptr<Evaluator> evaluator;
|
|
|
|
// Object responsible for actually computing the trust region
|
|
// step, and sizing the trust region radius.
|
|
std::shared_ptr<TrustRegionStrategy> trust_region_strategy;
|
|
|
|
// Object holding the Jacobian matrix. It is assumed that the
|
|
// sparsity structure of the matrix has already been initialized
|
|
// and will remain constant for the life time of the
|
|
// optimization.
|
|
std::shared_ptr<SparseMatrix> jacobian;
|
|
|
|
std::shared_ptr<CoordinateDescentMinimizer> inner_iteration_minimizer;
|
|
};
|
|
|
|
static std::unique_ptr<Minimizer> Create(MinimizerType minimizer_type);
|
|
static bool RunCallbacks(const Options& options,
|
|
const IterationSummary& iteration_summary,
|
|
Solver::Summary* summary);
|
|
|
|
virtual ~Minimizer();
|
|
// Note: The minimizer is expected to update the state of the
|
|
// parameters array every iteration. This is required for the
|
|
// StateUpdatingCallback to work.
|
|
virtual void Minimize(const Options& options,
|
|
double* parameters,
|
|
Solver::Summary* summary) = 0;
|
|
};
|
|
|
|
} // namespace ceres::internal
|
|
|
|
#include "ceres/internal/reenable_warnings.h"
|
|
|
|
#endif // CERES_INTERNAL_MINIMIZER_H_
|