MROB
factor_graph_solve_dense.hpp
1 /* Copyright (c) 2022, Gonzalo Ferrer
2  *
3  * Licensed under the Apache License, Version 2.0 (the "License");
4  * you may not use this file except in compliance with the License.
5  * You may obtain a copy of the License at
6  *
7  * http://www.apache.org/licenses/LICENSE-2.0
8  *
9  * Unless required by applicable law or agreed to in writing, software
10  * distributed under the License is distributed on an "AS IS" BASIS,
11  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12  * See the License for the specific language governing permissions and
13  * limitations under the License.
14  *
15  *
16  * factor_graph_solve_dense.hpp
17  *
18  * Created on: Sep 3, 2020
19  * Author: Gonzalo Ferrer
20  * g.ferrer@skoltech.ru
21  * Mobile Robotics Lab.
22  */
23 
24 #ifndef FACTOR_GRAPH_SOLVE_DENSE_HPP_
25 #define FACTOR_GRAPH_SOLVE_DENSE_HPP_
26 
27 #include "mrob/optimizer.hpp"
28 #include "mrob/factor_graph.hpp"
29 #include "mrob/time_profiling.hpp"
30 
31 namespace mrob {
32 
33 
42 class FGraphSolveDense: public FGraph, public OptimizerDense
43 {
44  public:
47 
48  // Function from the parent class Optimizer
49  virtual matData_t calculate_error() override;
50  virtual void calculate_gradient_hessian() override;
51  virtual void update_state() override;
52  virtual void bookkeep_state() override;
53  virtual void update_state_from_bookkeep() override;
54 
55 };
56 
57 
58 }//namespace
59 
60 #endif /* FACTOR_GRAPH_SOLVE_DENSE_HPP_ */
virtual void update_state_from_bookkeep() override
Definition: factor_graph_solve_dense.cpp:164
Definition: factor_graph.hpp:57
virtual void bookkeep_state() override
Definition: factor_graph_solve_dense.cpp:159
Definition: optimizer.hpp:151
virtual void calculate_gradient_hessian() override
Definition: factor_graph_solve_dense.cpp:58
virtual void update_state() override
Definition: factor_graph_solve_dense.cpp:145
virtual matData_t calculate_error() override
Definition: factor_graph_solve_dense.cpp:46
Special Euclidean (group) in 3d Is the group representing rotations and translations, that is, rigid body transformations. SE3 = {T = [R t] | R SO3 , t Re^3 } [0 1] Associated to the groups of RBT, there is the Lie algebra se3 representing the same transformation in the tangent space around the identity. Particularly, xi =[w , v] Re^6, where w Re^3 represents the rotation and v the translation. We will preserve this order in this class.
Definition: matrix_base.hpp:36
Definition: factor_graph_solve_dense.hpp:42