refactoring Point, added point normal as member
This commit is contained in:
@@ -69,7 +69,7 @@ class PoseOptimizerTest {
|
||||
if(it->score > Config::triangMinCornerScore())
|
||||
{
|
||||
Feature* ftr(new Feature(frame_.get(), Vector2d(it->x, it->y), it->level));
|
||||
Point* point(new Point(frame_->f2w(ftr->f*depthmap_.at<float>(it->y, it->x)), Point::DEPTH));
|
||||
Point* point(new Point(frame_->f2w(ftr->f*depthmap_.at<float>(it->y, it->x))));
|
||||
ftr->point = point;
|
||||
ftr->frame = frame_.get();
|
||||
frame_->addFeature(ftr);
|
||||
|
||||
@@ -104,7 +104,7 @@ void SparseImgAlignTest::testSequence(
|
||||
svo::Feature* ftr = new svo::Feature(frame_ref_.get(), Eigen::Vector2d(corner->x, corner->y), corner->level);
|
||||
Eigen::Vector3d pt_pos_cur = ftr->f*depthmap.at<float>(corner->y, corner->x);
|
||||
Eigen::Vector3d pt_pos_w = frame_ref_->T_f_w_.inverse()*pt_pos_cur;
|
||||
svo::Point* pt = new svo::Point(pt_pos_w, svo::Point::DEPTH);
|
||||
svo::Point* pt = new svo::Point(pt_pos_w);
|
||||
ftr->point = pt;
|
||||
frame_ref_->addFeature(ftr);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user