Deal w new Rot3 operators
parent
846a777491
commit
e16d798bd4
|
|
@ -101,7 +101,7 @@ Mechanization_bRn2 Mechanization_bRn2::integrate(const Vector3& u,
|
|||
|
||||
// convert to navigation frame
|
||||
Rot3 nRb = bRn_.inverse();
|
||||
Vector3 n_omega_bn = (nRb*b_omega_bn).vector();
|
||||
Vector3 n_omega_bn = nRb*b_omega_bn;
|
||||
|
||||
// integrate bRn using exponential map, assuming constant over dt
|
||||
Rot3 delta_nRn = Rot3::Rodrigues(n_omega_bn*dt);
|
||||
|
|
|
|||
|
|
@ -42,7 +42,7 @@ public:
|
|||
/// gravity in the body frame
|
||||
Vector3 b_g(double g_e) const {
|
||||
Vector3 n_g(0, 0, g_e);
|
||||
return (bRn_ * n_g).vector();
|
||||
return bRn_ * n_g;
|
||||
}
|
||||
|
||||
const Rot3& bRn() const {return bRn_; }
|
||||
|
|
|
|||
Loading…
Reference in New Issue