12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

LieScalar does not make sense here: scale is known -> double

release/4.3a0
dellaert 2014-02-01 14:03:16 -05:00
parent a48c72ff63
commit cfe5a3663e
1 changed files with 5 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
gtsam/navigation/MagFactor.h
View File

@ -38,7 +38,7 @@ class MagFactor: public NoiseModelFactor1<Rot2> {
public:
/** Constructor */
MagFactor(Key key, const Point3& measured, const LieScalar& scale,
MagFactor(Key key, const Point3& measured, double scale,
const Sphere2& direction, const Point3& bias,
const SharedNoiseModel& model) :
NoiseModelFactor1<Rot2>(model, key), //
@ -54,7 +54,8 @@ public:
static Point3 unrotate(const Rot2& R, const Point3& p,
boost::optional<Matrix&> HR = boost::none) {
Point3 q = Rot3::yaw(R.theta()).unrotate(p, HR);
if (HR) *HR = HR->col(2);
if (HR)
*HR = HR->col(2);
return q;
}
@ -83,7 +84,7 @@ class MagFactor1: public NoiseModelFactor1<Rot3> {
public:
/** Constructor */
MagFactor1(Key key, const Point3& measured, const LieScalar& scale,
MagFactor1(Key key, const Point3& measured, double scale,
const Sphere2& direction, const Point3& bias,
const SharedNoiseModel& model) :
NoiseModelFactor1<Rot3>(model, key), //