commit
e86e328240
|
@ -2623,6 +2623,8 @@ virtual class BearingRangeFactor : gtsam::NoiseModelFactor {
|
||||||
const BEARING& measuredBearing, const RANGE& measuredRange,
|
const BEARING& measuredBearing, const RANGE& measuredRange,
|
||||||
const gtsam::noiseModel::Base* noiseModel);
|
const gtsam::noiseModel::Base* noiseModel);
|
||||||
|
|
||||||
|
BearingRange<POSE, POINT, BEARING, RANGE> measured() const;
|
||||||
|
|
||||||
// enabling serialization functionality
|
// enabling serialization functionality
|
||||||
void serialize() const;
|
void serialize() const;
|
||||||
};
|
};
|
||||||
|
|
|
@ -113,12 +113,13 @@ class SmartStereoProjectionPoseFactor : public SmartStereoProjectionFactor {
|
||||||
* print
|
* print
|
||||||
* @param s optional string naming the factor
|
* @param s optional string naming the factor
|
||||||
* @param keyFormatter optional formatter useful for printing Symbols
|
* @param keyFormatter optional formatter useful for printing Symbols
|
||||||
*/ void print(
|
*/
|
||||||
const std::string& s = "",
|
void print(const std::string& s = "", const KeyFormatter& keyFormatter =
|
||||||
const KeyFormatter& keyFormatter = DefaultKeyFormatter) const override;
|
DefaultKeyFormatter) const override;
|
||||||
|
|
||||||
/// equals
|
/// equals
|
||||||
virtual bool equals(const NonlinearFactor& p, double tol = 1e-9) const;
|
virtual bool equals(const NonlinearFactor& p,
|
||||||
|
double tol = 1e-9) const override;
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* error calculates the error of the factor.
|
* error calculates the error of the factor.
|
||||||
|
@ -155,4 +156,4 @@ template <>
|
||||||
struct traits<SmartStereoProjectionPoseFactor>
|
struct traits<SmartStereoProjectionPoseFactor>
|
||||||
: public Testable<SmartStereoProjectionPoseFactor> {};
|
: public Testable<SmartStereoProjectionPoseFactor> {};
|
||||||
|
|
||||||
} // \ namespace gtsam
|
} // namespace gtsam
|
||||||
|
|
Loading…
Reference in New Issue