{"id":54022,"date":"2025-08-12T20:49:47","date_gmt":"2025-08-12T12:49:47","guid":{"rendered":"https:\/\/www.wsisp.com\/helps\/54022.html"},"modified":"2025-08-12T20:49:47","modified_gmt":"2025-08-12T12:49:47","slug":"robotics_py-docs-%e6%9c%ba%e5%99%a8%e4%ba%ba%e7%8a%b6%e6%80%81-%e4%bd%8d%e5%a7%bf-%e7%8e%af%e5%a2%83%e8%a1%a8%e7%a4%ba_%e6%a0%85%e6%a0%bc%e5%9c%b0%e5%9b%be","status":"publish","type":"post","link":"https:\/\/www.wsisp.com\/helps\/54022.html","title":{"rendered":"[Robotics_py] docs | \u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff | \u73af\u5883\u8868\u793a_\u6805\u683c\u5730\u56fe"},"content":{"rendered":"<p>\u94fe\u63a5&#xff1a;https:\/\/atsushisakai.github.io\/PythonRobotics\/modules\/0_getting_started\/0_getting_started.html# <img decoding=\"async\" src=\"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2025\/08\/20250812124943-689b3867e7aa0.png\" alt=\"\u5728\u8fd9\u91cc\u63d2\u5165\u56fe\u7247\u63cf\u8ff0\" \/><\/p>\n<h2>docs&#xff1a;PythonRobotics<\/h2>\n<p>PythonRobotics \u662f\u4e00\u4e2a\u7efc\u5408\u6027\u7684\u673a\u5668\u4eba\u7b97\u6cd5\u5b9e\u73b0\u9879\u76ee&#xff0c;\u6f14\u793a\u4e86\u673a\u5668\u4eba\u5982\u4f55\u901a\u8fc7\u6805\u683c\u5730\u56fe\u7b49\u8868\u5f81\u65b9\u5f0f\u611f\u77e5\u73af\u5883&#xff0c;\u501f\u52a9\u5b9a\u4f4d\u6ee4\u6ce2\u5668\u7cbe\u786e\u4f30\u8ba1\u81ea\u8eab\u72b6\u6001\/\u4f4d\u59ff&#xff0c;\u5229\u7528\u8fd0\u52a8\u6a21\u578b\u9884\u6d4b\u79fb\u52a8\u8f68\u8ff9\u3002<\/p>\n<p>\u5176\u6838\u5fc3\u5c55\u793a\u4e86\u673a\u5668\u4eba\u5982\u4f55\u901a\u8fc7\u57fa\u4e8e\u641c\u7d22\u8282\u70b9\u7684\u591a\u6837\u5316\u8def\u5f84\u89c4\u5212\u7b97\u6cd5\u5236\u5b9a\u76ee\u6807\u8def\u7ebf&#xff0c;\u5e76\u901a\u8fc7\u8def\u5f84\u8ddf\u8e2a\u63a7\u5236\u5668\u751f\u6210\u63a7\u5236\u6307\u4ee4\u7cbe\u51c6\u6267\u884c\u89c4\u5212\u65b9\u6848\u3002<\/p>\n<h3>\u67b6\u6784\u603b\u89c8<\/h3>\n<p><img decoding=\"async\" src=\"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2025\/08\/20250812124944-689b3868d0d9b.png\" alt=\"\u5728\u8fd9\u91cc\u63d2\u5165\u56fe\u7247\u63cf\u8ff0\" \/><\/p>\n<h3>\u7ae0\u8282\u5bfc\u822a<\/h3>\n<li>\u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff<\/li>\n<li>\u73af\u5883\u8868\u793a&#xff08;\u6805\u683c\u5730\u56fe&#xff09;<\/li>\n<li>\u673a\u5668\u4eba\u8fd0\u52a8\u6a21\u578b<\/li>\n<li>\u5b9a\u4f4d\u6ee4\u6ce2\u5668<\/li>\n<li>\u8def\u5f84\u89c4\u5212\u7b97\u6cd5<\/li>\n<li>\u641c\u7d22\u8282\u70b9&#xff08;\u8def\u5f84\u89c4\u5212\u7528&#xff09;<\/li>\n<li>\u8def\u5f84\u8ddf\u8e2a\u63a7\u5236\u5668<\/li>\n<hr \/>\n<h2>\u7b2c\u4e00\u7ae0&#xff1a;\u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff<\/h2>\n<p>\u6b22\u8fce\u8fdb\u5165PythonRobotics\u7cfb\u5217&#xff01;<\/p>\n<p>\u672c\u7ae0\u6211\u4eec\u5c06\u6df1\u5165\u63a2\u8ba8\u673a\u5668\u4eba\u5b66\u4e2d\u6700\u57fa\u7840\u7684\u6982\u5ff5\u2014\u2014\u673a\u5668\u4eba\u72b6\u6001&#xff08;State&#xff09;\u6216**\u4f4d\u59ff**&#xff08;Pose&#xff09;\u3002<\/p>\n<p>\u8fd9\u76f8\u5f53\u4e8e\u673a\u5668\u4eba\u7684&#034;\u8eab\u4efd\u8bc1&#034;\u548c&#034;\u5b9e\u65f6\u72b6\u6001\u7b80\u62a5&#034;&#xff0c;\u7cbe\u786e\u8bb0\u5f55\u7740\u673a\u5668\u4eba\u7684\u7a7a\u95f4\u4f4d\u7f6e\u4e0e\u8fd0\u52a8\u7279\u6027\u3002<\/p>\n<h4>\u673a\u5668\u4eba\u72b6\u6001\u4e3a\u4f55\u5982\u6b64\u91cd\u8981&#xff1f;<\/h4>\n<p>\u60f3\u8c61\u5bb6\u7528\u626b\u5730\u673a\u5668\u4eba\u6267\u884c\u6e05\u6d01\u4efb\u52a1\u65f6&#xff0c;\u9700\u8981\u5b9e\u65f6\u638c\u63e1\u4ee5\u4e0b\u4fe1\u606f&#xff1a;<\/p>\n<ul>\n<li>\u5df2\u6e05\u6d01\u533a\u57df\u5b9a\u4f4d&#xff08;X\/Y\u5750\u6807&#xff09;<\/li>\n<li>\u884c\u8fdb\u65b9\u5411\u5224\u65ad&#xff08;\u504f\u822a\u89d2&#xff09;<\/li>\n<li>\u79fb\u52a8\u901f\u5ea6\u8c03\u8282&#xff08;\u901f\u5ea6\u53c2\u6570&#xff09;<\/li>\n<\/ul>\n<p>\u8fd9\u4e9b\u53c2\u6570\u6784\u6210\u7684\u5b8c\u6574\u72b6\u6001\u63cf\u8ff0&#xff0c;\u662f\u673a\u5668\u4eba\u6267\u884c\u8def\u5f84\u89c4\u5212\u3001\u907f\u969c\u7b49\u9ad8\u7ea7\u529f\u80fd\u7684\u57fa\u77f3\u3002\u82e5\u7f3a\u4e4f\u72b6\u6001\u611f\u77e5&#xff0c;\u673a\u5668\u4eba\u5c06\u5982\u540c\u76f2\u4eba\u5931\u53bb\u7a7a\u95f4\u8ba4\u77e5\u80fd\u529b<\/p>\n<h4>\u72b6\u6001\u53c2\u6570\u7ec4\u6210\u89e3\u6790<\/h4>\n<p>\u9488\u5bf9\u5730\u9762\u79fb\u52a8\u673a\u5668\u4eba&#xff08;\u5982\u8f66\u8f86\u3001\u65e0\u4eba\u673a&#xff09;&#xff0c;\u5178\u578b\u72b6\u6001\u5305\u542b\u56db\u4e2a\u6838\u5fc3\u7ef4\u5ea6&#xff1a;<\/p>\n<table>\n<tr>\u53c2\u6570\u7269\u7406\u610f\u4e49\u751f\u6d3b\u7c7b\u6bd4<\/tr>\n<tbody>\n<tr>\n<td>X\u5750\u6807<\/td>\n<td>\u4e1c\u897f\u8f74\u5411\u4f4d\u7f6e&#xff08;\u7c73&#xff09;<\/td>\n<td>\u8857\u9053\u95e8\u724c\u53f7<\/td>\n<\/tr>\n<tr>\n<td>Y\u5750\u6807<\/td>\n<td>\u5357\u5317\u8f74\u5411\u4f4d\u7f6e&#xff08;\u7c73&#xff09;<\/td>\n<td>\u697c\u5c42\u7f16\u53f7<\/td>\n<\/tr>\n<tr>\n<td>\u504f\u822a\u89d2<\/td>\n<td>\u671d\u5411\u65b9\u4f4d&#xff08;\u5f27\u5ea6\u5236&#xff0c;0\u901a\u5e38\u6307\u4e1c\u65b9&#xff09;<\/td>\n<td>\u4eba\u4f53\u9762\u90e8\u671d\u5411<\/td>\n<\/tr>\n<tr>\n<td>\u901f\u5ea6<\/td>\n<td>\u79fb\u52a8\u901f\u7387&#xff08;\u7c73\/\u79d2&#xff09;<\/td>\n<td>\u6b65\u884c\/\u9a7e\u9a76\u901f\u5ea6\u8868\u663e<\/td>\n<\/tr>\n<\/tbody>\n<\/table>\n<h4>\u4ee3\u7801\u5b9e\u73b0&#xff1a;\u72b6\u6001\u7c7b\u7ed3\u6784<\/h4>\n<p>\u5728PythonRobotics\u9879\u76ee\u4e2d&#xff0c;\u673a\u5668\u4eba\u72b6\u6001\u901a\u8fc7\u9762\u5411\u5bf9\u8c61\u7f16\u7a0b\u5c01\u88c5\u3002\u4ee5\u4e0b\u4ee3\u7801\u8282\u9009\u81eaPathPlanning\/ClosedLoopRRTStar\/unicycle_model.py&#xff0c;\u5c55\u793a\u5178\u578b\u5b9e\u73b0&#xff1a;<\/p>\n<p><span class=\"token keyword\">import<\/span> math  <span class=\"token comment\"># \u6570\u5b66\u8fd0\u7b97\u5e93<\/span><\/p>\n<p><span class=\"token keyword\">class<\/span> <span class=\"token class-name\">State<\/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> x<span class=\"token operator\">&#061;<\/span><span class=\"token number\">0.0<\/span><span class=\"token punctuation\">,<\/span> y<span class=\"token operator\">&#061;<\/span><span class=\"token number\">0.0<\/span><span class=\"token punctuation\">,<\/span> yaw<span class=\"token operator\">&#061;<\/span><span class=\"token number\">0.0<\/span><span class=\"token punctuation\">,<\/span> v<span class=\"token operator\">&#061;<\/span><span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>x <span class=\"token operator\">&#061;<\/span> x      <span class=\"token comment\"># \u4e1c\u5411\u5750\u6807&#xff08;\u7c73&#xff09;<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>y <span class=\"token operator\">&#061;<\/span> y      <span class=\"token comment\"># \u5317\u5411\u5750\u6807&#xff08;\u7c73&#xff09;<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>yaw <span class=\"token operator\">&#061;<\/span> yaw  <span class=\"token comment\"># \u504f\u822a\u89d2&#xff08;\u5f27\u5ea6&#xff09;<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>v <span class=\"token operator\">&#061;<\/span> v      <span class=\"token comment\"># \u7ebf\u901f\u5ea6&#xff08;\u7c73\/\u79d2&#xff09;<\/span><\/p>\n<p>\u5173\u952e\u89e3\u6790&#xff1a;<\/p>\n<ul>\n<li>\u7c7b\u6784\u9020\u51fd\u6570\u521d\u59cb\u5316\u9ed8\u8ba4\u5750\u6807\u539f\u70b9<\/li>\n<li>\u91c7\u7528\u56fd\u9645\u5355\u4f4d\u5236\u4fdd\u8bc1\u8ba1\u7b97\u4e00\u81f4\u6027<\/li>\n<li>\u504f\u822a\u89d2\u91c7\u7528\u5f27\u5ea6\u5236\u4fbf\u4e8e\u4e09\u89d2\u51fd\u6570\u8ba1\u7b97<\/li>\n<\/ul>\n<p>\u5b9e\u4f8b\u5316\u6f14\u793a&#xff1a;<\/p>\n<p><span class=\"token comment\"># \u521b\u5efa\u521d\u59cb\u72b6\u6001&#xff1a;\u5750\u6807(10,5)&#xff0c;45\u5ea6\u671d\u5411&#xff0c;\u901f\u5ea62m\/s<\/span><br \/>\nmy_robot <span class=\"token operator\">&#061;<\/span> State<span class=\"token punctuation\">(<\/span>x<span class=\"token operator\">&#061;<\/span><span class=\"token number\">10.0<\/span><span class=\"token punctuation\">,<\/span> y<span class=\"token operator\">&#061;<\/span><span class=\"token number\">5.0<\/span><span class=\"token punctuation\">,<\/span> yaw<span class=\"token operator\">&#061;<\/span>math<span class=\"token punctuation\">.<\/span>radians<span class=\"token punctuation\">(<\/span><span class=\"token number\">45<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">,<\/span> v<span class=\"token operator\">&#061;<\/span><span class=\"token number\">2.0<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p><span class=\"token comment\"># \u8f93\u51fa\u683c\u5f0f\u5316\u72b6\u6001\u4fe1\u606f<\/span><br \/>\n<span class=\"token keyword\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string-interpolation\"><span class=\"token string\">f&#034;X\u5750\u6807: <\/span><span class=\"token interpolation\"><span class=\"token punctuation\">{<\/span>my_robot<span class=\"token punctuation\">.<\/span>x<span class=\"token punctuation\">:<\/span><span class=\"token format-spec\">.2f<\/span><span class=\"token punctuation\">}<\/span><\/span><span class=\"token string\">m&#034;<\/span><\/span><span class=\"token punctuation\">)<\/span><br \/>\n<span class=\"token keyword\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string-interpolation\"><span class=\"token string\">f&#034;Y\u5750\u6807: <\/span><span class=\"token interpolation\"><span class=\"token punctuation\">{<\/span>my_robot<span class=\"token punctuation\">.<\/span>y<span class=\"token punctuation\">:<\/span><span class=\"token format-spec\">.2f<\/span><span class=\"token punctuation\">}<\/span><\/span><span class=\"token string\">m&#034;<\/span><\/span><span class=\"token punctuation\">)<\/span><br \/>\n<span class=\"token keyword\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string-interpolation\"><span class=\"token string\">f&#034;\u822a\u5411\u89d2: <\/span><span class=\"token interpolation\"><span class=\"token punctuation\">{<\/span>math<span class=\"token punctuation\">.<\/span>degrees<span class=\"token punctuation\">(<\/span>my_robot<span class=\"token punctuation\">.<\/span>yaw<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><span class=\"token format-spec\">.2f<\/span><span class=\"token punctuation\">}<\/span><\/span><span class=\"token string\">\u00b0&#034;<\/span><\/span><span class=\"token punctuation\">)<\/span><br \/>\n<span class=\"token keyword\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string-interpolation\"><span class=\"token string\">f&#034;\u77ac\u65f6\u901f\u5ea6: <\/span><span class=\"token interpolation\"><span class=\"token punctuation\">{<\/span>my_robot<span class=\"token punctuation\">.<\/span>v<span class=\"token punctuation\">:<\/span><span class=\"token format-spec\">.2f<\/span><span class=\"token punctuation\">}<\/span><\/span><span class=\"token string\">m\/s&#034;<\/span><\/span><span class=\"token punctuation\">)<\/span><\/p>\n<h4>\u72b6\u6001\u66f4\u65b0\u673a\u5236<\/h4>\n<p>\u673a\u5668\u4eba\u8fd0\u52a8\u901a\u8fc7\u8fd0\u52a8\u6a21\u578b\u5b9e\u73b0\u72b6\u6001\u8fed\u4ee3\u66f4\u65b0\u3002\u4ee5\u4e0b\u4ee3\u7801\u6bb5\u6765\u81eaunicycle_model.py&#xff0c;\u6f14\u793a\u5355\u6b65\u72b6\u6001\u9884\u6d4b&#xff1a;<\/p>\n<p>dt <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.05<\/span>   <span class=\"token comment\"># \u65f6\u95f4\u6b65\u957f&#xff08;\u79d2&#xff09;<\/span><br \/>\nL <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.9<\/span>     <span class=\"token comment\"># \u8f74\u8ddd\u53c2\u6570&#xff08;\u7c73&#xff09;<\/span><\/p>\n<p><span class=\"token keyword\">def<\/span> <span class=\"token function\">update<\/span><span class=\"token punctuation\">(<\/span>state<span class=\"token punctuation\">,<\/span> accel<span class=\"token punctuation\">,<\/span> delta<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n    <span class=\"token comment\"># \u4f4d\u7f6e\u66f4\u65b0<\/span><br \/>\n    state<span class=\"token punctuation\">.<\/span>x <span class=\"token operator\">&#043;&#061;<\/span> state<span class=\"token punctuation\">.<\/span>v <span class=\"token operator\">*<\/span> math<span class=\"token punctuation\">.<\/span>cos<span class=\"token punctuation\">(<\/span>state<span class=\"token punctuation\">.<\/span>yaw<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">*<\/span> dt<br \/>\n    state<span class=\"token punctuation\">.<\/span>y <span class=\"token operator\">&#043;&#061;<\/span> state<span class=\"token punctuation\">.<\/span>v <span class=\"token operator\">*<\/span> math<span class=\"token punctuation\">.<\/span>sin<span class=\"token punctuation\">(<\/span>state<span class=\"token punctuation\">.<\/span>yaw<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">*<\/span> dt<\/p>\n<p>    <span class=\"token comment\"># \u65b9\u5411\u66f4\u65b0<\/span><br \/>\n    state<span class=\"token punctuation\">.<\/span>yaw <span class=\"token operator\">&#043;&#061;<\/span> state<span class=\"token punctuation\">.<\/span>v<span class=\"token operator\">\/<\/span>L <span class=\"token operator\">*<\/span> math<span class=\"token punctuation\">.<\/span>tan<span class=\"token punctuation\">(<\/span>delta<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">*<\/span> dt<br \/>\n    state<span class=\"token punctuation\">.<\/span>yaw <span class=\"token operator\">&#061;<\/span> pi_2_pi<span class=\"token punctuation\">(<\/span>state<span class=\"token punctuation\">.<\/span>yaw<span class=\"token punctuation\">)<\/span>  <span class=\"token comment\"># \u89d2\u5ea6\u5f52\u4e00\u5316<\/span><\/p>\n<p>    <span class=\"token comment\"># \u901f\u5ea6\u66f4\u65b0<\/span><br \/>\n    state<span class=\"token punctuation\">.<\/span>v <span class=\"token operator\">&#043;&#061;<\/span> accel <span class=\"token operator\">*<\/span> dt<\/p>\n<p>    <span class=\"token keyword\">return<\/span> state<\/p>\n<p>\u53c2\u6570\u8bf4\u660e&#xff1a;<\/p>\n<ul>\n<li>accel: \u52a0\u901f\u5ea6&#xff08;m\/s\u00b2&#xff09;<\/li>\n<li>delta: \u524d\u8f6e\u8f6c\u5411\u89d2&#xff08;\u5f27\u5ea6&#xff09;<\/li>\n<li>pi_2_pi(): \u5c06\u89d2\u5ea6\u7ea6\u675f\u5728[-\u03c0, \u03c0]\u7684\u8f85\u52a9\u51fd\u6570<\/li>\n<\/ul>\n<p>\u8fd0\u52a8\u6a21\u62df\u793a\u4f8b&#xff1a;<\/p>\n<p><span class=\"token comment\"># \u89d2\u5ea6\u89c4\u7ea6\u51fd\u6570&#xff08;utils\/angle.py&#xff09;<\/span><br \/>\n<span class=\"token keyword\">def<\/span> <span class=\"token function\">pi_2_pi<\/span><span class=\"token punctuation\">(<\/span>angle<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n    <span class=\"token keyword\">return<\/span> <span class=\"token punctuation\">(<\/span>angle <span class=\"token operator\">&#043;<\/span> math<span class=\"token punctuation\">.<\/span>pi<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">%<\/span> <span class=\"token punctuation\">(<\/span><span class=\"token number\">2<\/span><span class=\"token operator\">*<\/span>math<span class=\"token punctuation\">.<\/span>pi<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">&#8211;<\/span> math<span class=\"token punctuation\">.<\/span>pi<\/p>\n<p><span class=\"token comment\"># \u521d\u59cb\u72b6\u6001&#xff1a;\u5750\u6807(10,5)&#xff0c;45\u5ea6\u822a\u5411&#xff0c;2m\/s<\/span><br \/>\ncurrent <span class=\"token operator\">&#061;<\/span> State<span class=\"token punctuation\">(<\/span><span class=\"token number\">10.0<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">5.0<\/span><span class=\"token punctuation\">,<\/span> math<span class=\"token punctuation\">.<\/span>radians<span class=\"token punctuation\">(<\/span><span class=\"token number\">45<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">2.0<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p><span class=\"token comment\"># \u65bd\u52a00.5m\/s\u00b2\u52a0\u901f&#xff0c;5\u5ea6\u53f3\u8f6c<\/span><br \/>\nupdated <span class=\"token operator\">&#061;<\/span> update<span class=\"token punctuation\">(<\/span>current<span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.5<\/span><span class=\"token punctuation\">,<\/span> math<span class=\"token punctuation\">.<\/span>radians<span class=\"token punctuation\">(<\/span><span class=\"token number\">5<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p><span class=\"token comment\"># \u8f93\u51fa\u72b6\u6001\u53d8\u5316<\/span><br \/>\n<span class=\"token keyword\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string-interpolation\"><span class=\"token string\">f&#034;X\u4f4d\u79fb\u589e\u91cf: <\/span><span class=\"token interpolation\"><span class=\"token punctuation\">{<\/span>updated<span class=\"token punctuation\">.<\/span>x <span class=\"token operator\">&#8211;<\/span> current<span class=\"token punctuation\">.<\/span>x<span class=\"token punctuation\">:<\/span><span class=\"token format-spec\">.3f<\/span><span class=\"token punctuation\">}<\/span><\/span><span class=\"token string\">m&#034;<\/span><\/span><span class=\"token punctuation\">)<\/span><br \/>\n<span class=\"token keyword\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string-interpolation\"><span class=\"token string\">f&#034;\u822a\u5411\u4fee\u6b63\u91cf: <\/span><span class=\"token interpolation\"><span class=\"token punctuation\">{<\/span>math<span class=\"token punctuation\">.<\/span>degrees<span class=\"token punctuation\">(<\/span>updated<span class=\"token punctuation\">.<\/span>yaw <span class=\"token operator\">&#8211;<\/span> current<span class=\"token punctuation\">.<\/span>yaw<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><span class=\"token format-spec\">.3f<\/span><span class=\"token punctuation\">}<\/span><\/span><span class=\"token string\">\u00b0&#034;<\/span><\/span><span class=\"token punctuation\">)<\/span><\/p>\n<h4>\u72b6\u6001\u8868\u5f81\u591a\u6837\u6027<\/h4>\n<p>\u4e0d\u540c\u5e94\u7528\u573a\u666f\u9700\u6269\u5c55\u72b6\u6001\u53c2\u6570&#xff1a;<\/p>\n<li>\n<p>\u65f6\u5e8f\u8def\u5f84\u89c4\u5212&#xff08;TimeBasedPathPlanning\/Node.py&#xff09;&#xff1a;<\/p>\n<p> <span class=\"token decorator annotation punctuation\">&#064;dataclass<\/span><br \/>\n<span class=\"token keyword\">class<\/span> <span class=\"token class-name\">Node<\/span><span class=\"token punctuation\">:<\/span><br \/>\n    pos<span class=\"token punctuation\">:<\/span> <span class=\"token builtin\">tuple<\/span>    <span class=\"token comment\"># (x,y)\u5750\u6807<\/span><br \/>\n    time<span class=\"token punctuation\">:<\/span> <span class=\"token builtin\">int<\/span>     <span class=\"token comment\"># \u5230\u8fbe\u65f6\u523b<\/span><br \/>\n    heuristic<span class=\"token punctuation\">:<\/span> <span class=\"token builtin\">float<\/span>  <span class=\"token comment\"># \u542f\u53d1\u5f0f\u4ee3\u4ef7<\/span><\/p>\n<p>\u5f3a\u8c03\u65f6\u95f4\u7ef4\u5ea6\u800c\u975e\u77ac\u65f6\u8fd0\u52a8\u72b6\u6001<\/p>\n<\/li>\n<li>\n<p>\u7eaf\u8ffd\u8e2a\u63a7\u5236&#xff08;pure_pursuit.py&#xff09;&#xff1a;<\/p>\n<p> <span class=\"token keyword\">class<\/span> <span class=\"token class-name\">EnhancedState<\/span><span class=\"token punctuation\">(<\/span>State<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> is_reverse<span class=\"token operator\">&#061;<\/span><span class=\"token boolean\">False<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">**<\/span>kwargs<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 operator\">**<\/span>kwargs<span class=\"token punctuation\">)<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>direction <span class=\"token operator\">&#061;<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1<\/span> <span class=\"token keyword\">if<\/span> is_reverse <span class=\"token keyword\">else<\/span> <span class=\"token number\">1<\/span><br \/>\n        <span class=\"token comment\"># \u8ba1\u7b97\u540e\u8f74\u4e2d\u5fc3&#xff08;\u63a7\u5236\u7b97\u6cd5\u9700\u8981&#xff09;<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>rear_x <span class=\"token operator\">&#061;<\/span> self<span class=\"token punctuation\">.<\/span>x <span class=\"token operator\">&#8211;<\/span> self<span class=\"token punctuation\">.<\/span>direction<span class=\"token operator\">*<\/span><span class=\"token punctuation\">(<\/span>L<span class=\"token operator\">\/<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>math<span class=\"token punctuation\">.<\/span>cos<span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">.<\/span>yaw<span class=\"token punctuation\">)<\/span><br \/>\n        self<span class=\"token punctuation\">.<\/span>rear_y <span class=\"token operator\">&#061;<\/span> self<span class=\"token punctuation\">.<\/span>y <span class=\"token operator\">&#8211;<\/span> self<span class=\"token punctuation\">.<\/span>direction<span class=\"token operator\">*<\/span><span class=\"token punctuation\">(<\/span>L<span class=\"token operator\">\/<\/span><span class=\"token number\">2<\/span><span class=\"token punctuation\">)<\/span><span class=\"token operator\">*<\/span>math<span class=\"token punctuation\">.<\/span>sin<span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">.<\/span>yaw<span class=\"token punctuation\">)<\/span><\/p>\n<p>\u589e\u52a0\u9006\u5411\u884c\u9a76\u6807\u5fd7\u4f4d\u548c\u540e\u8f74\u5750\u6807\u8ba1\u7b97<\/p>\n<\/li>\n<p><img decoding=\"async\" src=\"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2025\/08\/20250812124945-689b386992f67.png\" alt=\"\u5728\u8fd9\u91cc\u63d2\u5165\u56fe\u7247\u63cf\u8ff0\" \/><\/p>\n<h4>\u5c0f\u7ed3<\/h4>\n<p>\u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff\u662f\u6784\u5efa\u667a\u80fd\u79fb\u52a8\u7cfb\u7edf\u7684\u57fa\u77f3&#xff0c;\u5305\u542b\u7a7a\u95f4\u5750\u6807\u3001\u8fd0\u52a8\u65b9\u5411\u4e0e\u901f\u5ea6\u7b49\u6838\u5fc3\u53c2\u6570\u3002<\/p>\n<p>\u901a\u8fc7\u72b6\u6001\u7c7b\u5c01\u88c5\u548c\u8fd0\u52a8\u6a21\u578b\u8fed\u4ee3&#xff0c;\u5b9e\u73b0\u4e86\u673a\u5668\u4eba\u5bf9\u81ea\u8eab\u8fd0\u52a8\u72b6\u6001\u7684\u6301\u7eed\u8ba4\u77e5\u3002\u8fd9\u79cd\u57fa\u7840\u611f\u77e5\u80fd\u529b\u4e3a\u540e\u7eed\u73af\u5883\u5efa\u6a21\u3001\u8def\u5f84\u89c4\u5212\u7b49\u9ad8\u7ea7\u529f\u80fd\u5960\u5b9a\u57fa\u7840\u3002<\/p>\n<p>\u4e0b\u4e00\u7ae0&#xff1a;\u73af\u5883\u8868\u793a&#xff08;\u6805\u683c\u5730\u56fe&#xff09;<\/p>\n<hr \/>\n<h2>\u7b2c\u4e8c\u7ae0&#xff1a;\u73af\u5883\u8868\u793a&#xff08;\u6805\u683c\u5730\u56fe&#xff09;<\/h2>\n<p>\u5728\u7b2c\u4e00\u7ae0&#xff1a;\u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff\u4e2d&#xff0c;\u6211\u4eec\u5b66\u4e60\u4e86\u673a\u5668\u4eba\u5982\u4f55\u8ddf\u8e2a\u81ea\u8eab\u4f4d\u7f6e\u548c\u8fd0\u52a8\u72b6\u6001\u3002<\/p>\n<p>\u8fd9\u76f8\u5f53\u4e8e\u673a\u5668\u4eba\u7684&#034;\u8eab\u4efd\u8bc1&#034;\u3002\u4f46\u673a\u5668\u4eba\u5982\u4f55\u611f\u77e5\u5468\u56f4\u73af\u5883&#xff1f;\u5982\u4f55\u77e5\u9053\u5899\u9762\u4f4d\u7f6e\u6216\u969c\u788d\u7269\u5206\u5e03&#xff1f;<\/p>\n<p>\u8fd9\u6b63\u662f\u73af\u5883\u8868\u793a\u7684\u6838\u5fc3\u4ef7\u503c&#xff01;\u672c\u7ae0\u5c06\u805a\u7126\u673a\u5668\u4eba\u7406\u89e3\u73af\u5883\u7684\u5e38\u7528\u65b9\u6cd5\u2014\u2014\u6805\u683c\u5730\u56fe\u3002<\/p>\n<h3>\u4e3a\u4f55\u9700\u8981\u73af\u5883\u5730\u56fe&#xff1f;<\/h3>\n<p>\u4ee5\u626b\u5730\u673a\u5668\u4eba\u4e3a\u4f8b&#xff0c;\u4ec5\u77e5\u9053\u81ea\u8eab\u5750\u6807\u4e0d\u8db3\u4ee5\u6709\u6548\u5de5\u4f5c\u3002\u5b83\u9700\u8981&#xff1a;<\/p>\n<ul>\n<li>\u907f\u969c\u529f\u80fd&#xff1a;\u907f\u514d\u78b0\u649e\u5899\u58c1\u3001\u5bb6\u5177\u6216\u5ba0\u7269<\/li>\n<li>\u5bfc\u822a\u80fd\u529b&#xff1a;\u89c4\u5212\u623f\u95f4\u7a7f\u8d8a\u8def\u5f84<\/li>\n<li>\u6e05\u6d01\u8def\u5f84&#xff1a;\u8bbe\u8ba1\u5168\u8986\u76d6\u65e0\u6b7b\u89d2\u7684\u79fb\u52a8\u8f68\u8ff9<\/li>\n<\/ul>\n<p>\u6805\u683c\u5730\u56fe\u5982\u540c\u6570\u5b57\u5316\u7684\u73af\u5883\u84dd\u56fe&#xff0c;\u5c06\u7a7a\u95f4\u5212\u5206\u4e3a\u82e5\u5e72\u5355\u5143\u683c&#xff0c;\u6bcf\u4e2a\u5355\u5143\u5b58\u50a8\u7279\u5b9a\u4f4d\u7f6e\u7684\u73af\u5883\u4fe1\u606f\u3002<\/p>\n<hr \/>\n<h3>\u6805\u683c\u5730\u56fe\u6838\u5fc3\u8981\u7d20<\/h3>\n<p>\u6805\u683c\u5730\u56fe\u53ef\u7c7b\u6bd4\u4e3a\u7535\u5b50\u8868\u683c\u6216\u50cf\u7d20\u56fe\u50cf&#xff0c;\u5176\u6784\u6210\u8981\u7d20\u5305\u62ec&#xff1a;<\/p>\n<table>\n<tr>\u8981\u7d20\u63cf\u8ff0\u7c7b\u6bd4<\/tr>\n<tbody>\n<tr>\n<td align=\"left\">\u5355\u5143\u683c<\/td>\n<td align=\"left\">\u6784\u6210\u5730\u56fe\u7684\u57fa\u672c\u5355\u5143&#xff0c;\u4ee3\u8868\u771f\u5b9e\u4e16\u754c\u7684\u5fae\u5c0f\u533a\u57df<\/td>\n<td align=\"left\">\u68cb\u76d8\u65b9\u683c\u6216\u4f4e\u5206\u8fa8\u7387\u56fe\u50cf\u7684\u50cf\u7d20<\/td>\n<\/tr>\n<tr>\n<td align=\"left\">\u5206\u8fa8\u7387<\/td>\n<td align=\"left\">\u5355\u5143\u683c\u5bf9\u5e94\u7684\u771f\u5b9e\u5c3a\u5bf8&#xff08;\u59820.1m\u00d70.1m&#xff09;&#xff0c;\u6570\u503c\u8d8a\u5c0f\u7ec6\u8282\u8d8a\u4e30\u5bcc<\/td>\n<td align=\"left\">\u56fe\u50cf\u7f29\u653e\u7ea7\u522b<\/td>\n<\/tr>\n<tr>\n<td align=\"left\">\u6570\u503c\u7f16\u7801<\/td>\n<td align=\"left\">\u5355\u5143\u683c\u5b58\u50a8\u7684\u73af\u5883\u4fe1\u606f&#xff1a;<\/td>\n<td align=\"left\">\u7ed8\u753b\u4e2d\u7684\u8272\u5f69<\/td>\n<\/tr>\n<tr>\n<td align=\"left\"><\/td>\n<td align=\"left\">&#8211; \u5360\u7528(1.0)&#xff1a;\u5b58\u5728\u969c\u788d\u7269<\/td>\n<td align=\"left\">\u9ed1\u8272\u50cf\u7d20\u4ee3\u8868\u5899\u9762<\/td>\n<\/tr>\n<tr>\n<td align=\"left\"><\/td>\n<td align=\"left\">&#8211; \u81ea\u7531(0.0)&#xff1a;\u53ef\u901a\u884c\u533a\u57df<\/td>\n<td align=\"left\">\u767d\u8272\u50cf\u7d20\u4ee3\u8868\u5f00\u653e\u533a\u57df<\/td>\n<\/tr>\n<tr>\n<td align=\"left\"><\/td>\n<td align=\"left\">&#8211; \u672a\u77e5(0.5)&#xff1a;\u672a\u63a2\u7d22\u533a\u57df<\/td>\n<td align=\"left\">\u7070\u8272\u50cf\u7d20\u8868\u793a\u672a\u77e5\u533a\u57df<\/td>\n<\/tr>\n<tr>\n<td align=\"left\">\u5750\u6807\u539f\u70b9<\/td>\n<td align=\"left\">\u5730\u56fe\u5750\u6807\u7cfb\u4e0e\u771f\u5b9e\u4e16\u754c\u5750\u6807\u7cfb\u7684\u5bf9\u5e94\u5173\u7cfb<\/td>\n<td align=\"left\">\u5927\u5730\u56fe\u4e0a\u7684\u8d77\u59cb\u5b9a\u4f4d\u70b9<\/td>\n<\/tr>\n<\/tbody>\n<\/table>\n<hr \/>\n<h3>PythonRobotics\u6805\u683c\u5730\u56fe\u5b9e\u8df5<\/h3>\n<p>PythonRobotics\u7684GridMap\u7c7b&#xff08;\u4f4d\u4e8eMapping\/grid_map_lib\/grid_map_lib.py&#xff09;\u662f\u6784\u5efa\u6805\u683c\u5730\u56fe\u7684\u6838\u5fc3\u5de5\u5177\u3002\u4ee5\u4e0b\u793a\u4f8b\u5c55\u793a\u5982\u4f55\u521b\u5efa\u57fa\u7840\u5730\u56fe [7]&#xff1a;<\/p>\n<p><span class=\"token keyword\">import<\/span> numpy <span class=\"token keyword\">as<\/span> np<br \/>\n<span class=\"token keyword\">import<\/span> matplotlib<span class=\"token punctuation\">.<\/span>pyplot <span class=\"token keyword\">as<\/span> plt<br \/>\n<span class=\"token keyword\">from<\/span> Mapping<span class=\"token punctuation\">.<\/span>grid_map_lib<span class=\"token punctuation\">.<\/span>grid_map_lib <span class=\"token keyword\">import<\/span> GridMap<span class=\"token punctuation\">,<\/span> FloatGrid<\/p>\n<p><span class=\"token comment\"># 1. \u5b9a\u4e49\u5730\u56fe\u53c2\u6570<\/span><br \/>\nwidth_cells <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">100<\/span>       <span class=\"token comment\"># \u6a2a\u5411\u5355\u5143\u683c\u6570<\/span><br \/>\nheight_cells <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">120<\/span>      <span class=\"token comment\"># \u7eb5\u5411\u5355\u5143\u683c\u6570<\/span><br \/>\nresolution <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">0.5<\/span>        <span class=\"token comment\"># \u5355\u5143\u683c\u5206\u8fa8\u7387&#xff08;\u7c73&#xff09;<\/span><br \/>\ncenter_x <span class=\"token operator\">&#061;<\/span> <span class=\"token number\">10.0<\/span>         <span class=\"token comment\"># \u5730\u56fe\u4e2d\u5fc3\u771f\u5b9e\u5750\u6807X<\/span><br \/>\ncenter_y <span class=\"token operator\">&#061;<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">0.5<\/span>         <span class=\"token comment\"># \u5730\u56fe\u4e2d\u5fc3\u771f\u5b9e\u5750\u6807Y<\/span><\/p>\n<p><span class=\"token comment\"># 2. \u521b\u5efaGridMap\u5bf9\u8c61<\/span><br \/>\nmy_room_map <span class=\"token operator\">&#061;<\/span> GridMap<span class=\"token punctuation\">(<\/span>width_cells<span class=\"token punctuation\">,<\/span> height_cells<span class=\"token punctuation\">,<\/span> resolution<span class=\"token punctuation\">,<\/span><br \/>\n                      center_x<span class=\"token punctuation\">,<\/span> center_y<span class=\"token punctuation\">,<\/span> init_val<span class=\"token operator\">&#061;<\/span>FloatGrid<span class=\"token punctuation\">(<\/span><span class=\"token number\">0.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p><span class=\"token keyword\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string-interpolation\"><span class=\"token string\">f&#034;\u521b\u5efa\u5730\u56fe\u5c3a\u5bf8&#xff1a;<\/span><span class=\"token interpolation\"><span class=\"token punctuation\">{<\/span>width_cells<span class=\"token punctuation\">}<\/span><\/span><span class=\"token string\">x<\/span><span class=\"token interpolation\"><span class=\"token punctuation\">{<\/span>height_cells<span class=\"token punctuation\">}<\/span><\/span><span class=\"token string\">\u5355\u5143\u683c&#034;<\/span><\/span><span class=\"token punctuation\">)<\/span><br \/>\n<span class=\"token keyword\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string-interpolation\"><span class=\"token string\">f&#034;\u5730\u56fe\u5206\u8fa8\u7387&#xff1a;<\/span><span class=\"token interpolation\"><span class=\"token punctuation\">{<\/span>resolution<span class=\"token punctuation\">}<\/span><\/span><span class=\"token string\"> \u7c73\/\u5355\u5143\u683c&#034;<\/span><\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p>\u6280\u672f\u89e3\u6790&#xff1a;<\/p>\n<ul>\n<li>FloatGrid\u5c01\u88c5\u6d6e\u70b9\u6570\u503c&#xff0c;\u652f\u6301\u540e\u7eed\u6269\u5c55\u590d\u6742\u6570\u636e\u7c7b\u578b<\/li>\n<li>init_val&#061;FloatGrid(0.0)\u521d\u59cb\u5316\u5168\u56fe\u5355\u5143\u683c\u4e3a\u81ea\u7531\u72b6\u6001<\/li>\n<li>\u5750\u6807\u7cfb\u8f6c\u6362\u6a21\u5757\u5b9e\u73b0\u771f\u5b9e\u5750\u6807\u4e0e\u6805\u683c\u7d22\u5f15\u7684\u53cc\u5411\u6620\u5c04 [4]<\/li>\n<\/ul>\n<hr \/>\n<h3>\u969c\u788d\u7269\u6807\u6ce8\u65b9\u6cd5<\/h3>\n<p>\u901a\u8fc7\u771f\u5b9e\u5750\u6807\u6807\u6ce8\u969c\u788d\u7269\u793a\u4f8b&#xff1a;<\/p>\n<p><span class=\"token comment\"># \u6807\u6ce8\u969c\u788d\u7269\u5750\u6807&#xff08;1.0\u8868\u793a\u5360\u7528\u72b6\u6001&#xff09;<\/span><br \/>\nmy_room_map<span class=\"token punctuation\">.<\/span>set_value_from_xy_pos<span class=\"token punctuation\">(<\/span><span class=\"token number\">10.1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">1.1<\/span><span class=\"token punctuation\">,<\/span> FloatGrid<span class=\"token punctuation\">(<\/span><span class=\"token number\">1.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><br \/>\nmy_room_map<span class=\"token punctuation\">.<\/span>set_value_from_xy_pos<span class=\"token punctuation\">(<\/span><span class=\"token number\">10.1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token operator\">&#8211;<\/span><span class=\"token number\">0.1<\/span><span class=\"token punctuation\">,<\/span> FloatGrid<span class=\"token punctuation\">(<\/span><span class=\"token number\">1.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><br \/>\nmy_room_map<span class=\"token punctuation\">.<\/span>set_value_from_xy_pos<span class=\"token punctuation\">(<\/span><span class=\"token number\">11.1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">,<\/span> FloatGrid<span class=\"token punctuation\">(<\/span><span class=\"token number\">1.0<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p><span class=\"token comment\"># \u67e5\u8be2\u7279\u5b9a\u5750\u6807\u503c<\/span><br \/>\nvalue <span class=\"token operator\">&#061;<\/span> my_room_map<span class=\"token punctuation\">.<\/span>get_value_from_xy_pos<span class=\"token punctuation\">(<\/span><span class=\"token number\">10.1<\/span><span class=\"token punctuation\">,<\/span> <span class=\"token number\">0.1<\/span><span class=\"token punctuation\">)<\/span><br \/>\n<span class=\"token keyword\">print<\/span><span class=\"token punctuation\">(<\/span><span class=\"token string-interpolation\"><span class=\"token string\">f&#034;\u5750\u6807(10.1,0.1)\u503c&#xff1a;<\/span><span class=\"token interpolation\"><span class=\"token punctuation\">{<\/span>value<span class=\"token punctuation\">.<\/span>get_float_data<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">}<\/span><\/span><span class=\"token string\">&#034;<\/span><\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p>\u6ce8\u610f\u4e8b\u9879&#xff1a;<\/p>\n<ul>\n<li>\u8d8a\u754c\u5750\u6807\u64cd\u4f5c\u8fd4\u56deFalse&#xff0c;\u5730\u56fe\u4e0d\u4f1a\u81ea\u52a8\u6269\u5c55\u8fb9\u754c<\/li>\n<li>\u6279\u91cf\u6807\u6ce8\u5efa\u8bae\u4f7f\u7528set_value_from_xy_index\u63d0\u5347\u6548\u7387<\/li>\n<\/ul>\n<hr \/>\n<h3>\u5730\u56fe\u53ef\u89c6\u5316\u5b9e\u73b0<\/h3>\n<p>matplotlib\u53ef\u89c6\u5316\u5de5\u5177\u5c55\u793a\u6805\u683c\u5730\u56fe&#xff1a;<\/p>\n<p>my_room_map<span class=\"token punctuation\">.<\/span>plot_grid_map<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><br \/>\nplt<span class=\"token punctuation\">.<\/span>title<span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;\u623f\u95f4\u6805\u683c\u5730\u56fe&#034;<\/span><span class=\"token punctuation\">)<\/span><br \/>\nplt<span class=\"token punctuation\">.<\/span>xlabel<span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;X\u5750\u6807(\u7c73)&#034;<\/span><span class=\"token punctuation\">)<\/span><br \/>\nplt<span class=\"token punctuation\">.<\/span>ylabel<span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;Y\u5750\u6807(\u7c73)&#034;<\/span><span class=\"token punctuation\">)<\/span><br \/>\nplt<span class=\"token punctuation\">.<\/span>axis<span class=\"token punctuation\">(<\/span><span class=\"token string\">&#034;equal&#034;<\/span><span class=\"token punctuation\">)<\/span>  <span class=\"token comment\"># \u4fdd\u6301\u5355\u5143\u683c\u65b9\u5f62\u6bd4\u4f8b<\/span><br \/>\nplt<span class=\"token punctuation\">.<\/span>grid<span class=\"token punctuation\">(<\/span><span class=\"token boolean\">True<\/span><span class=\"token punctuation\">)<\/span><br \/>\nplt<span class=\"token punctuation\">.<\/span>show<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">)<\/span><\/p>\n<p>\u8f93\u51fa\u7279\u5f81&#xff1a;<\/p>\n<ul>\n<li>\u84dd\u8272\u5355\u5143\u683c\u8868\u793a\u969c\u788d\u7269&#xff08;1.0&#xff09;<\/li>\n<li>\u6d45\u8272\u533a\u57df\u4e3a\u81ea\u7531\u7a7a\u95f4&#xff08;0.0&#xff09;<\/li>\n<li>\u5750\u6807\u7cfb\u81ea\u52a8\u5bf9\u9f50\u771f\u5b9e\u4e16\u754c\u5c3a\u5ea6 [13]<\/li>\n<\/ul>\n<hr \/>\n<h3>\u5e95\u5c42\u6280\u672f\u89e3\u6790<\/h3>\n<p><img decoding=\"async\" src=\"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2025\/08\/20250812124946-689b386a1943d.png\" alt=\"\u5728\u8fd9\u91cc\u63d2\u5165\u56fe\u7247\u63cf\u8ff0\" \/><\/p>\n<h4>\u5750\u6807\u8f6c\u6362\u7b97\u6cd5<\/h4>\n<p>\u6838\u5fc3\u8f6c\u6362\u51fd\u6570\u5b9e\u73b0\u771f\u5b9e\u5750\u6807\u5230\u6805\u683c\u7d22\u5f15\u7684\u7cbe\u786e\u6620\u5c04&#xff1a;<\/p>\n<p><span class=\"token keyword\">class<\/span> <span class=\"token class-name\">GridMap<\/span><span class=\"token punctuation\">:<\/span><br \/>\n    <span class=\"token keyword\">def<\/span> <span class=\"token function\">calc_xy_index_from_position<\/span><span class=\"token punctuation\">(<\/span>self<span class=\"token punctuation\">,<\/span> pos<span class=\"token punctuation\">,<\/span> lower_pos<span class=\"token punctuation\">,<\/span> max_index<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">:<\/span><br \/>\n        <span class=\"token triple-quoted-string string\">&#034;&#034;&#034;\u8ba1\u7b97\u5750\u6807\u5bf9\u5e94\u7684\u6805\u683c\u7d22\u5f15&#034;&#034;&#034;<\/span><br \/>\n        ind <span class=\"token operator\">&#061;<\/span> <span class=\"token builtin\">int<\/span><span class=\"token punctuation\">(<\/span>np<span class=\"token punctuation\">.<\/span>floor<span class=\"token punctuation\">(<\/span><span class=\"token punctuation\">(<\/span>pos <span class=\"token operator\">&#8211;<\/span> lower_pos<span class=\"token punctuation\">)<\/span> <span class=\"token operator\">\/<\/span> self<span class=\"token punctuation\">.<\/span>resolution<span class=\"token punctuation\">)<\/span><span class=\"token punctuation\">)<\/span><br \/>\n        <span class=\"token keyword\">return<\/span> ind <span class=\"token keyword\">if<\/span> <span class=\"token number\">0<\/span> <span class=\"token operator\">&lt;&#061;<\/span> ind <span class=\"token operator\">&lt;&#061;<\/span> max_index <span class=\"token keyword\">else<\/span> <span class=\"token boolean\">None<\/span><\/p>\n<p>\u8ba1\u7b97\u8fc7\u7a0b&#xff1a;<\/p>\n<li>\u8ba1\u7b97\u5750\u6807\u76f8\u5bf9\u4e8e\u5730\u56fe\u5de6\u4e0b\u89d2\u7684\u504f\u79fb\u91cf<\/li>\n<li>\u9664\u4ee5\u5206\u8fa8\u7387\u83b7\u5f97\u5355\u5143\u683c\u6570\u91cf<\/li>\n<li>\u53d6\u6574\u786e\u4fdd\u7d22\u5f15\u4e3a\u6574\u6570<\/li>\n<li>\u8fb9\u754c\u68c0\u67e5\u9632\u6b62\u8d8a\u754c\u8bbf\u95ee<\/li>\n<h4>\u6570\u636e\u5b58\u50a8\u4f18\u5316<\/h4>\n<p>\u91c7\u7528\u4e00\u7ef4\u6570\u7ec4\u5b58\u50a8\u4e8c\u7ef4\u6805\u683c\u6570\u636e&#xff0c;\u901a\u8fc7\u884c\u5217\u8ba1\u7b97\u5feb\u901f\u5b9a\u4f4d&#xff1a;<\/p>\n<p>grid_ind <span class=\"token operator\">&#061;<\/span> y_ind <span class=\"token operator\">*<\/span> self<span class=\"token punctuation\">.<\/span>width <span class=\"token operator\">&#043;<\/span> x_ind  <span class=\"token comment\"># \u4e8c\u7ef4\u8f6c\u4e00\u7ef4\u7d22\u5f15<\/span><br \/>\nself<span class=\"token punctuation\">.<\/span>data<span class=\"token punctuation\">[<\/span>grid_ind<span class=\"token punctuation\">]<\/span> <span class=\"token operator\">&#061;<\/span> value  <span class=\"token comment\"># \u66f4\u65b0\u5b58\u50a8<\/span><\/p>\n<hr \/>\n<h3>\u9ad8\u7ea7\u6805\u683c\u5730\u56fe\u53d8\u4f53<\/h3>\n<h4>\u52a8\u6001\u969c\u788d\u7269\u5730\u56fe<\/h4>\n<p>TimeBasedPathPlanning\/GridWithDynamicObstacles.py\u5b9e\u73b0\u65f6\u5e8f\u6805\u683c\u5806\u6808&#xff0c;\u652f\u6301&#xff1a;<\/p>\n<ul>\n<li>\u9884\u6d4b\u672a\u6765\u65f6\u6bb5\u7684\u969c\u788d\u7269\u5206\u5e03<\/li>\n<li>\u56db\u7ef4\u6570\u636e\u5b58\u50a8&#xff08;x,y,time,value&#xff09;<\/li>\n<li>\u52a8\u6001\u8def\u5f84\u89c4\u5212\u907f\u969c<\/li>\n<\/ul>\n<h4>\u4f20\u611f\u5668\u5efa\u56fe\u6280\u672f<\/h4>\n<p>lidar_to_grid_map.py\u5c55\u793a\u6fc0\u5149\u96f7\u8fbe\u5efa\u56fe\u6d41\u7a0b&#xff1a;<\/p>\n<li>\u6fc0\u5149\u5c04\u7ebf\u6295\u5c04&#xff08;ray casting&#xff09;\u6807\u8bb0\u969c\u788d<\/li>\n<li>\u533a\u57df\u751f\u957f\u7b97\u6cd5\u586b\u5145\u672a\u77e5\u533a\u57df<\/li>\n<li>\u6982\u7387\u66f4\u65b0\u673a\u5236\u5904\u7406\u4f20\u611f\u5668\u566a\u58f0<\/li>\n<hr \/>\n<h3>\u5c0f\u7ed3<\/h3>\n<p>\u672c\u7ae0\u6df1\u5165\u63a2\u8ba8\u4e86\u6805\u683c\u5730\u56fe\u4f5c\u4e3a\u73af\u5883\u8868\u793a\u7684\u6838\u5fc3\u65b9\u6cd5&#xff0c;\u6db5\u76d6\u5730\u56fe\u521b\u5efa\u3001\u969c\u788d\u6807\u6ce8\u3001\u53ef\u89c6\u5316\u53ca\u5e95\u5c42\u5b9e\u73b0\u539f\u7406\u3002<\/p>\n<p>\u7ed3\u5408\u7b2c\u4e00\u7ae0\u7684\u673a\u5668\u4eba\u72b6\u6001\u8ddf\u8e2a&#xff0c;\u73b0\u5df2\u5177\u5907\u73af\u5883\u8ba4\u77e5\u57fa\u7840\u80fd\u529b\u3002\u4e0b\u4e00\u7ae0\u5c06\u89e3\u9501\u673a\u5668\u4eba\u7684\u8fd0\u52a8\u5965\u79d8&#xff01;<\/p>\n<p>\u4e0b\u4e00\u7ae0&#xff1a;\u673a\u5668\u4eba\u8fd0\u52a8\u6a21\u578b<\/p>\n","protected":false},"excerpt":{"rendered":"<p>\u6587\u7ae0\u6d4f\u89c8\u9605\u8bfb279\u6b21\uff0c\u70b9\u8d5e7\u6b21\uff0c\u6536\u85cf6\u6b21\u3002\u7ed3\u5408\u673a\u5668\u4eba\u72b6\u6001\u8ddf\u8e2a\uff0c\u73b0\u5df2\u5177\u5907\u73af\u5883\u8ba4\u77e5\u57fa\u7840\u80fd\u529b\u3002\u4e0b\u4e00\u7ae0\u5c06\u89e3\u9501\u673a\u5668\u4eba\u7684\u8fd0\u52a8\u5965\u79d8\uff01<\/p>\n","protected":false},"author":2,"featured_media":54018,"comment_status":"open","ping_status":"open","sticky":false,"template":"","format":"standard","meta":{"footnotes":""},"categories":[1],"tags":[81,5500],"topic":[],"class_list":["post-54022","post","type-post","status-publish","format-standard","has-post-thumbnail","hentry","category-server","tag-python","tag-robotics"],"yoast_head":"<!-- This site is optimized with the Yoast SEO plugin v20.3 - https:\/\/yoast.com\/wordpress\/plugins\/seo\/ -->\n<title>[Robotics_py] docs | \u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff | \u73af\u5883\u8868\u793a_\u6805\u683c\u5730\u56fe - \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\/54022.html\" \/>\n<meta property=\"og:locale\" content=\"zh_CN\" \/>\n<meta property=\"og:type\" content=\"article\" \/>\n<meta property=\"og:title\" content=\"[Robotics_py] docs | \u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff | \u73af\u5883\u8868\u793a_\u6805\u683c\u5730\u56fe - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\" \/>\n<meta property=\"og:description\" content=\"\u6587\u7ae0\u6d4f\u89c8\u9605\u8bfb279\u6b21\uff0c\u70b9\u8d5e7\u6b21\uff0c\u6536\u85cf6\u6b21\u3002\u7ed3\u5408\u673a\u5668\u4eba\u72b6\u6001\u8ddf\u8e2a\uff0c\u73b0\u5df2\u5177\u5907\u73af\u5883\u8ba4\u77e5\u57fa\u7840\u80fd\u529b\u3002\u4e0b\u4e00\u7ae0\u5c06\u89e3\u9501\u673a\u5668\u4eba\u7684\u8fd0\u52a8\u5965\u79d8\uff01\" \/>\n<meta property=\"og:url\" content=\"https:\/\/www.wsisp.com\/helps\/54022.html\" \/>\n<meta property=\"og:site_name\" content=\"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\" \/>\n<meta property=\"article:published_time\" content=\"2025-08-12T12:49:47+00:00\" \/>\n<meta property=\"og:image\" content=\"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2025\/08\/20250812124943-689b3867e7aa0.png\" \/>\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=\"4 \u5206\" \/>\n<script type=\"application\/ld+json\" class=\"yoast-schema-graph\">{\"@context\":\"https:\/\/schema.org\",\"@graph\":[{\"@type\":\"WebPage\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/54022.html\",\"url\":\"https:\/\/www.wsisp.com\/helps\/54022.html\",\"name\":\"[Robotics_py] docs | \u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff | \u73af\u5883\u8868\u793a_\u6805\u683c\u5730\u56fe - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3\",\"isPartOf\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/#website\"},\"datePublished\":\"2025-08-12T12:49:47+00:00\",\"dateModified\":\"2025-08-12T12:49:47+00:00\",\"author\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41\"},\"breadcrumb\":{\"@id\":\"https:\/\/www.wsisp.com\/helps\/54022.html#breadcrumb\"},\"inLanguage\":\"zh-Hans\",\"potentialAction\":[{\"@type\":\"ReadAction\",\"target\":[\"https:\/\/www.wsisp.com\/helps\/54022.html\"]}]},{\"@type\":\"BreadcrumbList\",\"@id\":\"https:\/\/www.wsisp.com\/helps\/54022.html#breadcrumb\",\"itemListElement\":[{\"@type\":\"ListItem\",\"position\":1,\"name\":\"\u9996\u9875\",\"item\":\"https:\/\/www.wsisp.com\/helps\"},{\"@type\":\"ListItem\",\"position\":2,\"name\":\"[Robotics_py] docs | \u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff | \u73af\u5883\u8868\u793a_\u6805\u683c\u5730\u56fe\"}]},{\"@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":"[Robotics_py] docs | \u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff | \u73af\u5883\u8868\u793a_\u6805\u683c\u5730\u56fe - \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\/54022.html","og_locale":"zh_CN","og_type":"article","og_title":"[Robotics_py] docs | \u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff | \u73af\u5883\u8868\u793a_\u6805\u683c\u5730\u56fe - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","og_description":"\u6587\u7ae0\u6d4f\u89c8\u9605\u8bfb279\u6b21\uff0c\u70b9\u8d5e7\u6b21\uff0c\u6536\u85cf6\u6b21\u3002\u7ed3\u5408\u673a\u5668\u4eba\u72b6\u6001\u8ddf\u8e2a\uff0c\u73b0\u5df2\u5177\u5907\u73af\u5883\u8ba4\u77e5\u57fa\u7840\u80fd\u529b\u3002\u4e0b\u4e00\u7ae0\u5c06\u89e3\u9501\u673a\u5668\u4eba\u7684\u8fd0\u52a8\u5965\u79d8\uff01","og_url":"https:\/\/www.wsisp.com\/helps\/54022.html","og_site_name":"\u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","article_published_time":"2025-08-12T12:49:47+00:00","og_image":[{"url":"https:\/\/www.wsisp.com\/helps\/wp-content\/uploads\/2025\/08\/20250812124943-689b3867e7aa0.png"}],"author":"admin","twitter_card":"summary_large_image","twitter_misc":{"\u4f5c\u8005":"admin","\u9884\u8ba1\u9605\u8bfb\u65f6\u95f4":"4 \u5206"},"schema":{"@context":"https:\/\/schema.org","@graph":[{"@type":"WebPage","@id":"https:\/\/www.wsisp.com\/helps\/54022.html","url":"https:\/\/www.wsisp.com\/helps\/54022.html","name":"[Robotics_py] docs | \u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff | \u73af\u5883\u8868\u793a_\u6805\u683c\u5730\u56fe - \u7f51\u7855\u4e92\u8054\u5e2e\u52a9\u4e2d\u5fc3","isPartOf":{"@id":"https:\/\/www.wsisp.com\/helps\/#website"},"datePublished":"2025-08-12T12:49:47+00:00","dateModified":"2025-08-12T12:49:47+00:00","author":{"@id":"https:\/\/www.wsisp.com\/helps\/#\/schema\/person\/358e386c577a3ab51c4493330a20ad41"},"breadcrumb":{"@id":"https:\/\/www.wsisp.com\/helps\/54022.html#breadcrumb"},"inLanguage":"zh-Hans","potentialAction":[{"@type":"ReadAction","target":["https:\/\/www.wsisp.com\/helps\/54022.html"]}]},{"@type":"BreadcrumbList","@id":"https:\/\/www.wsisp.com\/helps\/54022.html#breadcrumb","itemListElement":[{"@type":"ListItem","position":1,"name":"\u9996\u9875","item":"https:\/\/www.wsisp.com\/helps"},{"@type":"ListItem","position":2,"name":"[Robotics_py] docs | \u673a\u5668\u4eba\u72b6\u6001\/\u4f4d\u59ff | \u73af\u5883\u8868\u793a_\u6805\u683c\u5730\u56fe"}]},{"@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\/54022","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=54022"}],"version-history":[{"count":0,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/posts\/54022\/revisions"}],"wp:featuredmedia":[{"embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/media\/54018"}],"wp:attachment":[{"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/media?parent=54022"}],"wp:term":[{"taxonomy":"category","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/categories?post=54022"},{"taxonomy":"post_tag","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/tags?post=54022"},{"taxonomy":"topic","embeddable":true,"href":"https:\/\/www.wsisp.com\/helps\/wp-json\/wp\/v2\/topic?post=54022"}],"curies":[{"name":"wp","href":"https:\/\/api.w.org\/{rel}","templated":true}]}}