Unit test for MagFactor. More...
#include <gtsam/navigation/MagFactor.h>#include <gtsam/base/Testable.h>#include <gtsam/base/numericalDerivative.h>#include <CppUnitLite/TestHarness.h>#include <GeographicLib/LocalCartesian.hpp>
Go to the source code of this file.
Functions | |
| Point3 | bias (10,-10, 50) |
| int | main () |
| Point3 | nM (22653.29982,-1956.83010, 44202.47862) |
| double | s (scale *nM.norm()) |
| TEST (MagFactor, unrotate) | |
| TEST (MagFactor, Factors) | |
Variables | |
| Unit3 | dir (nM) |
| Point3 | measured = nRb.inverse() * (scale * nM) + bias |
| SharedNoiseModel | model = noiseModel::Isotropic::Sigma(3, 0.25) |
| Rot3 | nRb = Rot3::Yaw(-0.1) |
| double | scale = 255.0 / 50000.0 |
| Point3 | scaled = scale * nM |
| Rot2 | theta = nRb.yaw() |
| Point3 bias | ( | 10 | , |
| - | 10, | ||
| 50 | |||
| ) |
| int main | ( | void | ) |
Definition at line 109 of file testMagFactor.cpp.
| Point3 nM | ( | 22653. | 29982, |
| -1956. | 83010, | ||
| 44202. | 47862 | ||
| ) |
| double s | ( | scale *nM. | norm() | ) |
| TEST | ( | MagFactor | , |
| unrotate | |||
| ) |
Definition at line 59 of file testMagFactor.cpp.
| TEST | ( | MagFactor | , |
| Factors | |||
| ) |
Definition at line 68 of file testMagFactor.cpp.
| Point3 measured = nRb.inverse() * (scale * nM) + bias |
Definition at line 49 of file testMagFactor.cpp.
| SharedNoiseModel model = noiseModel::Isotropic::Sigma(3, 0.25) |
Definition at line 54 of file testMagFactor.cpp.
| Rot3 nRb = Rot3::Yaw(-0.1) |
Definition at line 43 of file testMagFactor.cpp.
| double scale = 255.0 / 50000.0 |
Definition at line 41 of file testMagFactor.cpp.
Definition at line 48 of file testMagFactor.cpp.
| Rot2 theta = nRb.yaw() |
Definition at line 44 of file testMagFactor.cpp.