| /external/ceres-solver/internal/ceres/ |
| autodiff_local_parameterization_test.cc | 43 bool operator()(const T* x, const T* delta, T* x_plus_delta) const {
45 x_plus_delta[i] = x[i] + delta[i];
57 double x_plus_delta[3] = {0.0, 0.0, 0.0}; local
58 parameterization.Plus(x, delta, x_plus_delta);
60 EXPECT_EQ(x_plus_delta[0], 1.0);
61 EXPECT_EQ(x_plus_delta[1], 3.0);
62 EXPECT_EQ(x_plus_delta[2], 5.0);
80 bool operator()(const T* x, const T* delta, T* x_plus_delta) const {
82 x_plus_delta[i] = x[i] + T(scale_factor_) * delta[i];
98 double x_plus_delta[3] = {0.0, 0.0, 0.0} local
156 double x_plus_delta[4] = {0.0, 0.0, 0.0, 0.0}; local
[all...] |
| parameter_block_test.cc | 84 double x_plus_delta[3]; local
86 parameter_block.Plus(x, delta, x_plus_delta);
87 ASSERT_EQ(1.5, x_plus_delta[0]);
88 ASSERT_EQ(2.0, x_plus_delta[1]);
89 ASSERT_EQ(3.3, x_plus_delta[2]);
97 double* x_plus_delta) const {
128 double x_plus_delta[2]; local
129 parameter_block.Plus(x, delta, x_plus_delta);
130 EXPECT_EQ(1.2, x_plus_delta[0]);
131 EXPECT_EQ(2.3, x_plus_delta[1])
206 double x_plus_delta[2]; local
[all...] |
| local_parameterization_test.cc | 49 double x_plus_delta[3] = {0.0, 0.0, 0.0}; local
50 parameterization.Plus(x, delta, x_plus_delta);
51 EXPECT_EQ(x_plus_delta[0], 1.0);
52 EXPECT_EQ(x_plus_delta[1], 3.0);
53 EXPECT_EQ(x_plus_delta[2], 5.0);
94 double x_plus_delta[4] = {0.0, 0.0, 0.0}; local
96 parameterization.Plus(x, delta, x_plus_delta);
100 EXPECT_EQ(x_plus_delta[j], x[j]);
102 EXPECT_EQ(x_plus_delta[j], x[j] + delta[k++]);
129 bool operator()(const T* x, const T* delta, T* x_plus_delta) const
164 double x_plus_delta[4] = {0.0, 0.0, 0.0, 0.0}; local
186 QuaternionPlus(), parameters, 4, x_plus_delta, jacobian_array); local
[all...] |
| local_parameterization.cc | 46 double* x_plus_delta) const {
47 VectorRef(x_plus_delta, size_) =
88 double* x_plus_delta) const {
91 x_plus_delta[i] = x[i];
93 x_plus_delta[i] = x[i] + delta[j++];
113 double* x_plus_delta) const {
123 QuaternionProduct(q_delta, x, x_plus_delta);
126 x_plus_delta[i] = x[i];
|
| parameter_block.h | 214 bool Plus(const double *x, const double* delta, double* x_plus_delta) {
216 if (!local_parameterization_->Plus(x, delta, x_plus_delta)) {
220 VectorRef(x_plus_delta, size_) = ConstVectorRef(x, size_) +
227 x_plus_delta[i] = std::max(x_plus_delta[i], lower_bounds_[i]);
233 x_plus_delta[i] = std::min(x_plus_delta[i], upper_bounds_[i]);
|
| trust_region_minimizer.cc | 157 Vector x_plus_delta(num_parameters);
183 if (!evaluator->Plus(x.data(), delta.data(), x_plus_delta.data())) {
190 x_min = x_plus_delta;
191 x = x_plus_delta;
396 if (evaluator->Plus(x.data(), delta.data(), x_plus_delta.data())) {
397 if (!evaluator->Evaluate(x_plus_delta.data(),
407 LOG(WARNING) << "x_plus_delta = Plus(x, delta) failed. "
417 Vector inner_iteration_x = x_plus_delta;
428 x_plus_delta = inner_iteration_x;
455 iteration_summary.step_norm = (x - x_plus_delta).norm()
[all...] |
| line_search_minimizer.cc | 120 Vector x_plus_delta(num_parameters);
335 if (!evaluator->Plus(x.data(), delta.data(), x_plus_delta.data())) {
338 "x_plus_delta = Plus(x, delta) failed. This should not happen "
343 x_plus_delta,
354 x = x_plus_delta;
|
| covariance_test.cc | 201 // x_plus_delta = delta * x;
208 double* x_plus_delta) const {
209 x_plus_delta[0] = delta[0] * x[0];
210 x_plus_delta[1] = delta[0] * x[1];
|
| /external/ceres-solver/include/ceres/ |
| autodiff_local_parameterization.h | 49 // x_plus_delta = Plus(x, delta);
65 // bool operator()(const T* x, const T* delta, T* x_plus_delta) const {
88 // QuaternionProduct(q_delta, x, x_plus_delta);
120 double* x_plus_delta) const {
121 return (*functor_)(x, delta, x_plus_delta);
130 double x_plus_delta[kGlobalSize]; local
132 x_plus_delta[i] = 0.0;
141 x_plus_delta,
|
| local_parameterization.h | 68 // x_plus_delta = Plus(x, delta),
70 // where x_plus_delta has the same size as x, and delta is of size
117 // x_plus_delta = Plus(x, delta)
122 double* x_plus_delta) const = 0;
143 double* x_plus_delta) const;
161 double* x_plus_delta) const;
183 double* x_plus_delta) const;
|
| dynamic_numeric_diff_cost_function.h | 171 Map<ParameterVector> x_plus_delta(parameters[parameter_block],
173 ParameterVector x(x_plus_delta);
195 x_plus_delta(j) = x(j) + step_size(j);
212 x_plus_delta(j) = x(j) - step_size(j);
226 x_plus_delta(j) = x(j); // Restore x_plus_delta.
|
| /external/ceres-solver/include/ceres/internal/ |
| numeric_diff.h | 119 Map<ParameterVector> x_plus_delta(parameters[kParameterBlock],
121 ParameterVector x(x_plus_delta);
141 x_plus_delta(j) = x(j) + delta;
157 x_plus_delta(j) = x(j) - delta;
171 x_plus_delta(j) = x(j); // Restore x_plus_delta.
|
