| // Ceres Solver - A fast non-linear least squares minimizer |
| // Copyright 2016 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: vitus@google.com (Michael Vitus) |
| // |
| // Reads a 2D pose graph problem formulation in g2o format. |
| |
| #ifndef CERES_EXAMPLES_POSE_GRAPH_2D_READ_G2O_H_ |
| #define CERES_EXAMPLES_POSE_GRAPH_2D_READ_G2O_H_ |
| |
| #include <string> |
| #include <map> |
| #include <vector> |
| |
| #include "types.h" |
| |
| namespace ceres { |
| namespace examples { |
| |
| // Reads a file in the g2o filename format that describes a 2D pose graph |
| // problem. The g2o format consists of two entries, vertices and constraints. A |
| // vertex is defined as follows: |
| // |
| // VERTEX_SE2 ID x_meters y_meters yaw_radians |
| // |
| // A constraint is defined as follows: |
| // |
| // EDGE_SE2 ID_A ID_B A_x_B A_y_B A_yaw_B I_11 I_12 I_13 I_22 I_23 I_33 |
| // |
| // where I_ij is the (i, j)-th entry of the information matrix for the |
| // measurement. |
| bool ReadG2oFile(const std::string& filename, |
| std::map<int, Pose2d>* poses, |
| std::vector<Constraint2d>* constraints); |
| |
| } // namespace examples |
| } // namespace ceres |
| |
| #endif // CERES_EXAMPLES_POSE_GRAPH_2D_READ_G2O_H_ |