set sigma to 1 in pose2prior
parent
a4d61d2f23
commit
b0f27c5d4b
|
|
@ -25,10 +25,11 @@ private:
|
|||
|
||||
public:
|
||||
|
||||
typedef NonlinearFactor<Pose2Config> Base;
|
||||
typedef boost::shared_ptr<Pose2Prior> shared_ptr; // shorthand for a smart pointer to a factor
|
||||
|
||||
Pose2Prior(const Key& key, const Pose2& measured, const Matrix& measurement_covariance) :
|
||||
key_(key),measured_(measured) {
|
||||
key_(key),measured_(measured),Base(1.0) {
|
||||
square_root_inverse_covariance_ = inverse_square_root(measurement_covariance);
|
||||
keys_.push_back(key);
|
||||
}
|
||||
|
|
|
|||
Loading…
Reference in New Issue