diff --git a/src/publisher_vision.cpp b/src/publisher_vision.cpp
index ee50650a87e885f5ddcdf8c0688e204087a47b2a..0d13570bd62a3d7ce3ef201c1319f18977cd303b 100644
--- a/src/publisher_vision.cpp
+++ b/src/publisher_vision.cpp
@@ -511,14 +511,7 @@ Eigen::Matrix4d PublisherVisionDebug::getTcwMatrix(const CaptureBasePtr _capture
 
 Eigen::Matrix<double, 3, 4> PublisherVisionDebug::getProjectionMatrix(const CaptureBasePtr _capture) const
 {
-    auto k(_capture->getSensor()->getIntrinsic()->getState()); // intrinsic vector of camera k = [u0 v0 au av]
-    Eigen::Matrix<double, 3, 4> P;
-
-    P <<    k(2), 0   , k(0), 0, //
-            0   , k(3), k(1), 0, //
-            0   , 0   , 1   , 0; //
-
-    return P;
+    return (std::static_pointer_cast<SensorCamera>(_capture->getSensor()))->getProjectionMatrix();
 }
 
 LandmarkBasePtr PublisherVisionDebug::getAssociatedLandmark(const TrackMatrix& _track_matrix, const FeatureBasePtr& _ftr)