Skip to content
Snippets Groups Projects

Resolve "Frame/Capture/Feature/Landmark Other as list/vectors in FactorBase"

1 file
+ 6
4
Compare changes
  • Side-by-side
  • Inline
@@ -140,10 +140,12 @@ inline bool FactorDiffDrive::operator ()(const T* const _p1, const T* const _o1,
@@ -140,10 +140,12 @@ inline bool FactorDiffDrive::operator ()(const T* const _p1, const T* const _o1,
inline Eigen::VectorXd FactorDiffDrive::residual()
inline Eigen::VectorXd FactorDiffDrive::residual()
{
{
VectorXd residual(3);
VectorXd residual(3);
operator ()(getFrameOther()->getP()->getState().data(), getFrameOther()->getO()->getState().data(),
operator ()(getFrameOther() ->getP() ->getState() .data(),
getCapture()->getFrame()->getP()->getState().data(),
getFrameOther() ->getO() ->getState() .data(),
getCapture()->getFrame()->getO()->getState().data(),
getFrame() ->getP() ->getState() .data(),
getCaptureOther()->getSensorIntrinsic()->getState().data(), residual.data());
getFrame() ->getO() ->getState() .data(),
 
getCaptureOther() ->getSensorIntrinsic() ->getState() .data(),
 
residual.data());
return residual;
return residual;
}
}
Loading