{"id":87618,"date":"2026-07-30T15:27:05","date_gmt":"2026-07-30T07:27:05","guid":{"rendered":"https:\/\/www.wsisp.com\/helps\/87618.html"},"modified":"2026-07-30T15:27:05","modified_gmt":"2026-07-30T07:27:05","slug":"orb-slam3%e8%a7%86%e8%a7%89slam%e5%8e%9f%e7%90%86%e4%b8%8eros2%e5%ae%9e%e6%88%98","status":"publish","type":"post","link":"https:\/\/www.wsisp.com\/helps\/87618.html","title":{"rendered":"ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218"},"content":{"rendered":"<h2>ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218<\/h2>\n<h3>\u4e00\u3001\u5f15\u8a00<\/h3>\n<p>SLAM(\u540c\u65f6\u5b9a\u4f4d\u4e0e\u5efa\u56fe)\u662f\u673a\u5668\u4eba\u548cAR\u7684\u6838\u5fc3\u3002ORB-SLAM3\u662f\u89c6\u89c9SLAM\u7684SOTA\u65b9\u6848&#xff0c;\u652f\u6301\u5355\u76ee\/\u53cc\u76ee\/RGB-D&#043;IMU\u878d\u5408&#xff0c;\u80fd\u5728\u52a8\u6001\u73af\u5883\u4e2d\u9c81\u68d2\u8fd0\u884c\u3002\u672c\u6587\u5c06\u89e3\u6790\u5176\u4e09\u5927\u7ebf\u7a0b\u5e76\u7ed9\u51faROS2\u96c6\u6210\u3002<\/p>\n<h3>\u4e8c\u3001\u4e09\u7ebf\u7a0b\u67b6\u6784<\/h3>\n<p>\u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510  \u5e27  \u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510  \u5173\u952e\u5e27  \u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510<br \/>\n\u2502  Tracking    \u2502\u2500\u2500\u2500\u2500\u2500\u2192\u2502 Local Mapping\u2502\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2192\u2502 Loop Closing \u2502<br \/>\n\u2502  (\u5b9e\u65f6\u8ddf\u8e2a)  \u2502      \u2502 (\u5c40\u90e8\u5efa\u56fe)   \u2502         \u2502 (\u56de\u73af\u68c0\u6d4b)    \u2502<br \/>\n\u2502              \u2502\u2190\u2500\u2500\u2500\u2500\u2500\u2502              \u2502         \u2502              \u2502<br \/>\n\u2502 ORB\u63d0\u53d6&#043;\u5339\u914d \u2502      \u2502 BA\u4f18\u5316       \u2502         \u2502 \u8bcd\u888b\u68c0\u6d4b      \u2502<br \/>\n\u2502 \u4f4d\u59ff\u4f30\u8ba1     \u2502      \u2502 \u65b0\u5730\u56fe\u70b9\u751f\u6210 \u2502         \u2502 \u5168\u5c40BA        \u2502<br \/>\n\u2502 \u91cd\u5b9a\u4f4d       \u2502      \u2502 \u5197\u4f59\u5e27\u5254\u9664   \u2502         \u2502 \u4f4d\u59ff\u56fe\u4f18\u5316    \u2502<br \/>\n\u2514\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2518      \u2514\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2518         \u2514\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2518<\/p>\n<h3>\u4e09\u3001ORB\u7279\u5f81\u63d0\u53d6<\/h3>\n<p><span class=\"token keyword\">import<\/span> cv2<br \/>\n<span class=\"token keyword\">import<\/span> numpy <span class=\"token keyword\">as<\/span> np<\/p>\n<p><span class=\"token keyword\">class<\/span> <span class=\"token class-name\">ORBExtractor<\/span><span class=\"token punctuation\">:<\/span><br \/>\n    <span class=\"token keyword\">def<\/span> <span class=\"token function\">__init__<\/span><span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">,<\/span> n_features<span class=\"token operator\">&#061;<\/span><span class=\"token number\">1000<\/span><span class=\"token punctuation\">,<\/span> scale_factor<span class=\"token operator\">&#061;<\/span><span class=\"token number\">1.2<\/span><span class=\"token punctuation\">,<\/span> n_levels<span class=\"token operator\">&#061;<\/span><span class=\"token number\">8<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>orb <span class=\"token operator\">&#061;<\/span> cv2<span class=\"token punctuation\">.<\/span>ORB_create<span class=\"token punctuation\">(<\/span><br \/>\n            nfeatures<span class=\"token operator\">&#061;<\/span>n_features<span class=\"token punctuation\">,<\/span><br \/>\n            scaleFactor<span class=\"token operator\">&#061;<\/span>scale_factor<span class=\"token punctuation\">,<\/span><br \/>\n            nlevels<span class=\"token operator\">&#061;<\/span>n_levels<span class=\"token punctuation\">,<\/span><br \/>\n            edgeThreshold<span class=\"token operator\">&#061;<\/span><span class=\"token number\">31<\/span><span class=\"token punctuation\">,<\/span><br \/>\n            patchSize<span class=\"token operator\">&#061;<\/span><span class=\"token number\">31<\/span><span class=\"token punctuation\">,<\/span><br \/>\n            fastThreshold<span class=\"token operator\">&#061;<\/span><span class=\"token number\">20<\/span><br \/>\n        <span class=\"token punctuation\">)<\/span><\/p>\n<p>    <span class=\"token keyword\">def<\/span> <span class=\"token function\">extract<\/span><span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">,<\/span> image<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        <span class=\"token triple-quoted-string string\">&#034;&#034;&#034;\u63d0\u53d6ORB\u7279\u5f81\u70b9&#043;\u63cf\u8ff0\u5b50&#034;&#034;&#034;<\/span><br \/>\n        keypoints<span class=\"token punctuation\">,<\/span> descriptors <span class=\"token operator\">&#061;<\/span> self<span class=\"token punctuation\">.<\/span>orb<span class=\"token punctuation\">.<\/span>detectAndCompute<span class=\"token punctuation\">(<\/span>image<span class=\"token punctuation\">,<\/span> <span class=\"token boolean\">None<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p>        <span class=\"token comment\"># \u56db\u53c9\u6811\u5747\u5300\u5206\u5e03&#xff08;ORB-SLAM\u72ec\u6709&#xff0c;\u907f\u514d\u7279\u5f81\u70b9\u805a\u96c6&#xff09;<\/span><br \/>\n        keypoints <span class=\"token operator\">&#061;<\/span> self<span class=\"token punctuation\">.<\/span>_distribute_quadtree<span class=\"token punctuation\">(<\/span>keypoints<span class=\"token punctuation\">,<\/span> image<span class=\"token punctuation\">.<\/span>shape<span class=\"token punctuation\">)<\/span><\/p>\n<p>        <span class=\"token keyword\">return<\/span> keypoints<span class=\"token punctuation\">,<\/span> descriptors<\/p>\n<p>    <span class=\"token keyword\">def<\/span> <span class=\"token function\">_distribute_quadtree<\/span><span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">,<\/span> kps<span class=\"token punctuation\">,<\/span> shape<span class=\"token punctuation\">,<\/span> min_nodes<span class=\"token operator\">&#061;<\/span><span class=\"token number\">4<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        <span class=\"token triple-quoted-string string\">&#034;&#034;&#034;\u56db\u53c9\u6811\u5747\u5300\u5206\u5e03\u7279\u5f81\u70b9&#034;&#034;&#034;<\/span><br \/>\n        h<span class=\"token punctuation\">,<\/span> w <span class=\"token operator\">&#061;<\/span> shape<span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">:<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">]<\/span><br \/>\n        nodes <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">[<\/span>Node<span class=\"token punctuation\">(<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> w<span class=\"token punctuation\">,<\/span> h<span class=\"token punctuation\">,<\/span> kps<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">]<\/span><\/p>\n<p>        <span class=\"token keyword\">while<\/span> <span class=\"token builtin\">len<\/span><span class=\"token punctuation\">(<\/span>nodes<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&lt;<\/span> min_nodes<span class=\"token punctuation\">:<\/span><br \/>\n            new_nodes <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">]<\/span><br \/>\n            <span class=\"token keyword\">for<\/span> node <span class=\"token keyword\">in<\/span> nodes<span class=\"token punctuation\">:<\/span><br \/>\n                <span class=\"token keyword\">if<\/span> <span class=\"token builtin\">len<\/span><span class=\"token punctuation\">(<\/span>node<span class=\"token punctuation\">.<\/span>kps<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&lt;&#061;<\/span> <span class=\"token number\">1<\/span><span class=\"token punctuation\">:<\/span><br \/>\n                    new_nodes<span class=\"token punctuation\">.<\/span>append<span class=\"token punctuation\">(<\/span>node<span class=\"token punctuation\">)<\/span><br \/>\n                <span class=\"token keyword\">else<\/span><span class=\"token punctuation\">:<\/span><br \/>\n                    n1<span class=\"token punctuation\">,<\/span> n2<span class=\"token punctuation\">,<\/span> n3<span class=\"token punctuation\">,<\/span> n4 <span class=\"token operator\">&#061;<\/span> node<span class=\"token punctuation\">.<\/span>split<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><br \/>\n                    new_nodes<span class=\"token punctuation\">.<\/span>extend<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">[<\/span>n1<span class=\"token punctuation\">,<\/span> n2<span class=\"token punctuation\">,<\/span> n3<span class=\"token punctuation\">,<\/span> n4<span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">)<\/span><br \/>\n            nodes <span class=\"token operator\">&#061;<\/span> new_nodes<\/p>\n<p>        <span class=\"token comment\"># \u6bcf\u4e2a\u8282\u70b9\u4fdd\u7559\u6700\u5f3a\u54cd\u5e94\u70b9<\/span><br \/>\n        result <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">]<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> node <span class=\"token keyword\">in<\/span> nodes<span class=\"token punctuation\">:<\/span><br \/>\n            <span class=\"token keyword\">if<\/span> node<span class=\"token punctuation\">.<\/span>kps<span class=\"token punctuation\">:<\/span><br \/>\n                best <span class=\"token operator\">&#061;<\/span> <span class=\"token builtin\">max<\/span><span class=\"token punctuation\">(<\/span>node<span class=\"token punctuation\">.<\/span>kps<span class=\"token punctuation\">,<\/span> key<span class=\"token operator\">&#061;<\/span><span class=\"token keyword\">lambda<\/span> k<span class=\"token punctuation\">:<\/span> k<span class=\"token punctuation\">.<\/span>response<span class=\"token punctuation\">)<\/span><br \/>\n                result<span class=\"token punctuation\">.<\/span>append<span class=\"token punctuation\">(<\/span>best<span class=\"token punctuation\">)<\/span><br \/>\n        <span class=\"token keyword\">return<\/span> result<\/p>\n<h3>\u56db\u3001PnP\u4f4d\u59ff\u4f30\u8ba1<\/h3>\n<p><span class=\"token keyword\">def<\/span> <span class=\"token function\">estimate_pose_ransac<\/span><span class=\"token punctuation\">(<\/span>pts_3d<span class=\"token punctuation\">,<\/span> pts_2d<span class=\"token punctuation\">,<\/span> K<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n    <span class=\"token triple-quoted-string string\">&#034;&#034;&#034;EPnP &#043; RANSAC: 3D-2D\u5339\u914d\u4f30\u8ba1\u76f8\u673a\u4f4d\u59ff&#034;&#034;&#034;<\/span><br \/>\n    <span class=\"token comment\"># \u964d\u7ea7\u65b9\u68481: \u75283D-2D PnP<\/span><br \/>\n    success<span class=\"token punctuation\">,<\/span> rvec<span class=\"token punctuation\">,<\/span> tvec<span class=\"token punctuation\">,<\/span> inliers <span class=\"token operator\">&#061;<\/span> cv2<span class=\"token punctuation\">.<\/span>solvePnPRansac<span class=\"token punctuation\">(<\/span><br \/>\n        pts_3d<span class=\"token punctuation\">,<\/span> pts_2d<span class=\"token punctuation\">,<\/span> K<span class=\"token punctuation\">,<\/span> <span class=\"token boolean\">None<\/span><span class=\"token punctuation\">,<\/span><br \/>\n        iterationsCount<span class=\"token operator\">&#061;<\/span><span class=\"token number\">100<\/span><span class=\"token punctuation\">,<\/span><br \/>\n        reprojectionError<span class=\"token operator\">&#061;<\/span><span class=\"token number\">4.0<\/span><span class=\"token punctuation\">,<\/span><br \/>\n        confidence<span class=\"token operator\">&#061;<\/span><span class=\"token number\">0.99<\/span><span class=\"token punctuation\">,<\/span><br \/>\n        flags<span class=\"token operator\">&#061;<\/span>cv2<span class=\"token punctuation\">.<\/span>SOLVEPNP_EPNP<br \/>\n    <span class=\"token punctuation\">)<\/span><\/p>\n<p>    <span class=\"token keyword\">if<\/span> success<span class=\"token punctuation\">:<\/span><br \/>\n        R<span class=\"token punctuation\">,<\/span> _ <span class=\"token operator\">&#061;<\/span> cv2<span class=\"token punctuation\">.<\/span>Rodrigues<span class=\"token punctuation\">(<\/span>rvec<span class=\"token punctuation\">)<\/span><br \/>\n        T <span class=\"token operator\">&#061;<\/span> np<span class=\"token punctuation\">.<\/span>eye<span class=\"token punctuation\">(<\/span><span class=\"token number\">4<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">;<\/span> T<span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">:<\/span><span class=\"token number\">3<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token punctuation\">:<\/span><span class=\"token number\">3<\/span><span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> R<span class=\"token punctuation\">;<\/span> T<span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">:<\/span><span class=\"token number\">3<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> tvec<span class=\"token punctuation\">.<\/span>flatten<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><br \/>\n        <span class=\"token keyword\">return<\/span> T<span class=\"token punctuation\">,<\/span> <span class=\"token builtin\">len<\/span><span class=\"token punctuation\">(<\/span>inliers<span class=\"token punctuation\">)<\/span><\/p>\n<p>    <span class=\"token comment\"># \u964d\u7ea7\u65b9\u68482: \u5355\u5e94\u77e9\u9635(\u5e73\u9762\u573a\u666f)<\/span><br \/>\n    <span class=\"token keyword\">if<\/span> <span class=\"token builtin\">len<\/span><span class=\"token punctuation\">(<\/span>pts_2d<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&gt;&#061;<\/span> <span class=\"token number\">4<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        H<span class=\"token punctuation\">,<\/span> mask <span class=\"token operator\">&#061;<\/span> cv2<span class=\"token punctuation\">.<\/span>findHomography<span class=\"token punctuation\">(<\/span>pts_3d<span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">:<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token punctuation\">:<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">,<\/span> pts_2d<span class=\"token punctuation\">,<\/span> cv2<span class=\"token punctuation\">.<\/span>RANSAC<span class=\"token punctuation\">,<\/span> <span class=\"token number\">4.0<\/span><span class=\"token punctuation\">)<\/span><br \/>\n        <span class=\"token keyword\">if<\/span> H <span class=\"token keyword\">is<\/span> <span class=\"token keyword\">not<\/span> <span class=\"token boolean\">None<\/span><span class=\"token punctuation\">:<\/span><br \/>\n            <span class=\"token comment\"># \u4eceH\u5206\u89e3\u4f4d\u59ff<\/span><br \/>\n            solutions <span class=\"token operator\">&#061;<\/span> cv2<span class=\"token punctuation\">.<\/span>decomposeHomographyMat<span class=\"token punctuation\">(<\/span>H<span class=\"token punctuation\">,<\/span> K<span class=\"token punctuation\">)<\/span><br \/>\n            <span class=\"token keyword\">return<\/span> solutions<span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">,<\/span> mask<span class=\"token punctuation\">.<\/span><span class=\"token builtin\">sum<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p>    <span class=\"token keyword\">return<\/span> <span class=\"token boolean\">None<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0<\/span><\/p>\n<h3>\u4e94\u3001\u5c40\u90e8BA\u4f18\u5316<\/h3>\n<p><span class=\"token keyword\">import<\/span> g2o<\/p>\n<p><span class=\"token keyword\">class<\/span> <span class=\"token class-name\">BundleAdjustment<\/span><span class=\"token punctuation\">:<\/span><br \/>\n    <span class=\"token keyword\">def<\/span> <span class=\"token function\">optimize<\/span><span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">,<\/span> keyframes<span class=\"token punctuation\">,<\/span> mappoints<span class=\"token punctuation\">,<\/span> fixed_kf_id<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        optimizer <span class=\"token operator\">&#061;<\/span> g2o<span class=\"token punctuation\">.<\/span>SparseOptimizer<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><br \/>\n        solver <span class=\"token operator\">&#061;<\/span> g2o<span class=\"token punctuation\">.<\/span>BlockSolverSE3<span class=\"token punctuation\">(<\/span>g2o<span class=\"token punctuation\">.<\/span>LinearSolverEigenSE3<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><br \/>\n        optimizer<span class=\"token punctuation\">.<\/span>set_algorithm<span class=\"token punctuation\">(<\/span>g2o<span class=\"token punctuation\">.<\/span>OptimizationAlgorithmLevenberg<span class=\"token punctuation\">(<\/span>solver<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p>        <span class=\"token comment\"># \u6dfb\u52a0\u76f8\u673a\u9876\u70b9<\/span><br \/>\n        kf_vertices <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">{<\/span><span class=\"token punctuation\">}<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> kf <span class=\"token keyword\">in<\/span> keyframes<span class=\"token punctuation\">:<\/span><br \/>\n            v <span class=\"token operator\">&#061;<\/span> g2o<span class=\"token punctuation\">.<\/span>VertexSE3Expmap<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><br \/>\n            v<span class=\"token punctuation\">.<\/span>set_id<span class=\"token punctuation\">(<\/span>kf<span class=\"token punctuation\">.<\/span><span class=\"token builtin\">id<\/span><span class=\"token punctuation\">)<\/span><br \/>\n            v<span class=\"token punctuation\">.<\/span>set_estimate<span class=\"token punctuation\">(<\/span>g2o<span class=\"token punctuation\">.<\/span>SE3Quat<span class=\"token punctuation\">(<\/span>kf<span class=\"token punctuation\">.<\/span>R<span class=\"token punctuation\">,<\/span> kf<span class=\"token punctuation\">.<\/span>t<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><br \/>\n            v<span class=\"token punctuation\">.<\/span>set_fixed<span class=\"token punctuation\">(<\/span>kf<span class=\"token punctuation\">.<\/span><span class=\"token builtin\">id<\/span> <span class=\"token operator\">&#061;&#061;<\/span> fixed_kf_id<span class=\"token punctuation\">)<\/span><br \/>\n            optimizer<span class=\"token punctuation\">.<\/span>add_vertex<span class=\"token punctuation\">(<\/span>v<span class=\"token punctuation\">)<\/span><br \/>\n            kf_vertices<span class=\"token punctuation\">[<\/span>kf<span class=\"token punctuation\">.<\/span><span class=\"token builtin\">id<\/span><span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> v<\/p>\n<p>        <span class=\"token comment\"># \u6dfb\u52a0\u5730\u56fe\u70b9\u9876\u70b9<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> mp <span class=\"token keyword\">in<\/span> mappoints<span class=\"token punctuation\">:<\/span><br \/>\n            v <span class=\"token operator\">&#061;<\/span> g2o<span class=\"token punctuation\">.<\/span>VertexPointXYZ<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><br \/>\n            v<span class=\"token punctuation\">.<\/span>set_id<span class=\"token punctuation\">(<\/span>mp<span class=\"token punctuation\">.<\/span><span class=\"token builtin\">id<\/span> <span class=\"token operator\">&#043;<\/span> <span class=\"token number\">10000<\/span><span class=\"token punctuation\">)<\/span><br \/>\n            v<span class=\"token punctuation\">.<\/span>set_estimate<span class=\"token punctuation\">(<\/span>mp<span class=\"token punctuation\">.<\/span>position<span class=\"token punctuation\">)<\/span><br \/>\n            v<span class=\"token punctuation\">.<\/span>set_marginalized<span class=\"token punctuation\">(<\/span><span class=\"token boolean\">True<\/span><span class=\"token punctuation\">)<\/span><br \/>\n            optimizer<span class=\"token punctuation\">.<\/span>add_vertex<span class=\"token punctuation\">(<\/span>v<span class=\"token punctuation\">)<\/span><\/p>\n<p>        <span class=\"token comment\"># \u6dfb\u52a0\u91cd\u6295\u5f71\u8fb9<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> kf <span class=\"token keyword\">in<\/span> keyframes<span class=\"token punctuation\">:<\/span><br \/>\n            <span class=\"token keyword\">for<\/span> mp_id<span class=\"token punctuation\">,<\/span> <span class=\"token punctuation\">(<\/span>kp<span class=\"token punctuation\">,<\/span> _<span class=\"token punctuation\">)<\/span> <span class=\"token keyword\">in<\/span> kf<span class=\"token punctuation\">.<\/span>observations<span class=\"token punctuation\">.<\/span>items<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n                <span class=\"token keyword\">if<\/span> mp_id <span class=\"token keyword\">in<\/span> mappoints<span class=\"token punctuation\">:<\/span><br \/>\n                    edge <span class=\"token operator\">&#061;<\/span> g2o<span class=\"token punctuation\">.<\/span>EdgeSE3ProjectXYZ<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><br \/>\n                    edge<span class=\"token punctuation\">.<\/span>set_vertex<span class=\"token punctuation\">(<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> kf_vertices<span class=\"token punctuation\">[<\/span>kf<span class=\"token punctuation\">.<\/span><span class=\"token builtin\">id<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">)<\/span><br \/>\n                    edge<span class=\"token punctuation\">.<\/span>set_vertex<span class=\"token punctuation\">(<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">,<\/span> optimizer<span class=\"token punctuation\">.<\/span>vertex<span class=\"token punctuation\">(<\/span>mp_id <span class=\"token operator\">&#043;<\/span> <span class=\"token number\">10000<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><br \/>\n                    edge<span class=\"token punctuation\">.<\/span>set_measurement<span class=\"token punctuation\">(<\/span>kp<span class=\"token punctuation\">.<\/span>pt<span class=\"token punctuation\">)<\/span><br \/>\n                    edge<span class=\"token punctuation\">.<\/span>set_information<span class=\"token punctuation\">(<\/span>np<span class=\"token punctuation\">.<\/span>eye<span class=\"token punctuation\">(<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><br \/>\n                    edge<span class=\"token punctuation\">.<\/span>set_parameter_id<span class=\"token punctuation\">(<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> K<span class=\"token punctuation\">)<\/span>  <span class=\"token comment\"># \u5185\u53c2<\/span><br \/>\n                    optimizer<span class=\"token punctuation\">.<\/span>add_edge<span class=\"token punctuation\">(<\/span>edge<span class=\"token punctuation\">)<\/span><\/p>\n<p>        optimizer<span class=\"token punctuation\">.<\/span>initialize_optimization<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><br \/>\n        optimizer<span class=\"token punctuation\">.<\/span>optimize<span class=\"token punctuation\">(<\/span><span class=\"token number\">10<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p>        <span class=\"token comment\"># \u66f4\u65b0\u4f4d\u59ff\u548c\u5730\u56fe\u70b9<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> kf <span class=\"token keyword\">in<\/span> keyframes<span class=\"token punctuation\">:<\/span><br \/>\n            kf<span class=\"token punctuation\">.<\/span>set_pose<span class=\"token punctuation\">(<\/span>kf_vertices<span class=\"token punctuation\">[<\/span>kf<span class=\"token punctuation\">.<\/span><span class=\"token builtin\">id<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">.<\/span>estimate<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<h3>\u516d\u3001\u56de\u73af\u68c0\u6d4b(DBoW2\u8bcd\u888b)<\/h3>\n<p><span class=\"token comment\"># \u8bcd\u888b\u6a21\u578b&#xff1a;ORB\u63cf\u8ff0\u5b50\u2192\u89c6\u89c9\u8bcd\u6c47\u2192BoW\u5411\u91cf<\/span><br \/>\n<span class=\"token comment\"># \u76f8\u4f3c\u5ea6&gt;\u9608\u503c \u2192 \u56de\u73af\u5019\u9009 \u2192 Sim3\u9a8c\u8bc1 \u2192 \u4f4d\u59ff\u56fe\u4f18\u5316<\/span><\/p>\n<p><span class=\"token keyword\">class<\/span> <span class=\"token class-name\">LoopDetector<\/span><span class=\"token punctuation\">:<\/span><br \/>\n    <span class=\"token keyword\">def<\/span> <span class=\"token function\">__init__<\/span><span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">,<\/span> vocabulary_path<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>vocab <span class=\"token operator\">&#061;<\/span> cv2<span class=\"token punctuation\">.<\/span>BOWKMeansTrainer<span class=\"token punctuation\">.<\/span>load<span class=\"token punctuation\">(<\/span>vocabulary_path<span class=\"token punctuation\">)<\/span><\/p>\n<p>    <span class=\"token keyword\">def<\/span> <span class=\"token function\">detect<\/span><span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">,<\/span> current_frame<span class=\"token punctuation\">,<\/span> all_keyframes<span class=\"token punctuation\">,<\/span> min_score<span class=\"token operator\">&#061;<\/span><span class=\"token number\">0.3<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        <span class=\"token comment\"># \u7f16\u7801\u5f53\u524d\u5e27<\/span><br \/>\n        current_bow <span class=\"token operator\">&#061;<\/span> self<span class=\"token punctuation\">.<\/span>_compute_bow<span class=\"token punctuation\">(<\/span>current_frame<span class=\"token punctuation\">.<\/span>descriptors<span class=\"token punctuation\">)<\/span><\/p>\n<p>        <span class=\"token comment\"># \u4e0e\u6240\u6709\u5386\u53f2\u5173\u952e\u5e27\u6bd4\u8f83<\/span><br \/>\n        candidates <span class=\"token operator\">&#061;<\/span> <span class=\"token punctuation\">[<\/span><span class=\"token punctuation\">]<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> kf <span class=\"token keyword\">in<\/span> all_keyframes<span class=\"token punctuation\">:<\/span><br \/>\n            score <span class=\"token operator\">&#061;<\/span> self<span class=\"token punctuation\">.<\/span>_bow_similarity<span class=\"token punctuation\">(<\/span>current_bow<span class=\"token punctuation\">,<\/span> kf<span class=\"token punctuation\">.<\/span>bow<span class=\"token punctuation\">)<\/span><br \/>\n            <span class=\"token keyword\">if<\/span> score <span class=\"token operator\">&gt;<\/span> min_score<span class=\"token punctuation\">:<\/span><br \/>\n                candidates<span class=\"token punctuation\">.<\/span>append<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">(<\/span>kf<span class=\"token punctuation\">,<\/span> score<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p>        <span class=\"token comment\"># \u7ec4\u4e00\u81f4\u6027\u68c0\u67e5(\u8fde\u7eed3\u5e27\u68c0\u6d4b\u5230\u540c\u7ec4)<\/span><br \/>\n        groups <span class=\"token operator\">&#061;<\/span> self<span class=\"token punctuation\">.<\/span>_group_consistency<span class=\"token punctuation\">(<\/span>candidates<span class=\"token punctuation\">)<\/span><\/p>\n<p>        <span class=\"token comment\"># \u51e0\u4f55\u9a8c\u8bc1(Sim3)<\/span><br \/>\n        <span class=\"token keyword\">for<\/span> group <span class=\"token keyword\">in<\/span> groups<span class=\"token punctuation\">:<\/span><br \/>\n            best_kf <span class=\"token operator\">&#061;<\/span> <span class=\"token builtin\">max<\/span><span class=\"token punctuation\">(<\/span>group<span class=\"token punctuation\">,<\/span> key<span class=\"token operator\">&#061;<\/span><span class=\"token keyword\">lambda<\/span> x<span class=\"token punctuation\">:<\/span> x<span class=\"token punctuation\">[<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">]<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">]<\/span><br \/>\n            <span class=\"token comment\"># 3D-3D RANSAC\u9a8c\u8bc1<\/span><br \/>\n            <span class=\"token keyword\">if<\/span> self<span class=\"token punctuation\">.<\/span>_geometric_verification<span class=\"token punctuation\">(<\/span>current_frame<span class=\"token punctuation\">,<\/span> best_kf<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n                <span class=\"token keyword\">return<\/span> best_kf<\/p>\n<p>        <span class=\"token keyword\">return<\/span> <span class=\"token boolean\">None<\/span><\/p>\n<h3>\u4e03\u3001ROS2\u96c6\u6210<\/h3>\n<p><span class=\"token keyword\">import<\/span> rclpy<br \/>\n<span class=\"token keyword\">from<\/span> rclpy<span class=\"token punctuation\">.<\/span>node <span class=\"token keyword\">import<\/span> Node<br \/>\n<span class=\"token keyword\">from<\/span> sensor_msgs<span class=\"token punctuation\">.<\/span>msg <span class=\"token keyword\">import<\/span> Image<br \/>\n<span class=\"token keyword\">from<\/span> geometry_msgs<span class=\"token punctuation\">.<\/span>msg <span class=\"token keyword\">import<\/span> PoseStamped<\/p>\n<p><span class=\"token keyword\">class<\/span> <span class=\"token class-name\">SLAMNode<\/span><span class=\"token punctuation\">(<\/span>Node<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n    <span class=\"token keyword\">def<\/span> <span class=\"token function\">__init__<\/span><span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        <span class=\"token builtin\">super<\/span><span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">.<\/span>__init__<span class=\"token punctuation\">(<\/span><span class=\"token string\">&#039;orb_slam3&#039;<\/span><span class=\"token punctuation\">)<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>slam <span class=\"token operator\">&#061;<\/span> ORBSLAM3<span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;\/path\/to\/vocabulary.txt&#034;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#034;\/path\/to\/config.yaml&#034;<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p>        self<span class=\"token punctuation\">.<\/span>create_subscription<span class=\"token punctuation\">(<\/span>Image<span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#039;\/camera\/color&#039;<\/span><span class=\"token punctuation\">,<\/span> self<span class=\"token punctuation\">.<\/span>rgb_callback<span class=\"token punctuation\">,<\/span> <span class=\"token number\">10<\/span><span class=\"token punctuation\">)<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>create_subscription<span class=\"token punctuation\">(<\/span>Image<span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#039;\/camera\/depth&#039;<\/span><span class=\"token punctuation\">,<\/span> self<span class=\"token punctuation\">.<\/span>depth_callback<span class=\"token punctuation\">,<\/span> <span class=\"token number\">10<\/span><span class=\"token punctuation\">)<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>pose_pub <span class=\"token operator\">&#061;<\/span> self<span class=\"token punctuation\">.<\/span>create_publisher<span class=\"token punctuation\">(<\/span>PoseStamped<span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#039;\/slam\/pose&#039;<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">10<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p>    <span class=\"token keyword\">def<\/span> <span class=\"token function\">rgb_callback<\/span><span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">,<\/span> msg<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        cv_image <span class=\"token operator\">&#061;<\/span> self<span class=\"token punctuation\">.<\/span>bridge<span class=\"token punctuation\">.<\/span>imgmsg_to_cv2<span class=\"token punctuation\">(<\/span>msg<span class=\"token punctuation\">,<\/span> <span class=\"token string\">&#034;bgr8&#034;<\/span><span class=\"token punctuation\">)<\/span><br \/>\n        timestamp <span class=\"token operator\">&#061;<\/span> msg<span class=\"token punctuation\">.<\/span>header<span class=\"token punctuation\">.<\/span>stamp<span class=\"token punctuation\">.<\/span>sec <span class=\"token operator\">&#043;<\/span> msg<span class=\"token punctuation\">.<\/span>header<span class=\"token punctuation\">.<\/span>stamp<span class=\"token punctuation\">.<\/span>nanosec <span class=\"token operator\">*<\/span> <span class=\"token number\">1e-9<\/span><\/p>\n<p>        pose <span class=\"token operator\">&#061;<\/span> self<span class=\"token punctuation\">.<\/span>slam<span class=\"token punctuation\">.<\/span>track_rgbd<span class=\"token punctuation\">(<\/span>cv_image<span class=\"token punctuation\">,<\/span> self<span class=\"token punctuation\">.<\/span>last_depth<span class=\"token punctuation\">,<\/span> timestamp<span class=\"token punctuation\">)<\/span><\/p>\n<p>        <span class=\"token keyword\">if<\/span> pose <span class=\"token keyword\">is<\/span> <span class=\"token keyword\">not<\/span> <span class=\"token boolean\">None<\/span><span class=\"token punctuation\">:<\/span><br \/>\n            pose_msg <span class=\"token operator\">&#061;<\/span> PoseStamped<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><br \/>\n            pose_msg<span class=\"token punctuation\">.<\/span>header <span class=\"token operator\">&#061;<\/span> msg<span class=\"token punctuation\">.<\/span>header<br \/>\n            pose_msg<span class=\"token punctuation\">.<\/span>pose<span class=\"token punctuation\">.<\/span>position<span class=\"token punctuation\">.<\/span>x <span class=\"token operator\">&#061;<\/span> pose<span class=\"token punctuation\">[<\/span><span class=\"token number\">0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">]<\/span><br \/>\n            pose_msg<span class=\"token punctuation\">.<\/span>pose<span class=\"token punctuation\">.<\/span>position<span class=\"token punctuation\">.<\/span>y <span class=\"token operator\">&#061;<\/span> pose<span class=\"token punctuation\">[<\/span><span class=\"token number\">1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">]<\/span><br \/>\n            pose_msg<span class=\"token punctuation\">.<\/span>pose<span class=\"token punctuation\">.<\/span>position<span class=\"token punctuation\">.<\/span>z <span class=\"token operator\">&#061;<\/span> pose<span class=\"token punctuation\">[<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">3<\/span><span class=\"token punctuation\">]<\/span><br \/>\n            self<span class=\"token punctuation\">.<\/span>pose_pub<span class=\"token punctuation\">.<\/span>publish<span class=\"token punctuation\">(<\/span>pose_msg<span class=\"token punctuation\">)<\/span><\/p>\n<h3>\u516b\u3001\u603b\u7ed3<\/h3>\n<p>ORB-SLAM3\u4e09\u5927\u521b\u65b0&#xff1a;ORB\u7279\u5f81\u63d0\u53d6&#043;\u56db\u53c9\u6811\u5206\u5e03\u3001\u4e09\u7ebf\u7a0b\u5e76\u884c\u3001DBoW2\u56de\u73af&#043;\u5168\u5c40BA\u3002ROS2\u96c6\u6210\u540e\u53ef\u5b9e\u73b0\u5b9e\u65f6\u89c6\u89c9\u5b9a\u4f4d\u5efa\u56fe\u3002<\/p>\n","protected":false},"excerpt":{"rendered":"<p>ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218<br \/>\n\u4e00\u3001\u5f15\u8a00<br \/>\nSLAM(\u540c\u65f6\u5b9a\u4f4d\u4e0e\u5efa\u56fe)\u662f\u673a\u5668\u4eba\u548cAR\u7684\u6838\u5fc3\u3002ORB-SLAM3\u662f\u89c6\u89c9SLAM\u7684SOTA\u65b9\u6848&#xff0c;\u652f\u6301\u5355\u76ee\/\u53cc\u76ee\/RGB-DIMU\u878d\u5408&#xff0c;\u80fd\u5728\u52a8\u6001\u73af\u5883\u4e2d\u9c81\u68d2\u8fd0\u884c\u3002\u672c\u6587\u5c06\u89e3\u6790\u5176\u4e09\u5927\u7ebf\u7a0b\u5e76\u7ed9\u51faROS2\u96c6\u6210\u3002<br \/>\n\u4e8c\u3001\u4e09\u7ebf\u7a0b\u67b6\u6784<br \/>\n\u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510  \u5e27  \u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510  \u5173\u952e\u5e27  \u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510<br \/>\n\u2502  Tracking    \u2502\u2500\u2500\u2500\u2500\u2500\u2192\u2502 Loc<\/p>\n","protected":false},"author":2,"featured_media":0,"comment_status":"open","ping_status":"open","sticky":false,"template":"","format":"standard","meta":{"footnotes":""},"categories":[1],"tags":[81,50,190,86],"topic":[],"class_list":["post-87618","post","type-post","status-publish","format-standard","hentry","category-server","tag-python","tag-50","tag-190","tag-86"],"yoast_head":"<!-- This site is optimized with the Yoast SEO plugin v20.3 - https:\/\/yoast.com\/wordpress\/plugins\/seo\/ -->\n<title>ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218 - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3<\/title>\n<meta name=\"robots\" content=\"index, follow, max-snippet:-1, max-image-preview:large, max-video-preview:-1\" \/>\n<link rel=\"canonical\" href=\"https:\/\/www.wsisp.com\/helps\/87618.html\" \/>\n<meta property=\"og:locale\" content=\"zh_CN\" \/>\n<meta property=\"og:type\" content=\"article\" \/>\n<meta property=\"og:title\" content=\"ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218 - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\" \/>\n<meta property=\"og:description\" content=\"ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218 \u4e00\u3001\u5f15\u8a00 SLAM(\u540c\u65f6\u5b9a\u4f4d\u4e0e\u5efa\u56fe)\u662f\u673a\u5668\u4eba\u548cAR\u7684\u6838\u5fc3\u3002ORB-SLAM3\u662f\u89c6\u89c9SLAM\u7684SOTA\u65b9\u6848&#xff0c;\u652f\u6301\u5355\u76ee\/\u53cc\u76ee\/RGB-DIMU\u878d\u5408&#xff0c;\u80fd\u5728\u52a8\u6001\u73af\u5883\u4e2d\u9c81\u68d2\u8fd0\u884c\u3002\u672c\u6587\u5c06\u89e3\u6790\u5176\u4e09\u5927\u7ebf\u7a0b\u5e76\u7ed9\u51faROS2\u96c6\u6210\u3002 \u4e8c\u3001\u4e09\u7ebf\u7a0b\u67b6\u6784 \u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510 \u5e27 \u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510 \u5173\u952e\u5e27 \u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510 \u2502 Tracking  \u2502\u2500\u2500\u2500\u2500\u2500\u2192\u2502 Loc\" \/>\n<meta property=\"og:url\" content=\"https:\/\/www.wsisp.com\/helps\/87618.html\" \/>\n<meta property=\"og:site_name\" content=\"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\" \/>\n<meta property=\"article:published_time\" content=\"2026-07-30T07:27:05+00:00\" \/>\n<meta name=\"author\" content=\"admin\" \/>\n<meta name=\"twitter:card\" content=\"summary_large_image\" \/>\n<meta name=\"twitter:label1\" content=\"\u4f5c\u8005\" \/>\n\t<meta name=\"twitter:data1\" content=\"admin\" \/>\n\t<meta name=\"twitter:label2\" content=\"\u9884\u8ba1\u9605\u8bfb\u65f6\u95f4\" \/>\n\t<meta name=\"twitter:data2\" content=\"3 \u5206\" \/>\n<script type=\"application\/ld+json\" class=\"yoast-schema-graph\">{\"@context\":\"https:\/\/schema.org\",\"@graph\":[{\"@type\":\"WebPage\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/87618.html\",\"url\":\"https:\/\/www.wsisp.com\/helps\/87618.html\",\"name\":\"ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218 - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\",\"isPartOf\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/#website\"},\"datePublished\":\"2026-07-30T07:27:05+00:00\",\"dateModified\":\"2026-07-30T07:27:05+00:00\",\"author\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41\"},\"breadcrumb\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/87618.html#breadcrumb\"},\"inLanguage\":\"zh-Hans\",\"potentialAction\":[{\"@type\":\"ReadAction\",\"target\":[\"https:\/\/www.wsisp.com\/helps\/87618.html\"]}]},{\"@type\":\"BreadcrumbList\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/87618.html#breadcrumb\",\"itemListElement\":[{\"@type\":\"ListItem\",\"position\":1,\"name\":\"\u9996\u9875\",\"item\":\"https:\/\/www.wsisp.com\/helps\"},{\"@type\":\"ListItem\",\"position\":2,\"name\":\"ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218\"}]},{\"@type\":\"WebSite\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/#website\",\"url\":\"https:\/\/www.wsisp.com\/helps\/\",\"name\":\"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\",\"description\":\"\u9999\u6e2f\u670d\u52a1\u5668_\u9999\u6e2f\u4e91\u670d\u52a1\u5668\u8d44\u8baf_\u670d\u52a1\u5668\u5e2e\u52a9\u6587\u6863_\u670d\u52a1\u5668\u6559\u7a0b\",\"potentialAction\":[{\"@type\":\"SearchAction\",\"target\":{\"@type\":\"EntryPoint\",\"urlTemplate\":\"https:\/\/www.wsisp.com\/helps\/?s={search_term_string}\"},\"query-input\":\"required name=search_term_string\"}],\"inLanguage\":\"zh-Hans\"},{\"@type\":\"Person\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41\",\"name\":\"admin\",\"image\":{\"@type\":\"ImageObject\",\"inLanguage\":\"zh-Hans\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/image\/\",\"url\":\"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery\",\"contentUrl\":\"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery\",\"caption\":\"admin\"},\"sameAs\":[\"http:\/\/wp.wsisp.com\"],\"url\":\"https:\/\/www.wsisp.com\/helps\/author\/admin\"}]}<\/script>\n<!-- \/ Yoast SEO plugin. -->","yoast_head_json":{"title":"ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218 - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","robots":{"index":"index","follow":"follow","max-snippet":"max-snippet:-1","max-image-preview":"max-image-preview:large","max-video-preview":"max-video-preview:-1"},"canonical":"https:\/\/www.wsisp.com\/helps\/87618.html","og_locale":"zh_CN","og_type":"article","og_title":"ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218 - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","og_description":"ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218 \u4e00\u3001\u5f15\u8a00 SLAM(\u540c\u65f6\u5b9a\u4f4d\u4e0e\u5efa\u56fe)\u662f\u673a\u5668\u4eba\u548cAR\u7684\u6838\u5fc3\u3002ORB-SLAM3\u662f\u89c6\u89c9SLAM\u7684SOTA\u65b9\u6848&#xff0c;\u652f\u6301\u5355\u76ee\/\u53cc\u76ee\/RGB-DIMU\u878d\u5408&#xff0c;\u80fd\u5728\u52a8\u6001\u73af\u5883\u4e2d\u9c81\u68d2\u8fd0\u884c\u3002\u672c\u6587\u5c06\u89e3\u6790\u5176\u4e09\u5927\u7ebf\u7a0b\u5e76\u7ed9\u51faROS2\u96c6\u6210\u3002 \u4e8c\u3001\u4e09\u7ebf\u7a0b\u67b6\u6784 \u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510 \u5e27 \u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510 \u5173\u952e\u5e27 \u250c\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2500\u2510 \u2502 Tracking  \u2502\u2500\u2500\u2500\u2500\u2500\u2192\u2502 Loc","og_url":"https:\/\/www.wsisp.com\/helps\/87618.html","og_site_name":"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","article_published_time":"2026-07-30T07:27:05+00:00","author":"admin","twitter_card":"summary_large_image","twitter_misc":{"\u4f5c\u8005":"admin","\u9884\u8ba1\u9605\u8bfb\u65f6\u95f4":"3 \u5206"},"schema":{"@context":"https:\/\/schema.org","@graph":[{"@type":"WebPage","@id":"https:\/\/www.wsisp.com\/helps\/87618.html","url":"https:\/\/www.wsisp.com\/helps\/87618.html","name":"ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218 - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","isPartOf":{"@id":"https:\/\/www.wsisp.com\/helps\/#website"},"datePublished":"2026-07-30T07:27:05+00:00","dateModified":"2026-07-30T07:27:05+00:00","author":{"@id":"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41"},"breadcrumb":{"@id":"https:\/\/www.wsisp.com\/helps\/87618.html#breadcrumb"},"inLanguage":"zh-Hans","potentialAction":[{"@type":"ReadAction","target":["https:\/\/www.wsisp.com\/helps\/87618.html"]}]},{"@type":"BreadcrumbList","@id":"https:\/\/www.wsisp.com\/helps\/87618.html#breadcrumb","itemListElement":[{"@type":"ListItem","position":1,"name":"\u9996\u9875","item":"https:\/\/www.wsisp.com\/helps"},{"@type":"ListItem","position":2,"name":"ORB-SLAM3\u89c6\u89c9SLAM\u539f\u7406\u4e0eROS2\u5b9e\u6218"}]},{"@type":"WebSite","@id":"https:\/\/www.wsisp.com\/helps\/#website","url":"https:\/\/www.wsisp.com\/helps\/","name":"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","description":"\u9999\u6e2f\u670d\u52a1\u5668_\u9999\u6e2f\u4e91\u670d\u52a1\u5668\u8d44\u8baf_\u670d\u52a1\u5668\u5e2e\u52a9\u6587\u6863_\u670d\u52a1\u5668\u6559\u7a0b","potentialAction":[{"@type":"SearchAction","target":{"@type":"EntryPoint","urlTemplate":"https:\/\/www.wsisp.com\/helps\/?s={search_term_string}"},"query-input":"required name=search_term_string"}],"inLanguage":"zh-Hans"},{"@type":"Person","@id":"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41","name":"admin","image":{"@type":"ImageObject","inLanguage":"zh-Hans","@id":"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/image\/","url":"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery","contentUrl":"https:\/\/gravatar.wp-china-yes.net\/avatar\/?s=96&d=mystery","caption":"admin"},"sameAs":["http:\/\/wp.wsisp.com"],"url":"https:\/\/www.wsisp.com\/helps\/author\/admin"}]}},"_links":{"self":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/posts\/87618","targetHints":{"allow":["GET"]}}],"collection":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/posts"}],"about":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/types\/post"}],"author":[{"embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/users\/2"}],"replies":[{"embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/comments?post=87618"}],"version-history":[{"count":0,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/posts\/87618\/revisions"}],"wp:attachment":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/media?parent=87618"}],"wp:term":[{"taxonomy":"category","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/categories?post=87618"},{"taxonomy":"post_tag","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/tags?post=87618"},{"taxonomy":"topic","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/topic?post=87618"}],"curies":[{"name":"wp","href":"https:\/\/api.w.org\/{rel}","templated":true}]}}