Skip to content
Snippets Groups Projects
Commit 25ea5d43 authored by Joan Solà Ortega's avatar Joan Solà Ortega
Browse files

remove old function projectLandmarkHp

parent 31d522a7
No related branches found
No related tags found
2 merge requests!3After cmake and const refactor,!1Resolve "Publisher for visual odometry"
Pipeline #9700 canceled
...@@ -93,7 +93,6 @@ class PublisherVisionDebug : public Publisher ...@@ -93,7 +93,6 @@ class PublisherVisionDebug : public Publisher
*/ */
void showTracks(cv::Mat _image, const TrackMatrix& _track_matrix, CaptureBasePtr _cap_img, COLORFEATURES _color_of_features, bool _show_track_ID); void showTracks(cv::Mat _image, const TrackMatrix& _track_matrix, CaptureBasePtr _cap_img, COLORFEATURES _color_of_features, bool _show_track_ID);
Eigen::Vector2d projectLandmarkHp (const LandmarkBasePtr _lmk, const CaptureBasePtr _capture) const;
Eigen::Vector2d projectLandmarkHp (const CaptureBasePtr& _capture, const LandmarkBasePtr _lmk); Eigen::Vector2d projectLandmarkHp (const CaptureBasePtr& _capture, const LandmarkBasePtr _lmk);
LandmarkBasePtr getAssociatedLandmark(const TrackMatrix& _track_matrix, const FeatureBasePtr& _ftr); LandmarkBasePtr getAssociatedLandmark(const TrackMatrix& _track_matrix, const FeatureBasePtr& _ftr);
Eigen::Matrix<double, 3, 4> getProjectionMatrix (const CaptureBasePtr _capture) const; Eigen::Matrix<double, 3, 4> getProjectionMatrix (const CaptureBasePtr _capture) const;
......
...@@ -353,17 +353,6 @@ Eigen::Matrix<double, 3, 4> PublisherVisionDebug::getProjectionMatrix(const Capt ...@@ -353,17 +353,6 @@ Eigen::Matrix<double, 3, 4> PublisherVisionDebug::getProjectionMatrix(const Capt
return P; return P;
} }
// Eigen::Vector2d PublisherVisionDebug::projectLandmarkHp(const LandmarkBasePtr _lmk, const CaptureBasePtr _capture) const
// {
// auto pos = _lmk->getP()->getState();
// Eigen::Vector3d pixel_position3 = getProjectionMatrix(_capture) * getTcwMatrix(_capture) * pos;
// Eigen::Vector2d pixel_position;
// pixel_position << pixel_position3(0) / pixel_position3(2), pixel_position3(1) / pixel_position3(2);
// return pixel_position;
// }
LandmarkBasePtr PublisherVisionDebug::getAssociatedLandmark(const TrackMatrix& _track_matrix, const FeatureBasePtr& _ftr) LandmarkBasePtr PublisherVisionDebug::getAssociatedLandmark(const TrackMatrix& _track_matrix, const FeatureBasePtr& _ftr)
{ {
const auto& track_at_kfs = _track_matrix.trackAtKeyframes(_ftr->trackId()); const auto& track_at_kfs = _track_matrix.trackAtKeyframes(_ftr->trackId());
...@@ -423,4 +412,4 @@ void PublisherVisionDebug::showLandmarks(cv::Mat _image, const TrackMatrix& _tra ...@@ -423,4 +412,4 @@ void PublisherVisionDebug::showLandmarks(cv::Mat _image, const TrackMatrix& _tra
} }
} }
} }
\ No newline at end of file
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment