{"id":4464,"date":"2023-02-17T11:44:22","date_gmt":"2023-02-17T03:44:22","guid":{"rendered":"http:\/\/192.168.10.115\/index.php\/2023\/02\/17\/4464\/"},"modified":"2023-02-17T14:39:28","modified_gmt":"2023-02-17T06:39:28","slug":"%e5%8f%91%e5%b8%83%e4%ba%8e-2023-02-16-1600%e3%83%bbip-%e5%b1%9e%e5%9c%b0%e5%90%89%e6%9e%97%e8%87%aa%e5%8a%a8%e9%a9%be%e9%a9%b6%e4%b8%ad%e5%9d%90%e6%a0%87%e7%b3%bb%e8%bd%ac%e6%8d%a2%e7%ae%80%e4%bb%8b","status":"publish","type":"post","link":"http:\/\/222.128.65.89:18086\/index.php\/2023\/02\/17\/4464\/","title":{"rendered":"2023-02-16\u81ea\u52a8\u9a7e\u9a76\u4e2d\u5750\u6807\u7cfb\u8f6c\u6362\u7b80\u4ecb"},"content":{"rendered":"<p>\u5728\u81ea\u52a8\u9a7e\u9a76\u4e2d\uff0c\u7ecf\u5e38\u9700\u8981\u5728\u5404\u79cd\u5750\u6807\u7cfb\u4e0b\u6765\u56de\u8f6c\u6362\uff0c\u6b64\u65f6\u9700\u8981\u4e86\u89e3\u5750\u6807\u7cfb\u8f6c\u6362\u7684\u57fa\u672c\u6982\u5ff5\u53ca\u4f7f\u7528\u65b9\u6cd5\u3002<\/p>\n<p>\u4e00\u3001\u5750\u6807\u7cfb\u7684\u65cb\u8f6c\u53d8\u6362<\/p>\n<p>\u4ece\u4e00\u4e2a\u5750\u6807\u7cfb\u5230\u53e6\u4e00\u4e2a\u5750\u6807\u7cfb\u7684\u65cb\u8f6c\u8f6c\u6362\u6709\u591a\u79cd\u65b9\u6cd5\uff1a\u6b27\u62c9\u89d2\u6cd5\u3001\u65b9\u5411\u4f59\u5f26\u77e9\u9635\u6cd5\u3001\u56db\u5143\u6570\u6cd5\u7b49\u3002<\/p>\n<p>1\u3001\u6b27\u62c9\u89d2\u6cd5<\/p>\n<p>\u6838\u5fc3\u601d\u60f3\u662f\uff1a\u4e00\u4e2a\u5750\u6807\u7cfb\u53ef\u4ee5\u7528\u53e6\u4e00\u4e2a\u53c2\u8003\u5750\u6807\u7cfb\u7684\u4e09\u6b21\u7a7a\u95f4\u65cb\u8f6c\u6765\u8868\u8fbe\u6b27\u62c9\u89d2\u662f\u7531\u4e09\u4e2a\u89d2\u7ec4\u6210\uff0c\u8fd9\u4e09\u4e2a\u89d2\u5206\u522b\u662fYaw,Pitch,Roll\u3002<\/p>\n<p>\u5b9a\u4e49\u4e00\u4e2axyz\u5750\u6807\u7cfb\uff0c\u8fd9\u4e2a\u6211\u4eec\u79f0\u547c\u4e3a\u4e16\u754c\u5750\u6807\u7cfb\uff0c\u5148\u5728xy\u5e73\u9762\u91cc\u9762\u65cb\u8f6c\u53ef\u4ee5\u6709\u4e00\u4e2a\u77e9\u9635\u554a\u5373\u7ed5z\u8f74\uff0c\u518dxz\u5e73\u9762\u5185\u65cb\u8f6c\u5373\u7ed5y\u8f74\uff0c<\/p>\n<p>\u518d\u5728zy\u5e73\u9762\u5185\u65cb\u8f6c\u5373\u7ed5x\u8f74\uff0c\u8fd9\u5c31\u8f6c\u4e86\u4e09\u6b21\u4e86\uff0c\u4e09\u6b21\u7684\u77e9\u9635\u5982\u4f55\u64cd\u4f5c\u5462\uff0c\u4e0d\u65ad\u7684\u5de6\u4e58\u554a\uff08\u8fd9\u91cc\u5de6\u4e58\u662f\u6570\u5b66\u4e0a\u5b9a\u4e49\u7684\u95ee\u9898\uff0c\u65cb\u8f6c\u77e9\u9635\u90fd\u5de6\u4e58\uff09<\/p>\n<p>\u4f46\u662f\u6b27\u62c9\u89d2\u5bb9\u6613\u9020\u6210\u5947\u5f02\u6027\u95ee\u9898<\/p>\n<p><img decoding=\"async\" class=\"origin_image zh-lightbox-thumb\" src=\"\/wp-content\/uploads\/2023\/02\/v2-aa5f48affc03da13566e1fc82effb881_b.png\" width=\"534\" data-caption=\"\" data-size=\"normal\" data-rawwidth=\"534\" data-rawheight=\"60\" data-original=\"https:\/\/pic2.zhimg.com\/v2-aa5f48affc03da13566e1fc82effb881_r.jpg\" \/><\/p>\n<p>2\u3001\u56db\u5143\u7d20<\/p>\n<p>\u56db\u5143\u6570\u5e38\u7528\u4e8e\u8868\u793a\u4e09\u7ef4\u7a7a\u95f4\u7684\u65cb\u8f6c\u53d8\u6362\uff0c\u6ce8\u610f\u5b83\u8868\u793a\u4e00\u4e2a\u53d8\u6362\uff0c\u4e0d\u662f\u4e00\u4e2a\u72b6\u6001\u3002\u5e38\u4f7f\u7528Eigen::Quaterniond\u6765\u8868\u793a\u3002<\/p>\n<p>3\u5b83\u63cf\u8ff0\u4e86\u4e00\u4e2a\u65cb\u8f6c\u8f74[\u03b1, \u03b2, \u03b3]\u548c\u89d2\u03b8\uff0c\u5bf9\u5e94\u7684\u56db\u5143\u6570\u4e3aQ = [cos(\u03b8\/2), \u03b1*sin(\u03b8\/2), \u03b2*sin(\u03b8\/2), \u03b3*sin(\u03b8\/2)]\uff0c\u4e00\u822c\u6211\u4eec\u4f7f\u7528\u53f3\u624b\u5750\u6807\u7cfb\uff0c\u9006\u65f6\u9488\u65cb\u8f6c\u4e3a\u6b63\u3002<\/p>\n<p>\u4e0e\u5176\u5b83\u65cb\u8f6c\u8868\u793a\u65b9\u6cd5\u76f8\u6bd4\uff0c\u4f8b\u5982\u6b27\u62c9\u89d2\u3001\u77e9\u9635\uff0c\u56db\u5143\u6570\u5e76\u4e0d\u76f4\u89c2\uff0c\u4f46\u5177\u6709\u4ee5\u4e0b\u4f18\u70b9<\/p>\n<p>1\u3001\u56db\u5143\u6570\u4e0d\u5b58\u5728\u6b27\u62c9\u89d2\u4e2d\u7684 \u201cgimbal lock\u201d \u95ee\u9898\uff0c\u7ffb\u8bd1\u6210\u4e2d\u6587\u53eb\u201c\u4e07\u5411\u8282\u6b7b\u9501\u201d\uff0c\u540d\u5b57\u5f88\u88c5B\u6709\u6728\u6709\uff0c\u5176\u5b9e\u5c31\u662f\u5f53\u4e09\u4e2a\u8f74\u4e2d\u7684\u4e24\u4e2a\u8f74\u7531\u4e8e\u65cb\u8f6c\u91cd\u5408\u4e86\uff0c\u5bfc\u81f4\u65cb\u8f6c\u5931\u53bb\u4e86\u4e00\u4e2a\u81ea\u7531\u5ea6\u3002<\/p>\n<p>2\u3001\u56db\u5143\u6570\u53ea\u6709\u56db\u4e2a\u6570\uff0c\u77e9\u9635\u8868\u793a\u53d8\u6362\u4e00\u822c\u90fd\u662f 4*4 \u7684\uff0c\u5b58\u50a8\u8ba1\u7b97\u91cf\u66f4\u5c0f\u3002<\/p>\n<p>3\u3001\u4e24\u4e2a\u56db\u5143\u6570\u4e4b\u95f4\u66f4\u5bb9\u6613\u63d2\u503c\uff0c\u6bd4\u5982\u7403\u9762\u7ebf\u6027\u63d2\u503c\u3002<\/p>\n<p>\u4f46\u662f\u4e5f\u5b58\u5728\u4e00\u4e9b\u7f3a\u70b9<\/p>\n<p>\u56db\u5143\u7d20\u5728\u591a\u6b21\u8fd0\u7b97\u540e\uff0c\u4f1a\u5b58\u5728\u7d2f\u8ba1\u8bef\u5dee\uff0c\u9700\u8981\u5b9a\u671f\u5f52\u4e00\u5316\u5904\u7406\u3002<\/p>\n<p>\u56db\u5143\u6570\u662f\u9ad8\u7ef4\u7a7a\u95f4\u4e0b\u7684\u8868\u793a\u65b9\u6cd5\uff0c\u4f7f\u7528\u8005\u4e0d\u80fd\u76f4\u89c2\u5730\u7406\u89e3\u5176\u6240\u4ee3\u8868\u7684\u65cb\u8f6c\u8fc7\u7a0b\uff0c\u56e0\u6b64\u786e\u5b9a\u65cb\u8f6c\u8868\u8fbe\u5f0f\u662f\u4e00\u4ef6\u4ee4\u4eba\u5934\u75bc\u7684\u4e8b\u60c5\uff0c\u7ecf\u5e38\u4f1a\u51fa\u73b0\u9519\u8bef\u4e8c\u3001\u5750\u6807\u7cfb\u7684\u5e73\u79fb\u53d8\u6362\u5750\u6807\u539f\u70b9\u53d1\u751f\u53d8\u5316\uff0c\u800c\u5750\u6807\u8f74\u7684\u65b9\u5411\u4e0d\u53d1\u751f\u6539\u53d8\uff0c\u8fd9\u6837\u7684\u53d8\u5316\u6210\u4e3a\u5750\u6807\u7cfb\u7684\u5e73\u79fb\u53d8\u5316\u3002<\/p>\n<p>\u4e09\u3001\u5750\u6807\u7cfb\u7684\u6574\u4f53\u53d8\u6362<\/p>\n<p>\u6574\u4f53\u53d8\u6362\u5c31\u662f\u5e73\u79fb+\u65cb\u8f6c\u53d8\u6362\uff0c\u5728\u81ea\u52a8\u9a7e\u9a76\u9886\u57df\u4e2d\uff0c\u53d8\u6362\u901a\u5e38\u90fd\u662f\u521a\u4f53\u53d8\u6362\u7684\uff0c\u5e38\u5e38\u4f7f\u7528Eigen::Isometry3d\u6765\u8868\u793a\u3002<\/p>\n<p>\u628a\u6574\u4f53\u53d8\u6362\u7528\uff08R\uff0cT\uff09\u77e9\u9635\u5f62\u8c61\u8868\u793a\uff0c\u628a\u4f4d\u59ff\u53d8\u6362\u7528delt r\u4e0e delt t\u5c55\u5f00\uff0c\u5c31\u53ef\u4ee5\u53d1\u73b0\u6700\u672c\u8d28\u6838\u5fc3\u7684\u4e1c\u897f\uff1b<\/p>\n<p>\u65cb\u8f6c\u77e9\u9635\u7684\u5dee\u503c\u8ddf\u5750\u6807\u7cfb\u7684\u76f8\u5bf9\u5173\u7cfb \u6ca1\u6709\u5173\u7cfb\uff0c\u53ea\u8ddf\u89d2\u5ea6\u53d8\u6362\u6709\u5173\u3002<\/p>\n<p><img decoding=\"async\" class=\"origin_image zh-lightbox-thumb\" src=\"\/wp-content\/uploads\/2023\/02\/v2-8aa7560e1f1a56368b0288fac5a2cade_b.png\" width=\"1006\" data-caption=\"\" data-size=\"normal\" data-rawwidth=\"1006\" data-rawheight=\"97\" data-original=\"https:\/\/pic3.zhimg.com\/v2-8aa7560e1f1a56368b0288fac5a2cade_r.jpg\" \/><\/p>\n<p>\u56db\u3001\u4e3e\u4f8b\u8bf4\u660e<\/p>\n<p>\u5c06utm\u5750\u6807\u4e0b\u7684\u8f66\u9053\u7ebf\u70b9\u8f6c\u6362\u5230\u50cf\u7d20\u5750\u6807\u7cfb\u4e0b<\/p>\n<p><img decoding=\"async\" class=\"origin_image zh-lightbox-thumb\" src=\"\/wp-content\/uploads\/2023\/02\/v2-bd9f6fb49b888b5c088153d0601eecd8_b.jpg\" width=\"983\" data-size=\"normal\" data-rawwidth=\"983\" data-rawheight=\"435\" data-original=\"https:\/\/pic1.zhimg.com\/v2-bd9f6fb49b888b5c088153d0601eecd8_r.jpg\" \/>\u8f66\u8f86\u4fa7\u89c6\u56fe<\/p>\n<p><img decoding=\"async\" class=\"content_image\" src=\"\/wp-content\/uploads\/2023\/02\/v2-052509e7e78bab5b84983a306b5c5a76_b.jpg\" width=\"344\" data-size=\"normal\" data-rawwidth=\"344\" data-rawheight=\"544\" \/><\/p>\n<p>\u8f66\u8f86\u4fef\u89c6\u56fe<\/p>\n<p>\u8f6c\u6362\u8fc7\u7a0b<\/p>\n<p>utm\u5750\u6807-&gt;novatel\u5750\u6807-&gt;vehicle\u5750\u6807-&gt;\u2ecb\u5934\u5750\u6807-&gt;\u76f8\u673a\u5750\u6807 \uff1a\u7531\u5916\u53c2\u5b8c\u6210<\/p>\n<p>\u76f8\u673a\u5750\u6807-&gt;\u50cf\u7d20\u5750\u6807 \uff1a\u7531\u5185\u53c2\u5b8c\u6210\u3002<\/p>\n<p>\u83b7\u53d6\u5728\u76f8\u673a\u5750\u6807\u7cfb\u4e0b\u7684\u70b9\u7684\u5750\u6807camera_point=T_front_to_camera*T_vehicle_to_front*R_vehicle*T_novatel_to_vehicle*T_utm_to_novatel*utm_point<\/p>\n","protected":false},"excerpt":{"rendered":"<p>\u5728\u81ea\u52a8\u9a7e\u9a76\u4e2d\uff0c\u7ecf\u5e38\u9700\u8981\u5728\u5404\u79cd\u5750\u6807\u7cfb\u4e0b\u6765\u56de\u8f6c\u6362\uff0c [&hellip;]<\/p>\n","protected":false},"author":1,"featured_media":0,"comment_status":"open","ping_status":"open","sticky":false,"template":"","format":"standard","meta":{"footnotes":""},"categories":[3,1],"tags":[],"class_list":["post-4464","post","type-post","status-publish","format-standard","hentry","category-technology-frontier","category-home"],"views":6,"_links":{"self":[{"href":"http:\/\/222.128.65.89:18086\/index.php\/wp-json\/wp\/v2\/posts\/4464"}],"collection":[{"href":"http:\/\/222.128.65.89:18086\/index.php\/wp-json\/wp\/v2\/posts"}],"about":[{"href":"http:\/\/222.128.65.89:18086\/index.php\/wp-json\/wp\/v2\/types\/post"}],"author":[{"embeddable":true,"href":"http:\/\/222.128.65.89:18086\/index.php\/wp-json\/wp\/v2\/users\/1"}],"replies":[{"embeddable":true,"href":"http:\/\/222.128.65.89:18086\/index.php\/wp-json\/wp\/v2\/comments?post=4464"}],"version-history":[{"count":3,"href":"http:\/\/222.128.65.89:18086\/index.php\/wp-json\/wp\/v2\/posts\/4464\/revisions"}],"predecessor-version":[{"id":4516,"href":"http:\/\/222.128.65.89:18086\/index.php\/wp-json\/wp\/v2\/posts\/4464\/revisions\/4516"}],"wp:attachment":[{"href":"http:\/\/222.128.65.89:18086\/index.php\/wp-json\/wp\/v2\/media?parent=4464"}],"wp:term":[{"taxonomy":"category","embeddable":true,"href":"http:\/\/222.128.65.89:18086\/index.php\/wp-json\/wp\/v2\/categories?post=4464"},{"taxonomy":"post_tag","embeddable":true,"href":"http:\/\/222.128.65.89:18086\/index.php\/wp-json\/wp\/v2\/tags?post=4464"}],"curies":[{"name":"wp","href":"https:\/\/api.w.org\/{rel}","templated":true}]}}