rovio是一個(gè)緊耦合，基于圖像塊的濾波實(shí)現(xiàn)的VIO。Property

}V3D getPerp1() const{    return q_.rotate(e_x);
    FilterInitializationState(
      imgUpdateMeas_.template get<mtImgMeas::_aux>().pyr_[camID].computeFromImage(cv_img,true);
      imgUpdateMeas_.template get<mtImgMeas::_aux>().isValidPyr_[camID] = true;      if(imgUpdateMeas_.template get<mtImgMeas::_aux>().areAllValid()){
          mpFilter_->template addUpdateMeas<0>(imgUpdateMeas_,msgTime);
          imgUpdateMeas_.template get<mtImgMeas::_aux>().reset(msgTime);
   ImgUpdate.hpp

  • Stack all photometric error terms into a vector b, you get b(p)

  • Linearize the error around 

    網(wǎng)友評(píng)論