<\/path> \n<\/svg> <\/p>\n\u4e00\u3001\u5f15\u5165<\/h3>\n
GraphSLAM\u662f\u89e3\u51b3\u5b8c\u6574\u7684slam\u95ee\u9898\u7684slam\u7b97\u6cd5\u3002\u8fd9\u610f\u5473\u7740\u8be5\u7b97\u6cd5\u5c06\u6062\u590d\u6574\u4e2a\u8def\u5f84\u548c\u5730\u56fe\uff0c\u800c\u4e0d\u4ec5\u4ec5\u662f\u6700\u8fd1\u7684\u59ff\u52bf\u548c\u5730\u56fe\u3002\u8fd9\u79cd\u5dee\u5f02\u4f7f\u5b83\u53ef\u4ee5\u8003\u8651\u5f53\u524d\u59ff\u52bf\u4e0e\u5148\u524d\u59ff\u52bf\u4e4b\u95f4\u7684\u4f9d\u8d56\u6027\u3002\u9002\u7528\u4e8e\u6211\u4eec\u7684GraphSLAM\u7684\u4e00\u4e2a\u793a\u4f8b\u662f\u5730\u4e0b\u91c7\u77ff\u3002\u6bcf\u5929\u90fd\u7528\u5728\u94bb\u5b54\u673a\u4e0a\u7684\u5927\u578b\u673a\u5668\u5728\u5ca9\u58c1\u4e0a\u5207\u5272\u3002\u73af\u5883\u77ac\u606f\u4e07\u53d8\uff0c\u4fdd\u6301\u6b63\u786e\u7684\u5de5\u4f5c\u7a7a\u95f4\u56fe\u975e\u5e38\u91cd\u8981\u3002\u6620\u5c04\u6b64\u7a7a\u95f4\u7684\u4e00\u79cd\u65b9\u6cd5\u662f\u5728\u5468\u56f4\u73af\u5883\u4e2d\u9a7e\u9a76\u88c5\u6709\u6fc0\u5149\u96f7\u8fbe\u7684\u8f66\u8f86\u5e76\u6536\u96c6\u6709\u5173\u5468\u56f4\u73af\u5883\u7684\u6570\u636e\u3002<\/p>\n
GraphSLAM \u7b97\u6cd5\u89e3\u51b3\u4e86\u5168SLAM \u95ee\u9898\u3002\u8be5\u7b97\u6cd5\u65e8\u5728\u89e3\u51b3\u5b9a\u4e49\u5728\u6240\u6709\u4f4d\u59ff\u548c\u5730\u56fe\u4e2d\u6240\u6709\u7279\u5f81\u4e0a\u7684\u79bb\u7ebf\u95ee\u9898\u3002<\/p>\n
\u4e8c\u3001GraphSLAM\u6a21\u578b<\/h3>\n1. \u6700\u5927\u4f3c\u7136\u4f30\u8ba1<\/h4>\n
GraphSLAM\u7684\u6838\u5fc3\u662f\u56fe\u5f62\u4f18\u5316-\u5c06\u56fe\u5f62\u4e2d\u6240\u6709\u7ea6\u675f\u4e2d\u5b58\u5728\u7684\u9519\u8bef\u6700\u5c0f\u5316\u7684\u8fc7\u7a0b\u3002\u8ba9\u6211\u4eec\u770b\u4e00\u4e0b\u8fd9\u4e9b\u7ea6\u675f\uff0c\u5e76\u5b66\u4e60\u5e94\u7528\u79f0\u4e3a\u6700\u5927\u4f3c\u7136\u4f30\u8ba1\uff08MLE\uff09\u7684\u539f\u7406\u6765\u6784\u9020\u548c\u89e3\u51b3\u56fe\u5f62\u7684\u4f18\u5316\u95ee\u9898\u3002<\/p>\n
\uff081\uff09\u7279\u5f81\u91cf\u6d4b\u793a\u4f8b<\/h5>\n
\u8ba9\u6211\u4eec\u770b\u4e00\u4e2a\u975e\u5e38\u7b80\u5355\u7684\u793a\u4f8b-\u6211\u4eec\u7684\u673a\u5668\u4eba\u5728\u73af\u5883\u4e2d\u91cd\u590d\u6d4b\u91cf\u529f\u80fd\u7684\u4e00\u4e2a\u793a\u4f8b\u3002\u672c\u793a\u4f8b\u5c06\u5f15\u5bfc\u60a8\u5b8c\u6210\u89e3\u51b3\u8be5\u95ee\u9898\u6240\u9700\u7684\u6b65\u9aa4\uff0c\u7136\u540e\u53ef\u4ee5\u5c06\u5176\u5e94\u7528\u4e8e\u66f4\u590d\u6742\u7684\u95ee\u9898\u3002<\/p>\n
\u673a\u5668\u4eba\u7684\u521d\u59cb\u59ff\u6001\u7684\u65b9\u5dee\u4e3a0-\u4ec5\u4ec5\u662f\u56e0\u4e3a\u8fd9\u662f\u673a\u5668\u4eba\u7684\u8d77\u59cb\u4f4d\u7f6e\u3002\u56de\u60f3\u4e00\u4e0b\u5f00\u59cb\u4f4d\u7f6e\u53ef\u80fd\u5728\u54ea\u91cc-\u6211\u4eec\u5728\u76f8\u5bf9\u5730\u56fe\u4e2d\u5c06\u5176\u79f0\u4e3a\u4f4d\u7f6e0\u3002\u6b64\u540e\u7684\u6bcf\u4e2a\u52a8\u4f5c\u59ff\u52bf\u548c\u6d4b\u91cf\u90fd\u4e0d\u786e\u5b9a\u3002\u5728GraphSLAM\u4e2d\uff0c\u6211\u4eec\u5c06\u7ee7\u7eed\u5047\u8bbe\u8fd0\u52a8\u548c\u6d4b\u91cf\u6570\u636e\u5177\u6709\u9ad8\u65af\u566a\u58f0\u3002<\/p>\n
\u673a\u5668\u4eba\u6d4b\u91cf\u4e00\u4e2a\u7279\u5f81\uff0c m 1 m_1 <\/span><\/span>m<\/span><\/span>1<\/span><\/span><\/span><\/span>\u200b<\/span><\/span><\/span><\/span><\/span><\/span><\/span><\/span><\/span><\/span><\/span><\/span>\uff0c\u8fd4\u56de\u8ddd\u79bb\u4e3a1.8\u7c73\u3002<\/p>\n\u5982\u679c\u6211\u4eec\u5c06\u8fd9\u4e2a\u7279\u5f81\u7c7b\u6bd4\u505a\u5f39\u7c27\u2014\u20141.8\u7c73\u662f\u5f39\u7c27\u7684\u9759\u6b62\u957f\u5ea6\u3002\u8fd9\u662f\u5f39\u7c27\u6700\u7406\u60f3\u7684\u957f\u5ea6\u3002\u7136\u800c\uff0c\u5f39\u7c27\u6709\u53ef\u80fd\u88ab\u538b\u7f29\u6216\u62c9\u957f\uff0c\u4ee5\u9002\u5e94\u4f5c\u7528\u4e8e\u7cfb\u7edf\u7684\u5176\u4ed6\u529b(\u7ea6\u675f)\u3002<\/p>\n
\u8fd9\u79cd\u6d4b\u91cf\u7684\u6982\u7387\u5206\u5e03\u53ef\u4ee5\u5b9a\u4e49\u4e3a\uff0c
p ( x ) = 1 \u03c3 2 \u03c0 e \u2212 1 2 ( z 1 \u2212 ( x 0 + 1.8 ) ) 2 \u03c3 2 p(x)=\\frac{1}{\u03c3\\sqrt{2\u03c0}}e^{-\\frac{1}{2}\\frac{(z_1\u2212(x_0+1.8))^2}{\u03c3^2}} <\/span><\/span>p<\/span>(<\/span>x<\/span>)<\/span><\/span>=<\/span><\/span><\/span><\/span><\/span><\/span>\u03c3<\/span><\/span>2<\/span>\u03c0<\/span><\/span><\/span><\/span>
\n