changed optional matrices to Optional Jacobians
parent
a6ee1231a0
commit
493a4f7f86
|
|
@ -35,8 +35,8 @@ void OrientedPlane3::print(const std::string& s) const {
|
||||||
/* ************************************************************************* */
|
/* ************************************************************************* */
|
||||||
OrientedPlane3 OrientedPlane3::Transform (const gtsam::OrientedPlane3& plane,
|
OrientedPlane3 OrientedPlane3::Transform (const gtsam::OrientedPlane3& plane,
|
||||||
const gtsam::Pose3& xr,
|
const gtsam::Pose3& xr,
|
||||||
boost::optional<Matrix&> Hr,
|
OptionalJacobian<3, 6> Hr,
|
||||||
boost::optional<Matrix&> Hp)
|
OptionalJacobian<3, 3> Hp)
|
||||||
{
|
{
|
||||||
Matrix n_hr;
|
Matrix n_hr;
|
||||||
Matrix n_hp;
|
Matrix n_hp;
|
||||||
|
|
|
||||||
|
|
@ -76,8 +76,8 @@ public:
|
||||||
/// Transforms a plane to the specified pose
|
/// Transforms a plane to the specified pose
|
||||||
static OrientedPlane3 Transform (const gtsam::OrientedPlane3& plane,
|
static OrientedPlane3 Transform (const gtsam::OrientedPlane3& plane,
|
||||||
const gtsam::Pose3& xr,
|
const gtsam::Pose3& xr,
|
||||||
boost::optional<Matrix&> Hr,
|
OptionalJacobian<3, 6> Hr = boost::none,
|
||||||
boost::optional<Matrix&> Hp);
|
OptionalJacobian<3, 3> Hp = boost::none);
|
||||||
|
|
||||||
/// Computes the error between two poses
|
/// Computes the error between two poses
|
||||||
Vector3 error (const gtsam::OrientedPlane3& plane) const;
|
Vector3 error (const gtsam::OrientedPlane3& plane) const;
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue