parent
6dea8667fd
commit
7aeb386dbd
|
@ -361,4 +361,3 @@ struct traits<NonlinearEquality2<VALUE> > : Testable<NonlinearEquality2<VALUE> >
|
||||||
|
|
||||||
|
|
||||||
}// namespace gtsam
|
}// namespace gtsam
|
||||||
|
|
||||||
|
|
|
@ -305,8 +305,6 @@ public:
|
||||||
boost::optional<Matrix&> H4 = boost::none,
|
boost::optional<Matrix&> H4 = boost::none,
|
||||||
boost::optional<Matrix&> H5 = boost::none) const override {
|
boost::optional<Matrix&> H5 = boost::none) const override {
|
||||||
|
|
||||||
using namespace boost::placeholders;
|
|
||||||
|
|
||||||
// TODO: Write analytical derivative calculations
|
// TODO: Write analytical derivative calculations
|
||||||
// Jacobian w.r.t. Pose1
|
// Jacobian w.r.t. Pose1
|
||||||
if (H1){
|
if (H1){
|
||||||
|
@ -423,8 +421,6 @@ public:
|
||||||
// Note: all delta terms refer to an IMU\sensor system at t0
|
// Note: all delta terms refer to an IMU\sensor system at t0
|
||||||
// Note: Earth-related terms are not accounted here but are incorporated in predict functions.
|
// Note: Earth-related terms are not accounted here but are incorporated in predict functions.
|
||||||
|
|
||||||
using namespace boost::placeholders;
|
|
||||||
|
|
||||||
POSE body_P_sensor = POSE();
|
POSE body_P_sensor = POSE();
|
||||||
bool flag_use_body_P_sensor = false;
|
bool flag_use_body_P_sensor = false;
|
||||||
if (p_body_P_sensor){
|
if (p_body_P_sensor){
|
||||||
|
|
Loading…
Reference in New Issue