From 40bdf6990c08c1a4cda4af86169730623f87dad0 Mon Sep 17 00:00:00 2001 From: usernamekkyy Date: Wed, 11 Nov 2026 21:20:57 +0800 Subject: [PATCH 1/2] =?UTF-8?q?feat(humanoid):=20G1=20CostNet=20=E6=A0=85?= =?UTF-8?q?=E6=A0=BC=E8=A7=84=E5=88=92=E5=AF=B9=E7=85=A7?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit 在独立栅格示例中比较 CostNet 辅助 A* 和曼哈顿 A* 的路径代价与搜索扩展数。 --- .../humanoid/g1_costnet_grid_planner/index.md | 31 ++++ docs/img/g1_costnet_grid_planner/planner.png | Bin 0 -> 5789 bytes docs/index.md | 1 + mkdocs.yml | 1 + .../g1_costnet_grid_planner/.gitattributes | 2 + .../g1_costnet_grid_planner/CMakeLists.txt | 6 + .../g1_costnet_grid_planner/README.md | 27 +++ .../launch/main.launch | 17 ++ src/humanoid/g1_costnet_grid_planner/main.py | 36 ++++ .../g1_costnet_grid_planner/models/planner.pt | Bin 0 -> 39949 bytes .../g1_costnet_grid_planner/package.xml | 9 + .../patrol/__init__.py | 1 + .../g1_costnet_grid_planner/patrol/demo.py | 50 ++++++ .../patrol/planning.py | 159 ++++++++++++++++++ .../g1_costnet_grid_planner/requirements.txt | 3 + .../scripts/task_runner.py | 26 +++ 16 files changed, 369 insertions(+) create mode 100644 docs/humanoid/g1_costnet_grid_planner/index.md create mode 100644 docs/img/g1_costnet_grid_planner/planner.png create mode 100644 src/humanoid/g1_costnet_grid_planner/.gitattributes create mode 100644 src/humanoid/g1_costnet_grid_planner/CMakeLists.txt create mode 100644 src/humanoid/g1_costnet_grid_planner/README.md create mode 100644 src/humanoid/g1_costnet_grid_planner/launch/main.launch create mode 100644 src/humanoid/g1_costnet_grid_planner/main.py create mode 100644 src/humanoid/g1_costnet_grid_planner/models/planner.pt create mode 100644 src/humanoid/g1_costnet_grid_planner/package.xml create mode 100644 src/humanoid/g1_costnet_grid_planner/patrol/__init__.py create mode 100644 src/humanoid/g1_costnet_grid_planner/patrol/demo.py create mode 100644 src/humanoid/g1_costnet_grid_planner/patrol/planning.py create mode 100644 src/humanoid/g1_costnet_grid_planner/requirements.txt create mode 100755 src/humanoid/g1_costnet_grid_planner/scripts/task_runner.py diff --git a/docs/humanoid/g1_costnet_grid_planner/index.md b/docs/humanoid/g1_costnet_grid_planner/index.md new file mode 100644 index 0000000000..39fbea2245 --- /dev/null +++ b/docs/humanoid/g1_costnet_grid_planner/index.md @@ -0,0 +1,31 @@ +# G1 CostNet 栅格规划对照 + +在独立栅格示例中比较 CostNet 辅助 A* 和曼哈顿 A* 的路径代价与搜索扩展数。 + +## 环境与运行 + +使用 Python 3.11。在模块目录运行 `python -m pip install -r requirements.txt`。 + +```bash +python main.py --output results +``` + +示例在一个合成栅格比较经典和神经辅助搜索,输出路线图和 JSON。网络仅处理相同 f 值的排序。可用 `--mode train_planner` 重训,用 `--mode plan_stdio` 接收占据栅格 JSON。 + +## ROS launch + +在 ROS Noetic 源码空间运行,将路径替换为实际值。 + +```bash +source /opt/ros/noetic/setup.bash +export ROS_PACKAGE_PATH="$PWD:${ROS_PACKAGE_PATH:-}" +roslaunch g1_costnet_grid_planner main.launch sim_python:=/path/to/python sim_entry:=/path/to/main.py +``` + +## 运行效果 + +![G1 CostNet 栅格规划对照](../../img/g1_costnet_grid_planner/planner.png) + +## 大模型使用声明 + +使用 OpenAI Codex 辅助拆分、编程、验证和文档整理,提交者复核并对提交内容负责。 diff --git a/docs/img/g1_costnet_grid_planner/planner.png b/docs/img/g1_costnet_grid_planner/planner.png new file mode 100644 index 0000000000000000000000000000000000000000..36c4c600f4ee4e93e9ada855fc3eb7cdba7d4911 GIT binary patch literal 5789 zcmeI0X;70{m&b!>qm5uYjUu9;O$(?9vdK=gZA3*tc4SxC1R*SvuqLP|3KB$Alz_pY zEV8cw2?>fA0)&8oVF?Kk*%OwK5J*Uv$G59ys%QG0dFR7S)l|LrOOlgY&wcLyoO|y1 zorjlgEM>d*)U>);OKncZG2E>}uXs&sZ)=N$;lUz6>dV;6}JQvn@-{5EoS& z?DP$DkoLx!?N;|H9_nmilM^(bal*t-t5(i8=uXg8QEIr>L+wS1h2HYcdY6gF9gZ@ ze=Tg7=EFO46I|T#A z*UVL(lgYeSLQkl$N;hX4M>PpQBxfFxGPt1&-C%p#&QtM`d|IQlJxWbFec_gUb!FFm zW@v7uHh8n2b-P$ z#{Rhi+825I$dg0y+y}1>XvVL(iL>6Bey4_RJ8;q$OO4-=GwkFJ4otPb)xvpnYrjZz zlv(Ce$Cke8Mnn)tp)LoASZf^OYtFiiEaV_@xyY&_cKO*JG-7%3YT2+_u+m`B`X{M^ zUtuKcVI`D?>DXg`(nr2C0j+U~aZ=$VFYk_u8k{d&|9Jr=M+_&HI!OO0ZKVtqH0lM# z+_JN?*ZmfrXYo&nR)YlY;EoTZr| znYLm9c9mcrGl_!mSO)4*Uv>S-NaotZfQV`-nUZz|8FK_TlhT#KG=weO5h;m1Ro#xpf!9;LtS0HCah;kx{&fhfw;_7(50AfV(ybiLfSjy_{{^;j~WaU zbo_a&Chol~2jv2Ub%E{UgZf8ojhS5x5gdMis2e~z(OkCU{2t!uE;oFZtfewCjZL_rLdP$fmgE>!jz2ajD2*JnB3TPm|voK(40n0GAlRI%mJTZ+%^fu2|I2@PX zv&YZZ_jfx-SJ&vaK~w=PQV8`(v#@$zCLYWG77iB|OiWBjirL~Ix-DS^?WL*y*fqSglnn4zKyq~$IJBmdLTiicPaG@jF@a^DNlnM(*3vX2`8 zK}Jd%R&e0dE0*Ioh7}i4rgeQ)2ZN~Pxo)9b>@7k968ZFC%6|P|)y1(Qe!lV%X{ntG zy>%-)B!zr<;9RZmh1}sfeyO)sOpc)OhTtPtrn6|QowU-4W^9I$SQUuv?`PI0SN3Yo z_AF$18XtshKDE@g?nst@)Q-+dp4YvvCJqc-n2+JYfrJ?@L8LA|vXIAu#c z(wfclQ}Z1gwjb0U5f<89oN2nV8Gu*mF@1wNDhGhG_vle}u}dO$t<8H_Hs{Ia`pOTx zE;TgTu!l>)YbRlJ7&ux-q8LiJf6GG%y$*TboY1sL-?9GL9Ri#GQk<8US6R6<(z}_F zgBbQ3286Q0XT)Cqkddz*J6T6nRE|B*X<%oZc;)_n1ErQd^NdP&J;fi&axT?4x?VV) z{hW+kTLg=2u;EjQUg;tAq=tO-NQY)kE_w$HG%eQMTpdmC$*YwZYA#nqSaO{BU8P2(yU-AK-~<4^>So21x$Dix zx)Gj}QS^jP8B$zEzi~bQf|%<7W=@=BdXuG)f)DvF8dQg9T2hbjf6M@z|$tXWA@Z=^}c2 z2^*`hB@6Hg;15j~1Z!5f8`N+GfL0vZN@w~_x?Vz2##yOc zles6f#uffh++tHGzC4FXSmmTzA{!@OTNVOWc=!mWB-WRCPDW9GBfZ$x zG&fb;0mtXL;W2q7zv${SgjNJ~#n%TuCTU0^njVwzw%JFnqZ z&FasrJ{CP$9Qr;W%1iVinFwW9EtRWA?|gho`uj42Fo^^*%~z@Aog643i`n9yU;NGp&;2n zNjJhZ2&e`2IOTVh*bb1Xi`VyS$9`O!zqm;s?+y#gJXNx}^hI;c1T^g#Jv54?SJuF` zIt5?MPIUZjz^tXItNi6=;*Rr9hg(2DB@(vDfFyt#YU`ozzd(|wL0fkIe=*ek#*%yY z=4GzpkzMb}SM~^86OVxr!Jonp2=?W5TpImyjH36$yNM0nzvzK}9}vk#W38l;%(tos z4|mAdL+y^W8uU8m1iT0ebUX5j@N7nQkOnesy`12P0aW1GDKNG*-(bDzNd`GFtqbQTP5);RI8rwk3T=LGhurRR0px6^WcA%y#|E4!Y{e6|2A_LRNvRto%Td(bgDFB_v?JVwQul( zrk-PYR$deNN?n^v6;8bKnYYmj%;5p^_OVaE%Y1)EKe?QtlJu^9y|0r~V7{EM$_HqVlAQie&i1*M@ zk%JPuXYwiXN})NHd#^vxOaM3W=>SS~v$)exa<(`6BRy`B*OujNVaHw1@}8Q83=bpm z8$lwVA7Q%?=?viGaYlS_s+v>mBI!wTflcSg3&gbwv2uJv0XJNgpV6v`9pv+r;Ztp>4v8QIP5C-*(^(}FIV`SibaXB3%boc&S^Ck`%y9ybs9o;bseB4_2*ycXcyVRRi5iKGcBB}A5tn0=w zt;kx^U7a{BQLzs3WzN{gBb^tO2PKmAP};%J14LWX%uKUDSApsX&M^GIBBOFPh05>% z&~!DpXRXdaywpoX|4OajVA_7)vlJREAO-lhh3A;SK8R&dp=@7?!EHduN}UR#^J?K& z%!IGPzdqhYjmI6Sir|t6l;JKcp^_iB|fGX=rHZYP+!Ndiios z(PZx|>gLMCuXleX)+1UANNXhLNo9l}(Qg$VjY5)=QK>2Lh`^PyTn$iDOFhHsX*s|w z06P?#vxXp-soiQjSq$Op;=V6bS`EDUTX@=jef!ST)YN=KBt~6DB_G}#>y1#k+>x|Q z{qFoYRWlCYU=zrG6dY7D)kPU;2=7@+#i$RzK!bh1z1S4@H36gtpn-ECQwztMD`OY^ zM`Sy9?wnw3lGWT5e$LMEc)l}dfAmFiw!V(I>em{ZT(X75q{rtIUOC?!NL4_UrC|nN zC!)=LUP@}xa7Hng0icWbM`i6#><|W@hv0ZntY+?yz>t>CJaUAwR&dT;iLkyqnevLD zo`SI~07sG2u=T+s#{yPy>M0Tal;Ba!5ETpi16NkiapwBN06O+h{Uup}WkZ)bf-5ZT zxO4LmF;`6r@J^Zgsm|P{lPQ>csaf<>%VMsiJJ9ue*_`DpFia1M{I=J&tf(mZ!^B%V zIdYB})^o)9ZytJjJ(cL)4fuur&Z6d9(6?^SpNQe>YSJw>b!M;@znwFEB`ZgpzoVc? zzyo$O-(TGK@8nY!62bP%rzj?@-`xfFBGA)S=@G33)~NgG_;}8BTUM1Y6h@0?XHvT7 z`bAuzk0IS{0sx_JE%_b_9qTJix+^AGihqJ1Mmcop47dqs z1WxZ#hz7o*xb3wz#5%2J{+IIok!NO^w26#LWeTJ7Jp!LH zhdZ@wz~YD>G$LCz-7kkN6j>>~;JB9Twbljp;$7io^nJ5VDk488kWau$Rwd}Ky0ibt dl@>@9f_KO}L4~eMcn~lySlIkt{+rL8e+2`1Wr6?z literal 0 HcmV?d00001 diff --git a/docs/index.md b/docs/index.md index 9f6f16ff53..4551cacf5a 100644 --- a/docs/index.md +++ b/docs/index.md @@ -99,6 +99,7 @@ ROS 2 服务与参数基础实验(无人机模式切换与在线调参):[c * [人形上下台阶步态仿真](./humanoid/humanoid_stair_climb.md) * [ROS虚拟机器人圆形轨迹rviz可视化示例](./humanoid/ros_topic_demo/index.md) * [人形机器人全身逆运动学与可操作性](./humanoid/whole_body_ik.md) +* [G1 CostNet 栅格规划对照](./humanoid/g1_costnet_grid_planner/index.md) * [人形机器人双臂末端可达域分析](./humanoid/humanoid_reachability.md) * [人形机器人跌倒预判与保护性倒地](./humanoid/humanoid_fall_protection.md) * [人形机器人 3D 碰撞体边界检测可视化](./humanoid/humanoid_collision_boundary.md) diff --git a/mkdocs.yml b/mkdocs.yml index edf15e5906..dabd97e228 100644 --- a/mkdocs.yml +++ b/mkdocs.yml @@ -97,6 +97,7 @@ nav: - ROS虚拟机器人圆形轨迹rviz可视化示例: './humanoid/ros_topic_demo/index.md' - ROS2 Humble 路径点发布器: './waypoint_publisher.md' - 人形机器人全身逆运动学与可操作性: './humanoid/whole_body_ik.md' + - G1 CostNet 栅格规划对照: './humanoid/g1_costnet_grid_planner/index.md' - 人形机器人双臂末端可达域分析: './humanoid/humanoid_reachability.md' - 人形机器人跌倒预判与保护性倒地: './humanoid/humanoid_fall_protection.md' - 人形机器人 3D 碰撞体边界检测可视化: './humanoid/humanoid_collision_boundary.md' diff --git a/src/humanoid/g1_costnet_grid_planner/.gitattributes b/src/humanoid/g1_costnet_grid_planner/.gitattributes new file mode 100644 index 0000000000..f13e51c0ec --- /dev/null +++ b/src/humanoid/g1_costnet_grid_planner/.gitattributes @@ -0,0 +1,2 @@ +*.py text eol=lf +*.sh text eol=lf diff --git a/src/humanoid/g1_costnet_grid_planner/CMakeLists.txt b/src/humanoid/g1_costnet_grid_planner/CMakeLists.txt new file mode 100644 index 0000000000..084cb87281 --- /dev/null +++ b/src/humanoid/g1_costnet_grid_planner/CMakeLists.txt @@ -0,0 +1,6 @@ +cmake_minimum_required(VERSION 3.0.2) +project(g1_costnet_grid_planner) +find_package(catkin REQUIRED) +catkin_package() +catkin_install_python(PROGRAMS scripts/task_runner.py DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION}) +install(DIRECTORY launch DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION}) diff --git a/src/humanoid/g1_costnet_grid_planner/README.md b/src/humanoid/g1_costnet_grid_planner/README.md new file mode 100644 index 0000000000..3ff03e0973 --- /dev/null +++ b/src/humanoid/g1_costnet_grid_planner/README.md @@ -0,0 +1,27 @@ +# G1 CostNet 栅格规划对照 + +在独立栅格示例中比较 CostNet 辅助 A* 和曼哈顿 A* 的路径代价与搜索扩展数。 + +## 环境与运行 + +使用 Python 3.11。在模块目录运行 `python -m pip install -r requirements.txt`。 + +```bash +python main.py --output results +``` + +示例在一个合成栅格比较经典和神经辅助搜索,输出路线图和 JSON。网络仅处理相同 f 值的排序。可用 `--mode train_planner` 重训,用 `--mode plan_stdio` 接收占据栅格 JSON。 + +## ROS launch + +在 ROS Noetic 源码空间运行,将路径替换为实际值。 + +```bash +source /opt/ros/noetic/setup.bash +export ROS_PACKAGE_PATH="$PWD:${ROS_PACKAGE_PATH:-}" +roslaunch g1_costnet_grid_planner main.launch sim_python:=/path/to/python sim_entry:=/path/to/main.py +``` + +## 大模型使用声明 + +使用 OpenAI Codex 辅助拆分、编程、验证和文档整理,提交者复核并对提交内容负责。 diff --git a/src/humanoid/g1_costnet_grid_planner/launch/main.launch b/src/humanoid/g1_costnet_grid_planner/launch/main.launch new file mode 100644 index 0000000000..f2a062b54e --- /dev/null +++ b/src/humanoid/g1_costnet_grid_planner/launch/main.launch @@ -0,0 +1,17 @@ + + + + + + + + + + + + + + + + + diff --git a/src/humanoid/g1_costnet_grid_planner/main.py b/src/humanoid/g1_costnet_grid_planner/main.py new file mode 100644 index 0000000000..374f44f409 --- /dev/null +++ b/src/humanoid/g1_costnet_grid_planner/main.py @@ -0,0 +1,36 @@ +#!/usr/bin/env python3 +"""在独立栅格示例中比较 CostNet 辅助 A* 和曼哈顿 A* 的路径代价与搜索扩展数。""" +import argparse +import json +from pathlib import Path + + +def main(): + parser = argparse.ArgumentParser(description=__doc__) + parser.add_argument('--assets', help=argparse.SUPPRESS) + parser.add_argument('--mode', choices=['demo', 'train_planner', 'plan_stdio'], default='demo') + parser.add_argument('--output', type=Path) + parser.add_argument('--dataset', type=Path, default=Path('data/visual_patrol')) + parser.add_argument('--weights', type=Path, default=Path(__file__).resolve().parent / 'models') + parser.add_argument('--samples', type=int, default=100) + parser.add_argument('--epochs', type=int, default=15) + parser.add_argument('--seed', type=int, default=7) + parser.add_argument('--seconds', type=float, default=45) + parser.add_argument('--record', action='store_true') + parser.add_argument('--controller',choices=['navigation','perception','end2end'],default='navigation') + args = parser.parse_args() + if args.mode == 'train_planner': + from patrol.planning import train_planner + print(json.dumps(train_planner(args.weights),indent=2)) + return + if args.mode == 'plan_stdio': + import sys + from patrol.planning import plan_request + print(json.dumps(plan_request(json.load(sys.stdin),args.weights))) + return + from patrol.demo import run + print(json.dumps(run(args.weights, args.output or Path("results")), indent=2)) + + +if __name__ == '__main__': + main() diff --git a/src/humanoid/g1_costnet_grid_planner/models/planner.pt b/src/humanoid/g1_costnet_grid_planner/models/planner.pt new file mode 100644 index 0000000000000000000000000000000000000000..97c8a1cad3e1095c6a806a784df5d9af11c48d4e GIT binary patch literal 39949 zcmbsQ2{_f?_dg7q%9tTUk|FbuIpXYflu)6GRHg<)Xpke4P-aqOO6DR&1Csgdb(#zf zq)9YLY0`*BO?pn>&;R#*uFv&czx%oF`#!GCv7Gm7zus?auf5l_(ve?)het?==l|y= z$upfNc-y9+Aioep-%X*L41%|Av$qlFasSsVhR?@m$F^;LKB0j-f_93m2=Vm`@$G7(|%Yiq9)@>V>lOomq4LOUmpYQU?D5oX0Z!hm_I(A!YoRl*vB`rlBk|XV$#`k~04v zQs)1{FlSl(gE9XmXIW37p1t^K!b9&24R%kAGXbC!EF%j4fN3zlaz%j-X~u$|rpD;))e z#+FX8Jjq=vf5*!Ib>++PNd0%^8*JVYvVBwNhW~T__BPZ0Z2*k_!ZwdSivPP3|BnA1 zR)NRj{|ozn7WRfs+XDTAw)+Kz+S{1^8~I;m=70Ug-0Uv_>u}aQ!ut8a!z_BK}k zF9@(ta;!d71VeyIDqhnqKqvMDERI)XDnH|AhPFsE?~66z!wvlyHIYqb{g}$UWfj8d zonUeVFH3PmvjmyhDl^bS^$Ko0c7ZJCapmw=ui~sDr%>R|4Z7O71wNkJ3reCr@bHlm zY3VV?*-ax5HQb0%zWH$6zXoIj6X5*r3V8col_Qp~%sFsx8|TWor(ogvDBN zI;(9sBu#+Hzrmcj_JI?LRF>uNCWtZ1M(!|Ta%{;eg-*P?GP{BH{H+1?SZsqgX;ub`{oO7FWMk~?{a*6K#OCiJ)5bV zcdwPD?ZW9yJ&tRi$}uG}@=?TJ80{`@=3K7jWd<_d61VgIob^}R@YZZ|&VsTxWY3>j zkoLkG%OAUvb|Gc*)#@cxter;&BFf10rL&pwtN~Q)vS(hr8b?wxdf;B(R_4dg!0b-; zN5LNs%k0s}@ci0mqGDJAE!Wm914rAy}Wpbv-w?K@`EmX*w zf`h!Pm^Z6s5MSSfOxb&M%STmdwH*};s8m1KUX z(_)@@ww+{&s{qID0cfAG|S#vhLLM;$oHBggQLQYN-2yoOoS9uN7Ma@IU`M~Ng+j^9uX=+qj} z@mr5juPzdw9G(WHrONPG#hLVu<$_rDZREdj60|HQN!Hd!RKcPV9?KjfT2s1UPDe3# zh?+C?YK@_MpAvjBkY)1Z&*r>HD#MCER29!LcYnNjAAq$Nb18Plmm z+r+P7OD|!jmzIM?-%{rO-7fIc;R4NM&t!ggmE_DdQR4)ZmV#ailY{L%%tv1~;#o^R z=KIG9!YLtp(fK8@NBD4?n$j zVY**92mzAYvvUjZgij`TYD(hvx6Sx!;4->?SquwvYvIop zfCifs@U~e5HN~0`cbT747punUb|;(|nLJqWf}f)?aEf$f*>RSwTFrUf%*W)|exLs= zXg;TN?;(2c_fu@tRA7cmpJ%tZTm)^;m3VSZD{h?6%S=`h;e2;~2J0IoIgXNX-FnaSWInr60r4uovU_v_E*0*NPMO=>z7jdr9|oEM$J{Gh`M` z`GE$Dc$iD#tf58VJ9M~R#xo1~alb=O+w;(cO!@e7kjc?w?%gE@eo^Vra3LK}98iS} z1uM>j17ARUzbdCU$(lpoZQ?X?PC<|!FK19diR1Ujmjl5i=>LHqViNf2^h$u+HK%M6YfnmlLnA+`@!&g}b%+g6; z{5yYZSO1g+++F+c_`fl~$=~@|9!X?g#BIuVPLawzBDhxX3AxB(LW}!mhS?fvcoDJ& z>Ls*MlF7iY>i597%n#$ky+BO&Drh+}&`~WKe02tanRtgxMs>sEZ$H~oE}bWN!3P=g z2@*`X%X(lc&(BBUZlJ<+^)WKkSEyYPXo7d%G3bns!HeGt4deFmzxZnkY< z^D>z}uc4v?$&=tHICmlz4*WPt2MPy4ZCORD25ScXXgtR#+wzQ@O?w2I{tJMl?tn>; zF8JUg2tWP4fW)dMP%E0sobOyjMCXr^{Pm}ycfUC1`uMP2?wx|NVL?p!FbKO8`^WzjQ-cOw@Q&6>*9>_zH1TM zJp(lcqhP&AJE-h-!1i}<$gTC>a9rXH9MM&Pf#7Zs^J;^we{5jkXDQ54(8j^2%d}=W*|@Vpy9X z08j3UGY;J}r4h6QCQmMaTembw$FBt>exEMnRrSHrjou_Xxt+YdsSC$*3m`V`7(CqI zfxmNO$+ah!>9bOIblV#Xf!oiuC@>q_{IJL#B@~CPu5SMZxKI??HjXP7{x>@%~`nb{&Xmgw*gVl zQEFHs4qEq5fyPH3ba0RYlYM;5Pz7zeL~#yO@^hegZ7a;5rwdJM#7V%?E9^kkPwaBz zD^Q%>g1(D&F==}X-r3cT)>h`29yUfEoQi~+qh>hE!HDE69wy(MRq;|*DyB+%;~#^o zsOTtxeG|)Ymu)#Nw_E{sZzOT*#Z;m{*9R6@=0eZ+EFv6Xi!J7Zbo`Mhbk)uWy{3NX z^3#D%182OI^^mMqe!<|iI0`{mty+ioB$5a7H(7byyHD55DMPFDI6NqlM@sl!(=Ch} z)W6%0#$A_0Be5gI%UhS`&kO>oPi>^WNCcmqE5q>UYJC4u7TX+>3E$hJkSfN;x3x9I zdGse)FM6HY)}KR>c3$?3;%Kb!Jd4#jt*F_W3%5Il7}25?aM!3EI=|G=E2<;x*FQhA z=bGukiJisNLT(2v;wQj2bAZe{F^=!}`pKb>@5s-yQjmI3m&{ll552FLkXhaW$wE0G z>wJ-YX1O3lY2AY@Th9_7mn`_|o((tlo&y>2H1OAshNem@SSB_AAEY^8TOtpB9dDqt zssNskc7S^5TlOiJU>G?R2ZyD~==hRcP)IC>sKmWs>3tZyc2Ub?T_Rvuy%)+x@~HQ1 zJGOPO6@%RSqK&-iwZpM^NSQAoccnYL&}zzy-++)V{bFXJ*CG{D6&ZQ{5A> z@XIwEd;b9kaxIW~c?o`2p3ZoG>Uo<%?Nh7A>g{B`V+3kWH-K5ohuONT3K`8+IH4cwCK+^$XnS6?YU)e z-2EMO@;Lypsz(`NCuS3i=kc`Nq>>JLOMqpbEqqG5n8{KhM&nMcaUxwpS zRcPjT5!b55)2Gw7SlONOr^axIePV_VTz&P16z)35K4of$0w-;7^!z@M(VirV6P7r4 zdM{;r{UqntRuX=-+r&^^7lNxPOpNGZNVgtHCQXB>v$x=6_dyJQaRnx&Re(C&B0Xup z$P3*7Xer(d&DlAi9~Dmps#IvLaw57&*g~v+K8fpSgSmrG$eipocxKT7*!;{D_ZK9f z>8zdjqCpmhcz-cGr;HGPO$7{aQ-iZo@ocYa!Ke^l1$J9aP&pxkHhxK_y&5dgBGqvE zXCz%Ne~awXcY=Q2=L{`bMH~%FXd9bQW5Y{b@SpaJ+^yQgHlI5KI9={I#xon&_~^rz zLLa(sCpQiIeFM8NbZmhmJY70pGz786dss0!!Xh$YABuqo%L zp*tSEzZ4JbdW7Ha^Wn8^F{u3t@mS(BSC9&)Wo}E`!HXPBG;qVP z+m$r*yeOwbNQv|PSQ9n!V4@*If^+ueN={6kG-r602Wpg*qQDe6&W|-}99yfUoOd$X zoIK_=_KxX!uy#odlsl+GdtDCv7EL91zY8MSY2efs0Y82n0rvr6h`Di@M2_&lh{^}T z;dqfD+k3=>`I{6k3dZe;TJ%Un3Yfik35K7pLxZJnoAbjo=v~MUTeByqzD^~K>^@<2 zRI-A^{8$aTifdt;b2FPEBFaqe69fNfN3dAF3c72nEq_XXW!DF`0G{ZD!8?M?isCdf z;;RmmPqk_B+dN3V8bx?U+~F9@66W&c!IrRvG;GBt`g>I!RC$kDU6HbdZ98(TTE)9T zy<{pJl-f?$^bHWVsjZBTm?m(F5n|eZtAMCgRoD`qfx_F>$el!0j(62FYTv0s_d*{| z;fTQfHO_Qup(!k$>?WQQhhVjk5xaD2D;cq=g{CDH;1YHg#{U$MJJmjn_vOl%nRfx4 zJtN^9T4QToETkmm(+hKsL$l8Z`eaQT1P8W4-o-ZJaEE(8ymKL~q?TL}-wD6&Ph+Yq zxd`G-uR*df1lZZNU>u6m@ zCQ)x!f(?~nD8V}w?ri=}pVUdgN8`DW>z)S2VXo*rI1P_qDJM?_4wF?e=ZNwRS5hr7 zN$al92C*BIYfBR$>#!tb+FXSa*+Y;d`kjdL-ylNz7GNfq#F!GI2kJs4Bxqd|zSic0 z-E+>8yGLx%DbkNBR7R7<<(9ZS>@p+AJPJ0QdJKhi%W(C`Jz!sZ1(N$;!RK|4peyeO zV^0yAy>5{f#)2WPUeQFPghOb+ODB%KXCX!mFT>M!-Em&$0W$4ZFcE1hMqTN`cwHPs7MaO%d00SuebwDG$>-869=Z3Y-F(9 ztf3P;$#Er?fgQw+eYAzcy)*f zEM=Tun8H4iG#^d`=OL#y6C4xsV6#UIEK|z|{STdV^sNFN@!UeS#M5D!=y6n%dq~rc z!2Z`IOyQD)f8YkCg!wI`C*te>llHzuVKBkA|tPbKaJs)KJ5+J$1le`$Qhf@C% zNE%Fr19I!gfX6j>=gLoIJco(H$LUZSs{>p34ROH}9n5lcgpa?=V9karV0B{-irV_% z<0>EQ7}Ud48+Ac)WiUtx)zi?;abRuM220fS@v%-iTwc$@^Ysp}S@{&bs>j`rrOy%m z@GjD{tDiREF7(Yi2x-lpjBY0*MoPXMP<;Yl>Y{Pe#>*(tB@bKQm9c$8e^KM~6cjjo z2J5z+Z)->^W2>t+fs*YT#>#>`cpDy0lBMI(GW|2Xw17iJGKRqZP(7JCX-T!6ezY7p zo=L+Gzb4n-b%Kv~KeQ}MhA!QkbmF4{%Bj3$Jkfnme~;Fpl-w0eulR*4-E(Mq%RRbh z@+yEC1Q^34anJ7M$ftth*^hB)!4Vf8$by~R$IbnH}KSS}{+*WM#6hJcPCXQcN zKz)yE!kLoQ*fhrnyl(6Qk@<#b7_$yF!!|&ElR1d3NP^jhT_my31azaXL;3dth~FX2 zkgw;!KA{>IZ1aU_B?`bd+yK1lcI@r`g&?dd#aMeW0P?nrVpfR?o^FiBttM5(KiCYX zyVn8sYWnR>Hfc!gpq&NQc=m8L9sG5Wyx<^=hpD23axVzk%)nx07c5Z9#Vb;g z*t~N#@E-X}_&+mLdE;^O>-bDy+&&J+t{bBsD;XwlW-yYaZbFmdZkRDxL|*$w z6T8?7YLOB`MV4%&SL*}mVy%;;LYW(vnyLzGcOSy;@RRV})C$W^rQplhcJbrfqS z=WA`~<=xVtlpBb3snTR5&<)cwvO!y;m|j|K3DyTI=nDx=;7oiavks**jQ8eJcNY)n z&hw@VTH~>Tp$;jBUy!g5<~Sy>1w2n)r-74gFksn3^heJ?*NrXYwEj$bup%FH^in~5 zeG0vKZ!J{{nukiwnGhH>g*NQZp@Gq<@S;4Dv}-27HOGByv(Q6C!=M66EtJ7vc@DYS z;)wTuz9M5Q#gT{EO`M8e)0)soID7Re4BWj4SdgOX8jPPjS7ZG(F8udVT`6i+Nh{_1}SAogIwM?snt9U7e6^; z3NP0W2|fXflKG+0Js0#04?(W&RGeX04@c)U5?5VGY{;G<4hgBSYs?7l%dLVy`KR#g z^jr4Yl0Q_2cO8ui9RQEI6ez#Z1U}a*8HE~#IJW)+BZD`e!R$NE9(Ecc+p3?D(WYux zRnCX)N3-Bgq&zU2O<-+MJ@DPMCb^4Cz(h<8S8?XSm~bV`?sCMS2k~%UnGYBt0k}MR zE@S1~FsoX_mAKg?6S58_LxIICymK!FqV(;+Z02QnzPFcZ?HYpPuK>e1fSKl>DAD^f ze_+6n5boK3^WC@X&BI%Ifjkk<>^3XQ>Zp(Sv^gtN7 z&Ck^ptr75U@`KGkvdP`ZXwKHJ5AjA#P8NET`~jjpDck)U4A&fcsWY3&58M?-B|nS0-DGiMm6DUq`9vL%RGyz z$c6XxkM|y6#nfZ*NDPJw%^>N5zIaW0KLqAi!MC%sF?5d=^!0LMDPvCb?*0JqpE3tt zmuG@{Rz6$N)tcshc}R7wrh|9uA-owiNwbYSa9{X)(!X+mY>_a6tCB_7SnCF}Po5_8 z>Z|Z^FAMB^*?3OqG_A`kN5_+I(M#qR`L*%`^%{ABx7wZ2>$3?hEJKF#rYzhMO-Xgg zeNr)*2j9K|?D1R=P8Ck%T4NGeTTdsa@8yznQl}xvt_4!>RuC!PR?=}&6E0k9CTEYO zVNLZ*x+-8H+K5`>tL`<_Ha8ej`4ox9{s{`S1@+ZNC?nYgeD{8$(aGI#MVV_Ss`H>| zeMj5Y^53+iFBdrT`snG9Bs2&+1RpQY!!t)>VDUr>sLZ%Z<8yeZ#N}Aqu zZcoNg=Er^rHR8hyVhvEDavDl%9>cyrqa^&S6N!tsMlZ2nLyyxv#yYPiSkoB;AL^As zIid!3#aY3R4hab9;xMKy`az;+Isyum!6?_BW$f^WMHL5W|Kbf~*G@Y~tCgq43od|D zwgTkamNPsaKZolR65zKW2*Q_HGK#8Xkk}M}l^zd%ypasLotmI_JA|HaoraE==7EOB zVNm>51r}EdLHAKF9iPw5O*CC#+o;@OI5I!eR8%4j_LmuMYvd!y`+b58yu1WGV}9`Z z%Pib)*T(fZPFkHYs(`8k2SCSWg!;a6#T#YU;Kle_JgU?OX2ZU)vC4>kGT(~4Li2Fv ziWJ~y9mJQ+n^=9U(8{Sb#mX_z4YJ)`NaG7X6n~LKde==*yNEX2@?y#xip_3EnMH!7blDu&YOef%g5NGoAKB!i<}YoSlonOe+*(pXL$${a%=Rx*S4T zSytLtPD8kk3VHS9Ir*J41WIHbc+Q=I#X-}^FCKAtvo)*jz^)bSEKOcKS+y97Qs=|v z=Nag8KOSy=6NICmT+#Dq23n~t#TNAvxOX-YGEb}H*YM-)F-8tPS?_~OIF-bEegmo< zIfk;g3(3H)Ignjf#y%!ePX^NM@S|7>T%TmadVNdE`}7!WELi}p-hx=N&WQ#Jo8gG< za&jg63w=B^7oB2Xp#ME?e0jnSjx8k&d-u6uQP@ClOr9o2jb~_NwlVcvDG%>qTnuYQ4Z&YCAIc=F z;n}fQ)YXL#Y%czyZZr2`|7NbO9}GhAu&Lnv_!J|3RWVe4mx3^v7+@4mZEHxmL^7{0 z1>p;Y&~K5C&+H^XJ*NP^`NiSMpb8)-&B)B%32i1O`!Pez6rGQ5f+~qUQ2$XBhO27H z=6gAyaYPK&t4%Rez8Ai-gh6bT0E*}qFiLZ(;hk0>n(p~Wp0?snP;M`tkU?M4Eg3BL6C9%D$orinokPUsM%4ryQWQRU-9 z(o?+`FKipa1C8gXb3`|JxTOq!{?>t4dyT;(_Z}FGWrIqX1I@ph1#gA=8F?o*&^xws zX*6p)+2MB(1xHophvy&!PzhXtmM9Aht8yaJ^^o5E7BR$SAoO*b^|rvVM# zI2IWLm1Ti=d+$tabSPjL;wIElUkqJy7*?mR2s6eJ!8ExUy=FUNdT20mgr|b|@;EH+ z^QFFS5AnseJnZ+pg0BKhu-pCuA?pqB!fb%+?q<;5nn#RPTj=L;e&pnJgJ8}fU|;m1 z(W8bPOiT?lRcYthR)7B%^|5cQ2aQDPYz zc?*LvoLvb@1&?XblkIfR<=JEkUn(Jq~7U~A5LG_OcDs{RSuSxG9mSf^ju=f%b4XkAB)82x8 zjTCz_%aC`z6&-Od#5?CR@L9%Hc3RM0vS{xN9D2#ymf`gtJj*)Bo|aD_F~Y}Oyf1;? zn{@`(g|>m_vYQ}m!$Y-CdbcLzxq#YNFA!~$AV;JPVFfq$WOj*z_s7?v?vFTlIM#-b zI+O9c3J}$HCvrUZEU|5~1ljTo{Hc|TCyfqK+xS|VY_CmZDh}hKXzsJL-$Z_KL>NjD zk!=!F6Y4eUbhe2nqq*cIJ2FH7eBR%sS8A2v%sF*%GO)mg@{@2X z&J(S)ZJ>O~e!8TxmDp@|p}!8^LbnqP_(`^0?M;Ix3i41=*C@V5PGI zyY}+1TRhycbp8y+V9-I@Mz^30ETJ#_hrL<3?nSnAo zi6#&;Wp~uOJBY7uKgP47Q#h|C^l;^lL0ofa9-3xPus1LY@r*Y=M4t);Bl|_Ie(JI4 z{Gk*-@>If$uNl--O^(>N9U})%@j(*LZ6fX!4C31j=~M4?bTzz4<-cX${o8kqyVU4wBMoPe|sEC+y?parkDoCAHr$ zL3gR0heg)obX$2bZHSA*?&~bLwO9w!H+w*->S1^^HwC`13}L3`PSl)o9G>c5h9|qa z8D5!uV437cKm2LH4BZma@NN;Fq-R3*3J$EDBSGJ7vupc2yc^VYcA;mk1?-G2qQ6X=VVCj{Ir~Zh z9(h)h9Tw)8mcIpu4(^1SU00xq$BKrPCbW519fIfQYT#snK8UeL*kN;rXh@nRW4PUy z{dD30x87j`=^L{~B9;S-%}q$5(HMJoSsjdIiNW!gbKsqrBtEs7i|vi?XFN`rf3NkJ+aERds&6+ms()w+gn+ z%zy-oP~ZqH0n>sD#DB^snsv&G>$45QxY7w|59Rq&-a$p_HAPNt6 z!uaY-WaqdLKD9eYTx#dxpied`tuBQNQf~CC#5iSa=3^J|{iaQ7j&OG8J2KN|I|>+w zlL@D@@L=pJ?WmB$-LKc<24afOPCH}9rhOpH^%3?Its{y?=@_w05pF)b2cMj-!?o4A zaP!guknCtC>94NBpc+5U8%l$bHxFs9=Nxt|E1Z31h9flpu7W1+nX=kz8PrAU(Q&mu zwBTnnsE?kZ`G)VwU9BicpXGwz-Ri*N-&cCO#X_g<-zDA(1em6a-0*bf}F=j_2h(t87DFJJzb{hhHeoZ7?G>b(Rww3 z)2?cB66apTqFH{J;m^m+?(-v>@>k*REfwgVkiU=dYTqt zOlS|isdI#+1{Dx>%4DMh;&vgvuRtZT@osJtut-j%>EdvwKCL za~jw!`VDd4uENY&BcSZN3zbBJaNj*uocl2gr_bi$gsYywq|oIcD9ixGoX6B(d6+%F zo>1zs0LK-@Ipn6;6 zCeOSZu>*|1@1j@Iiil2eEDohCCc*v5^m|(|z2|YBT^ezP&JvS`dOZqO(*j}tmJwjy zeot=aZ-?T+LsZYU2%_UVNZ)#16d;;-;o&Kqh*3GSQa4J(KE z!M2q{-q_ye)+r3P#eN>ZlxO#8N##A_QL6`wOOp_fzGqKHETPYxqcH7^A8kG3gM4#> z8G#k5_*J_B61GP`&**Zvm=;K)Zn*&6cNbWh8U*(LXv;eH7}B48g$I9(z`Of8@laN0 zWZYIG);c2K`C=yYSzQ5tzFJZo83;kr59oo#A{aGNM`h*Xa9^%7JTFkhO^a-RryfY} zRU5o>Nf2~asle&MrFcH81RPkYu(dk_6fU`-iB=@MXDmnO-b!f7*Msww@t|O~fh{O{ z0PFLH870r_!Nc|gy>QP9{#=@%->-4l-)q&->NlIF+&%_kA6~)b2lqkP{2`<6M;kG` zkqdBgGx^hAO{I==W4})epyBZm+9&joy`%F1oP9J(KDo)EbLcF#YQR#E;MPVwVx0iG z+6{ z#{zwp@?m3+CC+;{KwA_p(jmtZ>S{1ZEjLt?P3~C?t+Rlu`QI|^T0^0#Mg?6auj8Ln zeYnrB3*RkJ0hxWalw)9w=k(Ip?H{E<_R*)9xtkBK+-w-Hmt7$#mHA+0qzEhW zf}x+gZdW9alBLHu&@v>0hZ62k1^ENGCs71sR{o?_H+PfG@v*qw=pK8V)kQvg=ixia zr`YY>jhm+AqHOCn#)j8o+!*&vjGj`8kt-WX+L;h!N2_4c<4aWh^j#Vs=z!~gorPDw z*TRJx#@sl%2t8721)KN8Vorx5)ZZBkq(cYhY~Lr@;&n&bUCes zb*uA;&oLJo{b4aI=brCQRmH%P-s8YBP6mI2T$oYXLdT0)R_(`M)8_Mwu+lyirfc&e zD?|}5r|yH(JG&W2i{ruFXc^u5q6W;a6+n>qBqKy5k2<)fV@6LG9qW2ZHk5UepUfAG zR@+N-^i>8@BU7krn1{!W`mj*Nj$6OXEvZdYBV}>s)O=qiaa74`8?<7Olv@swEIU^eKb?ktjy&xeuM2U$XT`7)VCdfRJtmIQnkER-2``RuEAjL>@BL4z(R@ z6Xkrfje&(nZ4&gs9+pqzE?nk z<`>Wrnu&kPx7Pw&ftYc6)?G(_BBUCE+3$dZX@cpnV`^FA2^l$$|9lKNzS9)Whq%-`f zjiD{G&av%x8G(YO2H0@?{J6nT8q)vXEt6i8={LU za-fR{(bK!bXo>z&wDY$Bsoo)4c6%$x{+f>u&OCu>&#dv0vntdrs)QBS0f%>m!;3^s z%n|Q}SA`moon+1MytR&oO6#*V_Z@C)(N;p8$;)jCVxHi1{T*#y?L@2Z*&*MK48lW< zvGG9!nmWpYG3yF@nsydC-8+OT%4zI(F~%?jH$zxWAx>D;(&JK6*m7M6Qg4Nj9nA-6 z5a$;(zR!b8H=COMt9Qaw*DvI;+X@hm9i#WY9U&XeJp+M}`_Lm5gh?h27@2dK@owi? zs0wdqOnK%C*RpzH^rrx6T|Y(~m+4>!X9fziDdDY`bpR42bVXzkYzuq`T47fqW}Xhl z{c2-3x^Dz|-vo%wiNFw@19X>%CavN#gvg3xbfIl9RafjMuVzmH$+I$4Zf-ABzA>V* z+V1#c-EQ`ib-GY<*%GVAp24;6%HWq|PyDvzfZN$3dWsvHI;U!eikby*|HBPJZJR*Q zDGFq)X5o;~F5uxu_KKZDbd^#Pc(rWDlOurT;(72ye>RxN2vgz31u*FqiMIruan`Dn zWNOiSy4Bzod*qS{>}}TN_9mI4vU?m>h?HQuMhynLEJEe`OW+n?6gY9zaFc!w!~4Zy z5DGEJu-Oi<<<)uGVJ{3`9ZMi^TLdi#ac0kp*+8Ax&E(ZQDeT%mgAUsALeoA`jDD&J z@#i|AH>-#?v_{azE$d;jS&H00mj}134!}Tv9&I+Nhh-0Bq5IiI@~B#cwyP+DsBbs% zGn2+I=XSy7vQy+p=4-lh^d3Bz$Y4lqtb^D~hl%WTOIQ-A2U%0r5(lmyFimeaTug|; zQ*YyFU3)r2JZqzO-44>?8@I@7Zmc^hauqjke1xpkk*BP!t+2_Tf+06gyzpHS^_q+pO5?6&XQ;Mv2r(G0 z0vTlq6wf*d{u=i|Hb;>DuJwb&thqSPteBk}^c;pgT^ZXNe-o>x%*Lt5M^s5BfBg=mE4QvTIG zxKyJW14mWqm1%7xd;suDWI5hnZUPsx4`9u)Lj0I{69?bl!O<57=^SHcg7JDZa(NQm z7APh|=N>Uk)XHe6qAd0=m`2BQRT*dXZ&1+#kHBz8AN$agdRY1-jeN5mq%9+-LG_Ca zUR+cSwjLMgwhQTSiGKrZ_#6sPXX_)0yaXD&EmpT**Fb>4VYaba6fX1+CAaxbz?Er> z(aZ8QBy(ecCBov^))I_1{U51U!B&RbXoeNQAorAM(Xpa z@dI-dtBZt)q)ZqIlZMG3WpqaBbcR^xa~hkG0vugkF#gIQ(ox!Ye%b&mjAldBoi{XK z^CDE=e-z%2y=i0a{YJG=8n#Il+H&9iK%qmFK#`LSwGcu zNCf}G92&_y3TaQj(Syn@FsFGPzFyr*E^3v5(28jwlv4zizh2QrTwA6absGeta%kx6 z4e%oE2vFtAuwT52dX654Fy31rx6&WZ6du5crPj1eFpw@-0rb$vI<%K*C+=!R$al;K zgq`$B&igZvIrXPi6{{Dn^Hsrsk|)hQIYHNN>7k!@oS{AiIZ)#^&VK75iwf@+(6I5t zbgVoSwQ8KuD*qm%TuFi!Xxy}n$`ZpW=y)f37YUx`aKoTzL5e2;h z@-pEFJaoNIBIJ$eYi^ysNI8S_O*sO;`|kq#M=|@6X9YNZmm!Pd{xGJT-+>Q$B2lih z2Cf-c!?G`gj;Y@uOBRy-Zu&EW40|m?>cKjKfgm^s~ug{w{Rc*@M2m$8g|` zEE$urCkBsI!Owmkyw$RV*Gn=Wky!-4=ZoX>nY*y^-6XZQlR?JetFT`)5MG^{58p>> zX!qgSm^#m!ZkA+&WTzbL*>#bzbN|N!@Wwi_61pOL!65_n>mib%yA3Zk{qo1=9MJ*s%8{jV?(An6nXrL%Zlw z^9PLh`TBUzuN#_FtjN!rJ&kMf~@CfQ>HQ z5SCL(3Z*?^O8a}_z?o07Z>&NFH`cgnzA|U~SQC2Y*@H-1CXuyxg)*I#Jo7nDdi_QT zue1Pp*snoZ-#6gVKQYAd6d$vyx{!*`nFm2VciXbI)`BwoAWj`rgj@{+$XKX>Zwj37 z(6mzAC!d0!PE!KOJ*2X<6W&&QgqT4+cDqV3#&+w|hNA*ZFS!C-sd0=qLho0iW z_QRMq&aEd}`;fQ>Z%5T{XB9%erE;PGZ4otxK@+ z-UxNsWJ_d)dWq*R7k2SuU36(Z+!iwsPePnJ=GQx(L<_izH@c;8rj{y4c3>`tCuA;` zejLZh{z9Dk{4Cy_X3i-qnubXtk@!$cmebzegu^Xv3^}(M99_wJtnGM>Z*CvMn4Oqbf!#7Hf{ZWAJO$N;6&!;jeHx8nxR0Z4BP0-uS8pi4qAfma4_KylOWrhdg)iq&e z<#cH>t3ZIMR=OX=WjI*Ua}w{oT*kR|<~B{7XOC^M!!$iBlbXa!l6yboI0FJVF;He0 zd5W4*=>80R88L&?e?ks#ui@(B;0YAvYr@D$SI&23#D4!J=)-5l5jN_^AG2n1l1h{~ zoVnMr_}T#ORa^z8n-@~&9$|QuuEtIt&VUfm zzH@jvk$M9N=gM)++=p|guMc@($ffsp{9o}?|95|#nZ1q5 z|KHB^7(WSUFa^3Ij&G6UjmzqVqvAs35d(?fQJPiTZc<#(DH-~ z5EXvG&M3)Y*z-EU_|_AE-fWoCR6wHsKNOvJJXil0$0f3NsF1P?Wn_Ks`;ZhR6{ST{ z`KlC(XiBzhDIb(Eh@A`C6!7$jo^evPu<^_{Vt}%e>LIFcoKgeax(qF2Vbs6=B}j z<7_1a(n^;k8t^Net>I=k?WzKp#4Lf08s#uqHi7lw^akI1DWviGNqWEjJekq|gh_B# z!txM9+%wirrYZt1S`bN=bsvQt$BwsXD^7;xj+@|@pg4pV^V5Hv>dKS3&zorD$AxXx zWQqA*;wPCyFJLe4Rox|KjfW35a=U)t);v6zF9^liR)pRb!pW=l!}FHAusvM}#OAq@ zN|pbZb${Q%)Rxz3 zU9k3%8peA^;*XhCban1ah&Ek;{@cyzWF;O*-uy}iw(*1h9L~SKDo3@Y0wL!^8k&tr zSthsfS^k*_BO{-!z~f5-{8jlu#JT@-*meef>Pmq0_YUxza}AdBLZLid2Q3^Z`FGM0 zCKXL%h628@Z{u=#=Ymd?12G{mu49dY5^u=Tp>&w_(;rj>0=OL|9U8R6QU6~oMw7GT zSBM#Wu8W0|O`K~{sfOkoHKCzm6AYhA2S1r;Fp7D?0o7zFy}q5!oar)csNG^EoWOZ1xDRWhm`_sww;MX_Xn6VpBA3$3}e_Xng4aMF0Fo)!N;ON=_W^b=1Ys`SYOm4Z)fJ)`Bu$82PkZ z6n%0ZowPkD!Ugxa zZc1PUS@I-@jf=2HQ#mzUljH-7hl6Q&-U+(>xd(QhGQu-Yld>!PsuNGs-j>9;Ai4ywDtiZB&YtZiDEaq;FB-?5n zj+>U%V&D5xR;pi^9`DkGMMbM2g7<^^%$h>gbu&=%oj?AOnN1(&m(q(#Dp>YA9&_6^ z;Q8S}Hco2|#@A+}lm+K)YBbaQwBsPGoJcau9#FY&AIPuBLYgEY0=ZLy(cISq%=wSw zz%DDeQ5}w52UkLp^*kt~JovO)8OnEr!`==tsPo=OoR}cY5K?5z)62>J&l0eE##_30 zk{UdC3*hFJgs~ewF?;v_BEHmv?6|j=Ueccne3AQcg8fS?`89F>?J&}*GY9{!InlDq zPZd;_guu-&|A-`)_X}5fNV8K-VEQa2ru6;<`#FW{I($jQ@3Xzhhp;F{LL-Fg2wb6G z8pH9$5_KTHg>3IrJ0e)%hgwZ$_$;@9P|s;}v7Rk{fBTJy8-Amuqu*%6u{C(MQUTj5 z7SdMjCl;^H24jlD0R43$fxfa!#+pCgWVU`eQ4NiR#QFqw)Bb4ue5j4SxugfhA2WG7 z%a6fcg$}ZKi72$WJRu*g9#g?;6F6eCj>s7whxzvDJa>HSmP6Hh(X`V>`xCx=k<}6UFdjNZOjDyHNgBHIP zcHpjDKr9ZWlL{R%+&1M6(UO^hK8M~hs#T#}H#Qfxd_N19TzHH~jsuu(8vvubS0H%t zL)Px^8MwW3Dr#>E#D!{})Yz?sIP5UxJp8p_8ElH$xkCrNH1KzJ75rS03^9sa7qsRE8TDv_ zvNI8|p37G!rm;ZHp3=a1J_zG+Jbq0LbdUMAu-@AsX+50-0=QBWm3!bDM{+C)RHd@hF4$I+rnkyVknhG*IW`VQDJSg}nP1d(7 zVBnsq;5{pj%hu0?)|+puOmga2jHV`6}^1Jjdb^& zLb(SJyeq36p1MmI@ zfX~`d!i$WC{o=`xAAXpwemVvEB=0bb_MU(>qh=`GSO(n-|5A457Eo9IKn~m8fx7m1 zun&nPKkf6t`Boq)nGpt4oyUpR^$*10(jsufRUknv>5~O}(0xG+`3|Xc){k|#do+|- zE-Iw!FSNtp!c15eG8qm2%)#2p56CawEOJ458@<$O2jN;@$Wm^uXntEyQmftJfQdbg ztFr=&U%!dusgra=Z93tf+elA_Sa5r35*8*{ZeJBB7PPU!rwyBAk;D2c|BGK>KW3a0lJefk}I5tlk@Wv zyYu`3To^}iS&-WI+=U2e`duZW@<5Thd%O`Y@IYESu6%cE|b2ug>$UC#97XSDdps9L1 z`kVLD)Jdl?!nq$!4OLo)bX(9pM+{bHoxoEI5}Do4-V%{77I@{rNm_Nx4)VC?#z5`` zyIyGIn_HMX4;n&U|&~lRnGsYvrVG<8-te zbOyf;t}CXO2#Up7@O+gX9nFvj?SX76nmq~X8kd8Z>od~mBny={+IS~jddQ?z=YT|? zh1qZN$lO73y09DQg+&!GWLE>Hn|q-vI+hGX^FdOUDcmqZP@FqVRZm26S(aBA^f;1g zze}O}5>H^}qZ#1GYYWp-aSs6pK zzn;e7m%%v3Jyx>2MyZ+pBj)~(ak|eeg`OJhp_h)G$6bqBvHtonc{$$$ghnkeyzezO ziWK0ldupw_hILyv&lhg(N>yw%UebXP`F$vRc^WQNYQWXTd9*awAA_<}F)2U@N1wLi zls*;sX6*)nd;gGCjr-7Uwgj?0+u@AOW(+)aln&V)C4pBHaHM4kmVdoVDkSzXV&D3i zceA3P?KJ0wZ4#oXN9x!O%tai27>equlCAn8spyAOh*-%7e8f9|&y{1@2%k`VJwAXQ z+fy;}h#Fq{t<4x5J4K4MtZ>)q2CAwThwonE5l-XzVP(0Hzs%BY{ywtna-wB5A;a*K(EB;zB{v}lk>`U=7wjUG~zFc~Vo5Paac1`Q6Sfp(}4 zI7r!|ca3n1OIki%DmNRHwB4XIYltk<_(+GB>(ZTFMric15ROUgZ}}rPN?tl0rjy%l z(y`-JV5>Qw(5XXoY)Kz8el{PjznTIjYQ^-PY&ay*nXshWg9hn3!H(s>$;woQdEyX> zbCrsiVo7e7--)0gQc5*nSA)*=6PyNYf|Z|=sphgxkR&D!KUY?Bxzu|!>&|DA5zq-L zOYf50Im*bK7l(wHY|?+IkE#W1gm>X);L@A`lWqc3r9{Gtfa{QQD1z1gF&E9QrIA^e zU(q>9N2y(gCWbU{f0Ng@sW}r0M+YJp72%7tTs)P$xSC6@rxZffHz`~nb^>Z-x05p& z88j@t6bzFrX!z?!I2E*jzFGgBu4>tgqYg#%(EoF~p%x^@J0(Z!uIgik<_a(qyGJfdw-8;P6qgHhXKxOeQ0wjP zps-*E9GY^86g+MsI@KGP5(9O#3NBaR3x(JO$5sij|F{g1{}aNz5Bf<{_*x4O)Fm=eFKR zR3tdsf&o@RVDnyrT{9;Y_>&5$({EAyQdGr$^KFEJr*lB1ZyB^L|4Y(h3>PB}_!+Z}OjZ zHb~UD(QQMnAhv%NJ~x`e%s!cf+jmU|1x^FnAHELiHZH(VRz390XQVw`E@68^B5c=B zhB<*(Ak%V$%VEBt#T_qr7Z0hS{e2@+?6{U>iQB<(Woei;kwh2%F#?pILdCf6D{DVT zJI|biD`MqDJl3?iShI!>8`e=J9 z54>M9@uK0lFUSb%E#>iCH7tk|9FIk&s_7q!7ebm&1@z3M zM7FS|Wk}Qmo+d=G>Z^2M%^h2^?i|N&h;X2VyYAzYr61w@m0iFuSAj{I3J@B2lrH!@ z*)s8p7X(V#Ktw1v>xDew{rt8UY8#T-l|MB>V7(D&IAlR%(-}zK6h_{4?!!;6ryz2? z0lK&JQPzxO@NAaC=TfP}y}pqAxqlW^@g7lrlE@4n-wDR%uUWgx+sL1`XpkK1A^Z4U z(4{wvSS?C}At_%FKRB68&P;~f%`E+EyBoS(ddWGiL&h(Ahu$nz19A5jV#jq1S6=>2 zKDyp!<~fSM_bLq(uR8K@J`BB@J>r|dbX=|}-32RC-#fGpIFe}$)C^XWP<9!^b4CXL4=F=|&TOjkd}erdH} zQy0s_-`4juc=|~+3YdmoM^iD?&yD@3wE*_S_E4<=VHC$&V$$zKo>v;gpm_0CaNiMx&&vYMIqMqooNE|%-U!)sBN}#{ zxyMw6pC#74GvM|u2?%zKBkeslI5Cn!x2p=%3fXFU$896gd$}DFbJkN2l~Yh;*i3uY zh|rWZYdD^g4J^8159c53h6fd9G`Ct1B}+tcuQZqE*x3UK`UT{OSUMfMRYx2TeI@In zjKJv*$BUfJk5PTmFwW!hIw6^m(_0O17Qcir#XeZMsTc&cEofY9G#p81Su;6jlHSe_ zM$OylwN5i8T1kSswO^%~Om>SB|3PX~Xhokns?d-ll2mGSGQE*-iy8PW4eRbj;@xv5 z#4pvJIy0ZhtNr1yQbJtX3>oOV$cHDK#)$2bYj7&&26@c&;go`$!1dQ3)^&y%$j5p>w6ioU*q02& z6S?5Q+-9V&d}6$`=aKM2Gu(7z2D(Uk<0d>$+=7Qm<$;&=vmDKh!TkOsmd(<~Ep_r{SpIrp4F_~pEE6oJ;Cl}b`222+ zDX;iOdMnpiXk^F1;rd2aS!zCfkDmvPk#CqrqjfkhLZW(lYwtY9t?Ur zsowHPB2(x?LqAA^f7f5OLcWqsoe{%Cw)?`d!|&nRKUWwu{>A>zM#$aI2O3WZW$ylE zc|M=not9^r>#8G6#R?tN>-GedqQ~UR;xO`4=@kw9T1=1psHbsB*0lK2KG-#;3C0I@ z!>(;Tq?9QnM+Q>hsY@R4zY<{<&qyIgH}=6Tj~KG@63g+=Y-rq8d5GG+0v=3kVICFA zV#X~~nk1`<-HpcNX5UnvGwMUp&v1C29ZmU;M8ds~xxn}B6kHdnr>ATGw0!$iLu6lF zhVogCP@$9!W1-$$A0nLy1TO)X>T&XJrUfnvIRSoBIiz^e7Fv_g36z<&NA#t}xS${t`ZcK1!UH;7_@WIH8$OXB(cw*!^+rVZMCK z|80otG=1=^ixVb4-A)`tS;`X)1}*E$WO(=ioYkv@Ur$p=zQhzr=WimTFF%l*vxVW; zwj7xI-55NUyk&#!%&5RNTk3Y_Bdavu2G6&<;I{@tU4ds1d{oo zc`yv_Kb?Z>-ni4w?#(E>))(Ycw=ku8>)5JVepq&X4_SFW8f2IPwqE@+-Cw&GioNn- z>XCMuXM34W-x&k`vp-Y)sirX6TgEYpju6*E4I*Bbza^4OR?;SjNHD4N2jx z<;%SAaeOO{j-S*cyYxm0o(*oHCJ}4t9vH;!>#A_# ziw@q|9EQf6{Ju@1 zH5dGE@W{@OTUfWl)pUZFhlf!U*K(T56EBfgZ~ZT%h1mxWqD*mr$2|JfcbK#WPHMeX zSB=+Caj^#11e8A4iGe=^>EiA>tWeX1emVm0w02{UIJc9AyaS03LU>zm6RtWw2~3t2 zV@mpcoN#$yzVu%Op7*gwxnrAJ9+vjAQ(hTE^{cI)F<*8=2y+9FY4n+-(#+; zpS6mH2wp+g`|XTv>}wpQ)~H8iu^SU;&bCw(N|wYGHDax0Wli{WKE?1*Y20*hGU#U& z;s;AH7_`tte}O`L7e7GaW8Iig>q)J323+Uj%2q1KvD12QrE)W?7L~gq)cSJsJj|HL z$Fs97S})39!ban7v_$?ODqcQ7{fzCgewhH;zf*vHQ*^QSfFG`uc|ipao+J^>2l{!- zV$}Gv9L{~xBCFjC>FfG^jJ#Yn#>L(v!jaq#bixq5a%a$ab~0e|od;3^d!Xw0W(wTQ z`uzA5EDTAfj~k}9T4_IJr5d)fwb`#xWq32BrHG-dJmO$rC~h*iimU2(knzvn|7i=FAz=A=(TR2bGBU`em@CKpYqHH9}z!g-!l)=sdU?*KAn^ zLP_^2JT!$pW;2Px`+Aap)c|b9;&IE|P|_%r!DaG4)96#(tbwo%4Z7ltk^$eDuGkoy z!rMeH-Z{(uNOYnntK6yn9$8%Qs)1S${~@+Isi?UA5Ix#5ANTXgaHh$51o6Jb?O19;mWf#Bu_D2WTAn+yHH zkna@SP23AEPZ{z+LK1jH5?*3IbUFJ{+d1{nVi3l}f9qg7*d%)2@ht4?ZG_{RuGC_q zK3+*NgWY30A>MNn%7@K`;@}*R2@?RvWqu@VF4OY9TM;x3`61&)KkKo+5e~N6gXOn{ z5Hlfg55~ zK55`uc6EXZ0j`oFyjGqe`3L`LJKAW8(_NlLP!=}0nvGfrvHdfnk>B90eVGxZzmZ)k!zyU?sb#& zY4*{1VUwu7`*Qe|cNfl8=`t1EZh9#23=s&q1~0X$$R3IFFkLK%ByJGFqP<&)g)=`a z*=3H;zGkyw!W{&aP0;W_1=XJP5O%CU&`HlF5jH6#?fG%=t^PssmYIMGY@|(-R^z>m zk6^3PWis$_5_Uaa01MW8(&g5n;C82p_WxRlLYJywPEa6>zup0k;rv7=V?HSih=QBb zG9m1o7G5L|sp0RL)GL1_9d$SXP7lt(-90ks*1ip2@@mPK1>szLu5Hg*a3+_=wchx2^gPS=|cCv~S$8RbGq zbWCURmGu=e?9>dbK^>4haQxa$n- zesxmY$EMNDTyPn8ir3qDqK)&*2$I&i4BpI!)iNw)em@)j_w z@!-W);*_O_)+7+(+;7ljSq9)VcLNllCA+f30SC4#V^5$v8^aM>s(xvq+@vM=#y=V! zoCw83f=#$>@HS0J_=vwh7Lo@U`51Wd2G?1%pep^&yxD8!;mBkcJZ^V`HyrAYNA|YT zU0o_rAmxse!!xjXa|maF1;x>~u}k?c%W^KeC{pXPEfPU1Fp=W8jEDG<==S@oyhU;akt7JxN+*H4Wp2iqOM!Ce{lK;TDVMMD>9>eyTW0pWo%7f}cFD5_N;m!WC3P zKLT@)?*n<04zkM54rQ`ku%U&UO})lggCWj0#(4TVkK?YE+{Cpre5ml2DoXEWqw<7$ ztNq8T*t9i^cXsF+)_%Q03w*EO-qW!}%u5=#UA2G%f69qi{0X$~{YQQNdeZ%}ad_#+ zANJTZC)gnKn{@ZAB};R%=(9!HWTJcuxo+Y~-gpW_oa}>^=UWZnwNeDQWmJ)|52qn2 znTOl@^2i$7P;5w?+&V|85*5Bvv~c-?%$oJ67<+~mISixXk685iz6V1y|I%B*wzOL) zn!MSy7;WEn;+|E6x+PQMbzBu{cUhvD`Z$@IXN6r&cUeXv0og!94Xgyn|(K?l_Gdm*99mVW?!}K}Q0$XvUgE4CMU1 zGYNBXiIX6_Skz2Is@!>NI~R}{vp3>uwLW@e!Um7}|7y85Z9i1^eV}JdS)SU_H8{26 zKf1wkh-T}2r02Oj+U_Kv86LSb&u}ZEwhQg!7yv`q=5vydrSC}+UT=(N*(rc zOikZ7GK}--Be~s__c;n)>p3&oiff^Z+p#6I6tKFqctf?#M#(gr?`+hCEG+)F5f&YM zLDvONf{!nrkpFHw(9a?PxNn0Bu3Y2}0wz(oCB&EUj;STn2ba(ifpHSi@sIo`^^q1P zM$w3syI}6?TINiz947PU)2W|DQT}oQcGwHyzvmz5$YEdB*+>!lg_2mO4@Xg2>L5M) zwS|mwH$!Ia<8p#FPB3&kinJYHNm~_^V7{grvAxcZt(sGy?7ye9Vm{ZG!A54Mz9ke# z{D*ta@Ih#G2U*zgzUAWk)i9QWc$o8G}zI= zUXl){%8NcxWzF|g`h^>zeY=29DVHZadoA%+>?S);Z^Ant+~~ydHhOBycJ3aE2VNgm z#Z}y%Q(PHN_|07)h?NG>)cH_xN)^%;>A(_qZ#-z@0^XvF=z`lt#CE3&gglmQ@ko3? zI+|X=$Jf_b#oBB-cyA#tNsWb|!CsPU`jh@=K99KP=R;8KCvG3oh3(mwAVfX_UJ104 zPwA6E+r5^qH%*1CH)SyWt~BlpvI3m|E+g)?2)orR@R+g|PW-LFuS<(i&Z3W$4HeN< ztU8^MC=S=w5J+Y&&^qUI+;z{5tlI4dj<1j7c;ygQO)+JcxiGNN>poN9`-$2tuO$Vh zCFD@}8qh~4)D2ljLRvZPxO)ys3GhKa;al*rNfVtqX27B2kLmt1{B&{h1o8jVPfKe@ z$deg_4sQ{L*T1Atn;L`Ze|j+2_89D3@rW^AdKBH6JzUpB1D>N2KIn6$SKAAS#u;@u z8l3|(4;w(SDj%F;7Qq_Ghg%Q3Vb-56Qjv%jJr;^+3oB5hIvQt=hG1c-G0eMgn%?@a zi_9uI&)twXNzRA9W12WGM^;md@Q#{OB^fVxr8)rSJ7?4Q^|r+CumU(%iou1P9Pqez zfa~JQ!gcQJ$K&t8ZAb`;-W$U(jRhUuS|+=21{^KD0v6XkGJMs?fmzf8lfPuc4%Jqo z<+T!Sl|CiMMjc5S=ht;w&qV7p8EV=dio}TIXczoH^@hyslBDL zW6zl7{<$dDz`))~e)MtWA}GI@3CSr6csplS%V64HM#G6?dD2T9lkggG+4hgTbn%3F z&S7}gm1E%)$20sKmxRfY!{v`2;qvt>VdJuy2&3I(Ag=`7E}Oy6J|!^e^TQiCS21GK zF%$xI8lPQF2IgI)gGGJhjo)jUs~kzM{?Ni06IV{R9HEDT^&r(wfclNclerK}{Pr55 zsNfKnZyID@H|4?NyJe7>2E3!X%9Wkwd{`Ny5zgcY25$E5aXNpare`k^!bhhC};M7_fhIM zjq%h+JtcV(zKG*H42p1>{3aTd!fC+|rLke+AEY?gTQc8jQ7>?rWzLNn%aUMg%a(Iz zpw#vcY}gS^`oB;%zc~}&ascpU?jU92CG@I+C+vCFNv2y@5ts09l+T*uSyi#notH_6 zZr-8;hc^$l6c!afRc6#w6``P^^jm!v{z%d#ahCjMUr%+?l{#7SwVZ(=Yq-3Y1p$%4m%ec zke@Zd;3th+!m$NTw$m8ycU*R=9kj$R6aAAt zv@)m^vVXJ_r?@{Padk%XmtW=dmU1!}zT&gI-Y*DpeWfi_q@OW4#8O#3&hzh@M6ak$ z!}1qCkXTd)-4YW-VwEahJJ?K2@{?Oqhy2-ZCvJB?o!Bdem2135w4I;dH?es&~H}2G6C_^vo!{&EF5Z zoWAo4NF7}gwE-Tlc}xcsl9`}8<{-0SHcavGgxHv5bnqHvCP*&0JvHMvX1DS8E=#tH zw+xPE36MH-b;yzd%rAGvYl9>7^IJENuBtb^p#XTiO^lT>mf8g}pJ_%?D(t5RI5~Fmf9=+I zYyrUoP)8mIFF=Q!HT3!UR0dQ2u!eqXQ0Yz_vDy>@QHHZ%+LHrh`kVq#OLMWzt>(BM zgWD}dPvlzWJ)2{B%$pDHew%95%9Hgq{U|R+n3rgd5c$e!G`)~Zp zB#GQW!=Qc)zO79Ko8QvLxK37aO%?4aI||F@DnW>d0NmeWL0a@z!2K8r&d{6=ycxT} zrhAae1k}*|OWTQCiUQ;Q~SWoj)?zuFv@^ z(tAk8%punM$O4#n7lFZh*JE@;9bF!LoAd7y$a>-3@SN*_JO6d2cP~^zeY+#%8mxh( z=T5_waVhw?P!K)yMX+?|9C#+)Ou~NuCK2y6AbI~=^83;XoD^A4W5i}*+S7%Q9@zYcfo1?nk)?)n3 z5%z%Tc9JJ^3=egsQrCtieAa5rR*Ku9U$hNe>0N?0ch{rA!}nDAy)6Exei}_xR8W5| zHyfo~pkw=sShv0BakBuAWM^CPc^B*F68nh48f+Z`-mHBdF_fY}IM56G`;yi5Nw*vm}r`Wc(eP~~K z6yF)iz)z!P(0W;c*6k7}yDKxub@3N8$g~beZBNtj7m<{fY{6$m9W>ti0toE90rlJY zU}ff6xFu?e?Mmu|&(MftPOi7O;_#gQ>%T>Y3`%H2urC^Pg@Te_D(Ihyf`nt?xK>&a z1B+(1Jaq4X+kNxdxpDEZv}uqT`P4^a-kVa#KT~nW&{Am6(b)a>oFbY3h z&v8NnsGju%DT!GGk;`YG@|j@nwn#YYn?5IrZ&Gjy*VTCNBnjtyOGCXgnHcUWLG^E( zU@wY`g3a(gIw6&aZ%-R@dO#P^-xz_@ZmuHNZrvmQYCP$p`S)15c_q=XpJ&k#W`pCS z??`~{8J?eOHvH;kNz9}Gcp37C46MzBpR^E<{yYuM_K#T0&-oY|RS7yr|BzPozx3nJ z%g_|71_#cZAW}3QeRL+Z&RLs9mvdbMuSX)pDfK36HPFDGUtUgZH0p70;B{(sO`go0 zbQz`BJ|^F4Jjg}gZE!#H6x-e#hJMedX(k0jSSi%!30j0>Jf!YS=LtV>ZS-En9mMr&%~Uv>r@;Mas|@kkWCVGipe zUAUV)H)){@AMEtIg2q+*>Bz`VvVMg&Z8K_Qjq8))jjj$+4y%N+D^29ggfZj%?>y@( zDG9H*c~@2?1=haW2{C8mVHHe=6G95;6Xr)^8UxVhQ8*QI{zmTI5P}g~Lpr$80O#*3 z#2$ry+`eTcHX2&P#EjS6E!y)`vFrmKtD>lF=8u{gW#n7Co~7+AEqdxwnB|w;2Ft*$ zQIkGw1;lG{r-9`s(wJ)r`ROM6J5dkn;W z?}NG%J}}-~+v2a)3BeC+z=-3{D0}d;Fm5K$u*FSFbC2< z&dr4^totnw`%9D1q$3F@Ci2N)lOnp0>xBNYFQEZ1R?-Vjvsn?93D#bT;J-9g)KlAw z9v{BYtzxxg`{UKnA${ zKOcO-hzGytxtyL%HI{OB5NG6K-5645pAR(b?I~`Ci2xz9aM&H3#?IL~500(lE+G~O zV{Sq%yh`4Nhb6dtTSg2}vGw32e+#mo7{SGgFsdzj0~*$~avY8pxGB{St75{*YT0eH zY=t-6@|}hmKRV&~v45~jpqi+!W?-srG?SfI3$Onw<72xY6mr!GfRlhc*O0;|GCk_LYjE1 zWG|5%xd)yivRLS_2;ZIiPWuG;$oZ~l@>DmPcJmiNi+UDpT;Yc_qXBD}$28A0kvhFx zh_9nR(U!PYKnOQ(fJQeW9v~<+G$W;pY7t-4|O33_958~_< zgW{(Js8`Z8;;iw5+33&ZJC~2+`ej1mynYC3%7FrzcKCKm13tw`gO^hX zT+0?}=@BYqzW-Q-3p_8df!@>b_nRj68keOws9DBofsq(tbqu?-ZDE#^e zNWnD?-qNeLNaUN1>;QM~Ph;OD^6^m&j<|}#u7ln5YIi;3#%bekKPzG9kOrqQ8_+dx zPJ?i*spYt0rNx)s2Q23s1zK+2u*=fSK+ba3r%je}K}+D_rhGWT7Y=fp7DD&OWO8*> zknZp9BRWqvvb{GJ!{nh|P+ymbXJxf)G+3GrbyC zNGp*;V$(^4omLYEo!TpL1y5?KpZ7&s6{v}WE@Rh^n z-{06pDdoVS^g(oyDkQDg3HuBhz<Z1GInq0NmfFPWC(qhi`3H$yP}Z*tseVc5Yfq3YP%>R?)#A z?oMB_vIYq`m<@$RXUU$aoW8={MAGGU{|K>Ta4&y8WZjd1XxnpeD|#`!ExSZE&J%~4 zXJ5%#;R?u>Jc#^TQt`UkX4n_D1a2Sw!HO?93kz2Jk@(H!q+%$P>+kCj-D8qmw>J*` z?EjMe;kracb0s!imIGdY5ZH~%p+WrxG#L~{Lpd{)E$+eXuI;Ra^I{yRw87rubBuHA z@s>XdCa_Mp2HY36k$Ih+BxuHR?gqqS`h%Pz^8YTALn2A=qx22OS ztH98%mh@WYlO>xaaMB)6^s9(w_HRsswLV9&bE20_+H{G$804p;L1QGnMgZT$5YW+* zg3d!GG-;>}X!>?WwIK>;zqP{$|H*-&SUSXaaU6@SH7$pqiQwW5d*HKSDbINKdhTbN z23famkr?+7fZk|WTH{YTJay2feFNOJ%BChU{q*RW6A+;IltlaYQ+GZdtP_m{4~_{f@z)-4sw- zHx&a#bLh_R ze-hUIJhYUngTzyQ?peG~H;jG&dF?)|+V4X?g^^aN$62kPBxG8f=S@f1Dy3F7Y%QMo zo6E&-SOgRQ`+^TF;z}*SGH>YZPy@2e@0_p~pvPR$@Pq5BNdfiC@I=lgYe0sjwQvHHs3Qklpyv3=kkZu)G z``X78-uy(~)Q7{|XI(J)tRyrA`ol-VL$szg1`>VR*rx3oKo4G~1)1*j;o<$=ngDJIXF6ng@Eh^@=+*?ls24%S2goVhKW1VnLWhXihgF+M*f2d zO9^mJpA9Zo#+hx=UZBF=$5E=Sz#eWt-ear{Jy{KS(E9*Bdr?mLJi~Ef)du(+S;Dq; zrm}K*pIThqt}+kKO5va5CiM5_Ffv=%3!XdbP}n^}s;oZJm0Zs8ZB7%Ht>H8;pF1eh z(ar7)*aoq`Ey3y57dCyG48Az{3Or^_#)SSgIPG%=ea2-#Y!>pvmrZ~0p}iqk>o9oh zwHICu&m%?wTXFnTwd2$lJz-@u%SOF@7*S zVh(n38n}9*rLaoI878}N@l*XjQ)QDWSZ$mD4;WJjoA-und=-q3uT1_Q}+T~G2# zJRZI+@qsa0`{Ac+L(qNMN%N<5i($@lX&{4L(duF|tDaCxqWng~mZ@ntVSgMB+{7S1 zA(FJU@$ljaT`0Z!iTZZVM+?;@xM5Tj&UBH(CJ!T;&Dw}$nr*NmG+e|#l`OhYY%6-U zO;Z#&ew^s5TMg?nCXM!cZ~&ONcp|L3!sH%0MZ0Tv!M&qNFmE{_rZd*zj&hbMueO21 z-zGv!>=9!6BoW?6aqD7+K4P4S5GpF=X!6Bw+7xSr4GbT)nd~MH1>Uq~Jr`&B?iDKb zEJq`ye)MrbFpRTYK!+-ihBHNucwv_pe)KM6AMe>t6I)|(mTe@l@K3{eg*=pMGf<&W>tSR6>wS* zcS+~B{-E|Wk3v};IXYK^rmsIr$2TZ~aBL%SmYGQ-vqIqUQZ@W4FNE20)`U$O25whs znH^URu#3vz$Bz5t{LR?jbum%a+>qPt}Efk)sgyhfwKW#P%2pP+3-5S+L= z5u}^!P^~(Tb#Yk@fk9hv*2)D~v+xcLYsiA=*~j3xIk!ib??Nw}RKr6z_S2Z!N04}1 zz!-(QqjiEgWGUH0x8EUnw7Qk;Hkb~E*Oryua`*UJhJ#7cP_nm$ z6dvT-$Bf0WP-Px2J~1CgeEHQ(y2Oh<`D(=Gvzy71l2wqkcc7Sm(g(Zz>d3m6M^SCd zF+5#;0l!%2u>$AK#EY8~YK*JEsf#C*_%qg6`e7ozENUPco6q3BdP``1G@L}nI>G1a ztyJ6AoNV;YAg7m}$3+u2g2s3?h~CHT$qt;3=JP5kFU1Qw?;nI_PQ%>Vge3{5hJ(=j z4H@-f4=#*ahEbP^S*=<= z4ePDm67P=#L2ghpZMF4*aQP6bcvl0AR~{_BJQavc^#@Y+Itd@_8IPBnuF{9MTv6F9 z8CoWFf!6*NB%;_!v~b5Z(K_#`BJIhku)fM)6ce`yqJ!P3_<$~Tntz;(YaD@FnSv57 z5E9g-ZU^^miLfZTgXrX)LDv_-wA5fCPB4E-rtF*v3-+vpj^(4_%agG*7oa8b(BJdIjIg$TV zMFM(J+v)R(14&x36bxVWg_wI4!VjO+;3s|+z_kpvTO)zfTQ)<_Ne3k|Kxe z6kx)OXHchCK}>fyFb0YV(670aC<^0gN`V$Pzw&~zd(~lchaJ4XR0qr3V_>?nFP3gt zCTt!&2D%4xF=+Z(Lap*Pa2mb{+-gaRUz2y-6SN zd1#nB03Sw%!*>%#!Ozt((C|tN$K2AzeQYs(qg2j(cgj!r^tKSTx*s8jQjFoD;!v;; z*5uX^rE6iBKV8jnRV$+pLvs*GsD>o!#wuudM?(9hPX?w~J zvVMe#m3}C@bvxa&y9uwHQzeUBg18;@vG^Mq21y&IGSxPGlndAci;wuRF?r4G5#Y2N zMN???mT*)*rbEpHZ8TY$Mbq@NB~mGTZvA8{+QTp$UE~Pvj;$!<;_r^Kxkuk8BC$T& zPEt9|7K>$RkY^tQ+pD65ZP$V@ShimPi zOC+Y+OSpUR*){C$+*_psYd4TGy(3^a?-aZg`~;61ydb(N7mlQ7()^ej;cCkp)OAe+ z)O3EMpYKP|PNhvGdEIb4r_e?_ERAXNh7icRTuoL*`+{|=y|B*o6A6o)LR>V0sG|E$ zk~~BRn`~6DrD6xYy_0}%r#u9|7)u0^2Jqn6SbDNM4yKL#Oymk~u}g&|@M2GmsnV>` z)TNlR+l`&s!e=$)z~F-b+<(51*0CbxH}WJ(eXKbD-VK=D!mU@Sj}&kFu>)dr7KtAm z4-&6+QiAtOW1;9ir*EhhN2g>j_&0UZ{T0`d2MHh!ltL9O!-xzk zIx~1BxP%@6B^e7ktr|&+!5}F7Is$b9&#?JA7s*}bC}9V*q3!j0+EqD@?6io)gi9<< z&5wgMOf!tz5f9N>y7)`d2ckw;PH!Y0PmVrGj0@ADs%S2rNgRU8cT|D*YX%<7IDxVb zF*s@K3HILl^Q7gvG`>92O{-5ka{mciY4FBGGTB`X7iG?&;Y$>$CE1StRna6pw}ig3 z8P4)EN5WxZ1Ks>qsQr*ZgOA~!Q_i#D#ypi{n) z`OaiDtA8U0*r{`1PNftSIhL_s&&{DLEOQ}o-fI}Mzl~8;H3liTBXpg^K$%}0g!az? zkLRbU(zg)CVfzuPn5;l5T6WQ-7h{0`t1^UVnL#Hvw%@G{LX(Q6^ooNjbQiy5tELY{ zgPag-0Dts29)U6P>d@XENR_$uAO0z^P*`@7M3gm=z#B2}X0`=pjekhwpBdqDwZo`Z zUj*$6GvMV2byR8cN4LR;h{2L1(0w%kmt9DrZcfX&_;-Wwo|8Q7clI&$wG-cX^O{6R)g$sw(vE_8?6Ru!rYp*Y(cjG1eXWlfY3$~bKQr0R*R+s z=6h1-6Iyis4INk|iXl75W#OJX2C#-6Cg!d;piC94c2CExKLN-5wV8{>^9z>kT$XzRxo*46F{-SuV@5#P2J4dIW(Q>j5B zmHd68u3avow?zdoVaX3756v*Rqr3=%xp_;^qh*|CsU?OEawJBcVrKeJXNlFVUyI>G zCX9D-BTk72m;!EJqu#y|xLng6S$#c_=ba|S^WTvQ%ju96p3kn;lp#y+7C@674{W1C zp`iE_#5v7_A>Icito;Xo(u39#xqxz_f9ora82KIZ(Z&uxS+6FcKdyxAbE-H$_y!z%eHY4W z9WW{GG!)Fqr!j@AK&vYs;*Y0-jJSzxKUWKL%f~`O0t$=jHq-ckJ5+wOE95mr)4cpe zG&A0Z96uYte9Dt&?aU2G#JLyr$IXRI*Xhsn;i1d)!$B{&cru;F8is*~Uod>Wy&4YM z6~U!6HCnaq09{|IiN88;1682_M^;u6DSLHTv*!e@Y^Wxzg9aY>jSuqLD>x18P-wSb zhd0J(3adW9r2#|UF>^oO1Gz>^{B-gS<;9PNL2?#2Y0ei?QErasQ&wTXHaWQbWj*sG zdkr|-c92l}ku=^bpLQE>z~3fil3(_vQr$2o^uD)*i{1W)9@^=RukHm=lg23OT&^PA zS?h;w`yX@h@SP?tedu-I^aoPRK+OexWL?Q~r$^rG0@BlQhs14j}UMd(@xTUzD$E z2rkkAM7v}Js-F*}AFjxXG_NPXkT=tyQbw9|`Zs{qhz?>U5W>esS9rYpEbOQcf%h!n zg)=_*gVh3j_i6)sMtB7deN*M)gAQX_Wm9RYy$000n+9-oFv&SO0~R$4;q@=$iGl7U z(iKPOvFqy3z@{QQ z5apS`TUj0yPFq0|YIRH6x$lmPiWCGXi6B)T0SU!}QBIcNJf#pC<6r~r!d4b!O38{8 zZ%#k_JlmM2h0}A7p-^Y2sKQH5{IgD&IP#e_rarlWQZ@!+a!_qP-=o)feaTjX)f3)mcWrrLwKic3jX<_@S<}SFggV=WIp`vpGNfi zof7RwiTx-4`shEJ{5SfK`}f_1`bQgRPQI)tGxQ@mWlR@Er^|_)R(wO7>>V)o?KrXc zkb_)* zt4QXue?ANcNpin`%+;Ykm$StFId^rQ!C$%Su5t2p((`fgUhm|#KETPB^Tcueni*EQ z|3_y8W&$HKfxytv%*fPGATTl37YGDqW&(3FfvJI^zNtXp*x1m>$VB4h!FKQI+MI_H zvzy&d;w(>AR`ST>wa=6`KO@ECNlfvNw|YE!xjA`wxOnSHoYwW)=+>7mdRrgbkGo!C zN8TtevEFQqTpw1yFWXavwl}Ldqz`M*m+h$#+ncqU)`vCh%k~`odb90)S);ye z&ylG&YZuoiU*o=P&rzW_+uoPuT5s>x+OxO!W^)hq$=9?m+q17KaP{=}G5qk~>_4>8 zo?S@&Z<0GZ&;$OTJGb5JfdeQ1n^BjV@)!N*2l(^ZhwCzu!z})fXO5GRoMj&U + + g1_costnet_grid_planner0.1.0 + MuJoCo G1 visual floor perception, image control and ROS indoor navigation. + OpenHUTB contributor + BSD-3-Clause + catkin + rospy + diff --git a/src/humanoid/g1_costnet_grid_planner/patrol/__init__.py b/src/humanoid/g1_costnet_grid_planner/patrol/__init__.py new file mode 100644 index 0000000000..bc4204b4fb --- /dev/null +++ b/src/humanoid/g1_costnet_grid_planner/patrol/__init__.py @@ -0,0 +1 @@ +"""Visual patrol on a physics simulated G1 humanoid.""" diff --git a/src/humanoid/g1_costnet_grid_planner/patrol/demo.py b/src/humanoid/g1_costnet_grid_planner/patrol/demo.py new file mode 100644 index 0000000000..3f1b9a3f95 --- /dev/null +++ b/src/humanoid/g1_costnet_grid_planner/patrol/demo.py @@ -0,0 +1,50 @@ +import json +from pathlib import Path + +import numpy as np +from PIL import Image, ImageDraw +import torch + +from .planning import CostNet, astar, features + + +def run(weights, output): + grid = np.zeros((32, 32), dtype=bool) + grid[5:26, 10:13] = True + grid[8:29, 21:24] = True + start, goal = (27, 3), (4, 28) + model = CostNet() + model.load_state_dict(torch.load(Path(weights) / 'planner.pt', weights_only=True)) + model.eval() + torch.set_num_threads(2) + with torch.inference_mode(): + costs = model(torch.from_numpy(features(grid, goal))[None])[0, 0].numpy() + baseline, baseline_expanded = astar(grid, start, goal) + assisted, assisted_expanded = astar(grid, start, goal, costs) + if len(assisted) != len(baseline): + raise RuntimeError('Search methods disagree on optimal path cost') + output.mkdir(parents=True, exist_ok=True) + report = { + 'path_cost': len(assisted) - 1, + 'baseline_expanded': baseline_expanded, + 'assisted_expanded': assisted_expanded, + 'baseline_route': baseline, + 'assisted_route': assisted, + } + (output / 'planner.json').write_text(json.dumps(report, indent=2), encoding='utf-8') + image = Image.new('RGB', (640, 355), 'white') + draw = ImageDraw.Draw(image) + for panel, (route, label) in enumerate(( + (baseline, f'Manhattan A* ({baseline_expanded} expanded)'), + (assisted, f'CostNet A* ({assisted_expanded} expanded)'), + )): + left = 16 + 320 * panel + draw.text((left, 9), label, fill='#13202a') + for y, x in np.argwhere(grid): + draw.rectangle((left+x*9, 30+y*9, left+x*9+8, 30+y*9+8), fill='#333b42') + draw.line([(left+x*9+4, 34+y*9) for y,x in route], fill='#087a61', width=3) + for y, x in (start, goal): + draw.ellipse((left+x*9, 30+y*9, left+x*9+8, 30+y*9+8), fill='#b04827') + draw.text((16, 330), f'Path cost: {report["path_cost"]} cells for both methods', fill='#13202a') + image.save(output / 'planner.png') + return report diff --git a/src/humanoid/g1_costnet_grid_planner/patrol/planning.py b/src/humanoid/g1_costnet_grid_planner/patrol/planning.py new file mode 100644 index 0000000000..ee38a57ac0 --- /dev/null +++ b/src/humanoid/g1_costnet_grid_planner/patrol/planning.py @@ -0,0 +1,159 @@ +"""Learned cost-to-go tie breaker for admissible grid A*. + +Manhattan f is the primary priority, so learned estimates cannot invalidate +optimality on the four-connected grid. The network resolves equal-f plateaus. +This is neural-assisted search, not an end-to-end replacement of graph search. +""" +import heapq +import json +from pathlib import Path + +import numpy as np +import torch +from torch import nn + + +class CostNet(nn.Module): + def __init__(self): + super().__init__() + self.net=nn.Sequential(nn.Conv2d(3,16,3,padding=1),nn.ReLU(), + nn.Conv2d(16,24,3,padding=2,dilation=2),nn.ReLU(), + nn.Conv2d(24,24,3,padding=4,dilation=4),nn.ReLU(), + nn.Conv2d(24,1,1),nn.Softplus()) + + def forward(self,x): + return self.net(x) + + +def features(grid,goal): + yy,xx=np.indices(grid.shape) + return np.stack([grid.astype(np.float32),(xx-goal[1])/32.,(yy-goal[0])/32.]).astype(np.float32) + + +def distances(grid,goal): + result=np.full(grid.shape,np.inf,dtype=np.float32) + result[goal]=0 + queue=[(0,goal)] + while queue: + cost,point=heapq.heappop(queue) + if cost!=result[point]: continue + for dy,dx in [(1,0),(-1,0),(0,1),(0,-1)]: + q=(point[0]+dy,point[1]+dx) + if 0<=q[0]50 + radius=int(np.ceil(.3/resolution)) + inflated=blocked.copy() + for dy in range(-radius,radius+1): + for dx in range(-radius,radius+1): + if dx*dx+dy*dy>radius*radius: continue + srcy=slice(max(0,-dy),min(len(blocked),len(blocked)-dy)) + srcx=slice(max(0,-dx),min(blocked.shape[1],blocked.shape[1]-dx)) + dsty=slice(max(0,dy),min(len(blocked),len(blocked)+dy)) + dstx=slice(max(0,dx),min(blocked.shape[1],blocked.shape[1]+dx)) + inflated[dsty,dstx]|=blocked[srcy,srcx] + stride=3 + hh,ww=inflated.shape[0]//stride,inflated.shape[1]//stride + grid=inflated[:hh*stride,:ww*stride].reshape(hh,stride,ww,stride).any(axis=(1,3)) + cell=resolution*stride;ox,oy=request['origin'] + def index(xy): + p=(int((xy[1]-oy)/cell),int((xy[0]-ox)/cell)) + if not(0<=p[0]=1.5: + keep.append(route[i]) + keep.append(route[-1]) + world=[[ox+(p[1]+.5)*cell,oy+(p[0]+.5)*cell] for p in keep[1:]] + world[-1]=request['goal'] + return dict(waypoints=world,expanded=expanded,baseline_expanded=baseline_expanded, + path_cost=len(route)-1,baseline_path_cost=len(baseline)-1, + unknown_policy='provisionally traversable; live local obstacle avoidance required', + method='Manhattan A* with neural equal-f tie breaking') diff --git a/src/humanoid/g1_costnet_grid_planner/requirements.txt b/src/humanoid/g1_costnet_grid_planner/requirements.txt new file mode 100644 index 0000000000..09a1ba72d0 --- /dev/null +++ b/src/humanoid/g1_costnet_grid_planner/requirements.txt @@ -0,0 +1,3 @@ +numpy>=1.26,<3 +torch>=2.5 +Pillow>=10 diff --git a/src/humanoid/g1_costnet_grid_planner/scripts/task_runner.py b/src/humanoid/g1_costnet_grid_planner/scripts/task_runner.py new file mode 100755 index 0000000000..c1112df063 --- /dev/null +++ b/src/humanoid/g1_costnet_grid_planner/scripts/task_runner.py @@ -0,0 +1,26 @@ +#!/usr/bin/env python3 +"""Launch standalone simulation/learning tasks through a ROS launch file.""" +import subprocess +import rospy + + +def main(): + rospy.init_node('humanoid_task_runner') + args = [rospy.get_param('~sim_python'),rospy.get_param('~sim_entry'), + '--assets',rospy.get_param('~assets'),'--mode',rospy.get_param('~task'), + '--weights',rospy.get_param('~weights'),'--output',rospy.get_param('~output'), + '--seconds',str(rospy.get_param('~seconds',45))] + child = subprocess.Popen(args) + try: + while child.poll() is None and not rospy.is_shutdown(): + rospy.rostime.wallsleep(.1) + if child.poll() not in (None,0): + raise RuntimeError('Simulation task failed with exit code %s'%child.returncode) + finally: + if child.poll() is None: + child.terminate() + child.wait(timeout=10) + + +if __name__ == '__main__': + main() From 88239de64cd62396d1acf57e417cf704d837e4dd Mon Sep 17 00:00:00 2001 From: usernamekkyy Date: Thu, 12 Nov 2026 15:26:41 +0800 Subject: [PATCH 2/2] fix(humanoid): wire CostNet training options and normalize larger maps --- .../humanoid/g1_costnet_grid_planner/index.md | 21 ++++++- .../g1_costnet_grid_planner/README.md | 21 ++++++- .../launch/main.launch | 7 --- src/humanoid/g1_costnet_grid_planner/main.py | 19 +++--- .../g1_costnet_grid_planner/package.xml | 2 +- .../g1_costnet_grid_planner/patrol/demo.py | 11 +--- .../patrol/planning.py | 59 +++++++++++++------ .../scripts/task_runner.py | 9 +-- 8 files changed, 97 insertions(+), 52 deletions(-) diff --git a/docs/humanoid/g1_costnet_grid_planner/index.md b/docs/humanoid/g1_costnet_grid_planner/index.md index 39fbea2245..c4d14643e7 100644 --- a/docs/humanoid/g1_costnet_grid_planner/index.md +++ b/docs/humanoid/g1_costnet_grid_planner/index.md @@ -12,9 +12,9 @@ python main.py --output results 示例在一个合成栅格比较经典和神经辅助搜索,输出路线图和 JSON。网络仅处理相同 f 值的排序。可用 `--mode train_planner` 重训,用 `--mode plan_stdio` 接收占据栅格 JSON。 -## ROS launch +## ROS 1 Noetic 启动 -在 ROS Noetic 源码空间运行,将路径替换为实际值。 +本模块的 ROS 接口使用 ROS 1 Noetic(catkin、rospy)。在 Noetic 源码空间运行,将路径替换为实际值。 ```bash source /opt/ros/noetic/setup.bash @@ -26,6 +26,23 @@ roslaunch g1_costnet_grid_planner main.launch sim_python:=/path/to/python sim_en ![G1 CostNet 栅格规划对照](../../img/g1_costnet_grid_planner/planner.png) +## 可复核结果 + +| 方法或指标 | 路径代价(格) | 扩展节点 | +| --- | ---: | ---: | +| Manhattan A* | 48 | 401 | +| 随仓库提供的 CostNet 辅助 A* | 48 | 49 | +| 40 张合成测试图的 CostNet MAE | 0.756 | — | + +扩展数仅对应演示地图。推理按栅格各轴尺寸归一化相对坐标,各轴尺度至少为 32,以保持 32×32 训练输入及已有权重兼容。大图的搜索扩展数会随布局变化。 + +```bash +python main.py --mode train_planner --epochs 5 --samples 100 --seed 91 --weights results/trained +python main.py --mode plan_stdio --robot-radius 0.3 --stride 3 < request.json +``` + +请求 JSON 包含 `map`(行优先的一维占据数组)、`width`、`height`、`resolution`(米/格)、`origin`、`start`、`goal`(二维世界坐标)。可用 `robot_radius`、`stride` 字段覆盖命令行默认值。重复在同一 Python 进程调用时复用权重,文件更新后重新加载。 + ## 大模型使用声明 使用 OpenAI Codex 辅助拆分、编程、验证和文档整理,提交者复核并对提交内容负责。 diff --git a/src/humanoid/g1_costnet_grid_planner/README.md b/src/humanoid/g1_costnet_grid_planner/README.md index 3ff03e0973..77510e61b3 100644 --- a/src/humanoid/g1_costnet_grid_planner/README.md +++ b/src/humanoid/g1_costnet_grid_planner/README.md @@ -12,9 +12,9 @@ python main.py --output results 示例在一个合成栅格比较经典和神经辅助搜索,输出路线图和 JSON。网络仅处理相同 f 值的排序。可用 `--mode train_planner` 重训,用 `--mode plan_stdio` 接收占据栅格 JSON。 -## ROS launch +## ROS 1 Noetic 启动 -在 ROS Noetic 源码空间运行,将路径替换为实际值。 +本模块的 ROS 接口使用 ROS 1 Noetic(catkin、rospy)。在 Noetic 源码空间运行,将路径替换为实际值。 ```bash source /opt/ros/noetic/setup.bash @@ -22,6 +22,23 @@ export ROS_PACKAGE_PATH="$PWD:${ROS_PACKAGE_PATH:-}" roslaunch g1_costnet_grid_planner main.launch sim_python:=/path/to/python sim_entry:=/path/to/main.py ``` +## 可复核结果 + +| 方法或指标 | 路径代价(格) | 扩展节点 | +| --- | ---: | ---: | +| Manhattan A* | 48 | 401 | +| 随仓库提供的 CostNet 辅助 A* | 48 | 49 | +| 40 张合成测试图的 CostNet MAE | 0.756 | — | + +扩展数仅对应演示地图。推理按栅格各轴尺寸归一化相对坐标,各轴尺度至少为 32,以保持 32×32 训练输入及已有权重兼容。大图的搜索扩展数会随布局变化。 + +```bash +python main.py --mode train_planner --epochs 5 --samples 100 --seed 91 --weights results/trained +python main.py --mode plan_stdio --robot-radius 0.3 --stride 3 < request.json +``` + +请求 JSON 包含 `map`(行优先的一维占据数组)、`width`、`height`、`resolution`(米/格)、`origin`、`start`、`goal`(二维世界坐标)。可用 `robot_radius`、`stride` 字段覆盖命令行默认值。重复在同一 Python 进程调用时复用权重,文件更新后重新加载。 + ## 大模型使用声明 使用 OpenAI Codex 辅助拆分、编程、验证和文档整理,提交者复核并对提交内容负责。 diff --git a/src/humanoid/g1_costnet_grid_planner/launch/main.launch b/src/humanoid/g1_costnet_grid_planner/launch/main.launch index f2a062b54e..9adf983528 100644 --- a/src/humanoid/g1_costnet_grid_planner/launch/main.launch +++ b/src/humanoid/g1_costnet_grid_planner/launch/main.launch @@ -1,17 +1,10 @@ - - - - - - - diff --git a/src/humanoid/g1_costnet_grid_planner/main.py b/src/humanoid/g1_costnet_grid_planner/main.py index 374f44f409..981f457f0a 100644 --- a/src/humanoid/g1_costnet_grid_planner/main.py +++ b/src/humanoid/g1_costnet_grid_planner/main.py @@ -7,26 +7,25 @@ def main(): parser = argparse.ArgumentParser(description=__doc__) - parser.add_argument('--assets', help=argparse.SUPPRESS) parser.add_argument('--mode', choices=['demo', 'train_planner', 'plan_stdio'], default='demo') parser.add_argument('--output', type=Path) - parser.add_argument('--dataset', type=Path, default=Path('data/visual_patrol')) parser.add_argument('--weights', type=Path, default=Path(__file__).resolve().parent / 'models') - parser.add_argument('--samples', type=int, default=100) - parser.add_argument('--epochs', type=int, default=15) - parser.add_argument('--seed', type=int, default=7) - parser.add_argument('--seconds', type=float, default=45) - parser.add_argument('--record', action='store_true') - parser.add_argument('--controller',choices=['navigation','perception','end2end'],default='navigation') + parser.add_argument('--samples', type=int, default=240) + parser.add_argument('--epochs', type=int, default=20) + parser.add_argument('--seed', type=int, default=91) + parser.add_argument('--robot-radius', type=float, default=0.3) + parser.add_argument('--stride', type=int, default=3) args = parser.parse_args() + if args.mode == 'train_planner' and (args.samples < 1 or args.epochs < 1 or args.seed < 0): + parser.error('training requires positive samples and epochs, and a nonnegative seed') if args.mode == 'train_planner': from patrol.planning import train_planner - print(json.dumps(train_planner(args.weights),indent=2)) + print(json.dumps(train_planner(args.weights, epochs=args.epochs, sample_count=args.samples, seed=args.seed),indent=2)) return if args.mode == 'plan_stdio': import sys from patrol.planning import plan_request - print(json.dumps(plan_request(json.load(sys.stdin),args.weights))) + print(json.dumps(plan_request(json.load(sys.stdin),args.weights, robot_radius=args.robot_radius, stride=args.stride))) return from patrol.demo import run print(json.dumps(run(args.weights, args.output or Path("results")), indent=2)) diff --git a/src/humanoid/g1_costnet_grid_planner/package.xml b/src/humanoid/g1_costnet_grid_planner/package.xml index d837f0d3f5..92c0df4c7b 100644 --- a/src/humanoid/g1_costnet_grid_planner/package.xml +++ b/src/humanoid/g1_costnet_grid_planner/package.xml @@ -2,7 +2,7 @@ g1_costnet_grid_planner0.1.0 MuJoCo G1 visual floor perception, image control and ROS indoor navigation. - OpenHUTB contributor + usernamekkyy BSD-3-Clause catkin rospy diff --git a/src/humanoid/g1_costnet_grid_planner/patrol/demo.py b/src/humanoid/g1_costnet_grid_planner/patrol/demo.py index 3f1b9a3f95..c118766e4b 100644 --- a/src/humanoid/g1_costnet_grid_planner/patrol/demo.py +++ b/src/humanoid/g1_costnet_grid_planner/patrol/demo.py @@ -1,11 +1,9 @@ import json -from pathlib import Path import numpy as np from PIL import Image, ImageDraw -import torch -from .planning import CostNet, astar, features +from .planning import astar, predict_costs def run(weights, output): @@ -13,12 +11,7 @@ def run(weights, output): grid[5:26, 10:13] = True grid[8:29, 21:24] = True start, goal = (27, 3), (4, 28) - model = CostNet() - model.load_state_dict(torch.load(Path(weights) / 'planner.pt', weights_only=True)) - model.eval() - torch.set_num_threads(2) - with torch.inference_mode(): - costs = model(torch.from_numpy(features(grid, goal))[None])[0, 0].numpy() + costs = predict_costs(grid, goal, weights) baseline, baseline_expanded = astar(grid, start, goal) assisted, assisted_expanded = astar(grid, start, goal, costs) if len(assisted) != len(baseline): diff --git a/src/humanoid/g1_costnet_grid_planner/patrol/planning.py b/src/humanoid/g1_costnet_grid_planner/patrol/planning.py index ee38a57ac0..c48189657a 100644 --- a/src/humanoid/g1_costnet_grid_planner/patrol/planning.py +++ b/src/humanoid/g1_costnet_grid_planner/patrol/planning.py @@ -7,6 +7,8 @@ import heapq import json from pathlib import Path +from functools import lru_cache +import math import numpy as np import torch @@ -27,7 +29,9 @@ def forward(self,x): def features(grid,goal): yy,xx=np.indices(grid.shape) - return np.stack([grid.astype(np.float32),(xx-goal[1])/32.,(yy-goal[0])/32.]).astype(np.float32) + height, width = grid.shape + return np.stack([grid, (xx - goal[1]) / max(32, width), + (yy - goal[0]) / max(32, height)]).astype(np.float32) def distances(grid,goal): @@ -45,8 +49,8 @@ def distances(grid,goal): return result -def train_planner(output,epochs=20): - torch.manual_seed(91) +def train_planner(output, epochs=20, sample_count=240, seed=91): + torch.manual_seed(seed) torch.set_num_threads(3) def samples(seeds): xs,ys,masks=[],[],[] @@ -65,9 +69,12 @@ def samples(seeds): xs.append(features(grid,goal));ys.append(np.where(valid,d,0)/32.) masks.append(valid) return torch.from_numpy(np.asarray(xs)),torch.from_numpy(np.asarray(ys))[:,None],torch.from_numpy(np.asarray(masks))[:,None] - x,y,mask=samples(range(240)) - xv,yv,mv=samples(range(1000,1040)) - xt,yt,mt=samples(range(2000,2040)) + first_train_seed = (seed - 91) % 2**32 + x,y,mask=samples(range(first_train_seed, first_train_seed + sample_count)) + first_eval_seed = max(1000, first_train_seed + sample_count) + xv,yv,mv=samples(range(first_eval_seed, first_eval_seed + 40)) + first_test_seed = max(2000, first_eval_seed + 40) + xt,yt,mt=samples(range(first_test_seed, first_test_seed + 40)) model=CostNet() opt=torch.optim.Adam(model.parameters(),lr=.001) best=float('inf');history=[] @@ -82,7 +89,7 @@ def samples(seeds): best=val;torch.save(model.state_dict(),output/'planner.pt') model.load_state_dict(torch.load(output/'planner.pt',weights_only=True)) with torch.inference_mode(): mae=float((model(xt)-yt).abs()[mt].mean()*32) - result=dict(train_maps=240,validation_maps=40,test_maps=40,test_mae_cells=mae, + result=dict(train_maps=sample_count, epochs=epochs, seed=seed,validation_maps=40,test_maps=40,test_mae_cells=mae, validation_mse=history,scope='synthetic occupancy maps; not visual training scenes') (output/'planner_metrics.json').write_text(json.dumps(result,indent=2),encoding='utf-8') return result @@ -112,36 +119,54 @@ def h(p): return abs(p[0]-goal[0])+abs(p[1]-goal[1]) raise ValueError('No path in known free map') -def plan_request(request,weights): +@lru_cache(maxsize=2) +def load_model(path, revision): + model = CostNet() + model.load_state_dict(torch.load(path, map_location='cpu', weights_only=True)) + return model.eval() + + +def predict_costs(grid, goal, weights): + path = (Path(weights) / 'planner.pt').resolve() + model = load_model(path, path.stat().st_mtime_ns) + with torch.inference_mode(): + return model(torch.from_numpy(features(grid, goal))[None])[0, 0].numpy() + + +def plan_request(request, weights, *, robot_radius=0.3, stride=3): original=np.asarray(request['map'],dtype=np.int16).reshape(request['height'],request['width']) resolution=float(request['resolution']) + robot_radius = float(request.get('robot_radius', robot_radius)) + stride = request.get('stride', stride) + if not math.isfinite(resolution) or resolution <= 0: + raise ValueError('resolution must be finite and positive') + if not math.isfinite(robot_radius) or robot_radius < 0: + raise ValueError('robot_radius must be finite and nonnegative') + if type(stride) is not int or not 1 <= stride <= min(original.shape): + raise ValueError('stride must be a positive integer within the map dimensions') # Exploration mode: inflate known obstacles; unknown space remains provisional. # Execution still uses the live local obstacle costmap. No safety claim is made # for unobserved portions of this global route. blocked=original>50 - radius=int(np.ceil(.3/resolution)) + radius=int(np.ceil(robot_radius/resolution)) inflated=blocked.copy() - for dy in range(-radius,radius+1): - for dx in range(-radius,radius+1): + for dy in range(-min(radius, len(blocked)-1), min(radius, len(blocked)-1)+1): + for dx in range(-min(radius, blocked.shape[1]-1), min(radius, blocked.shape[1]-1)+1): if dx*dx+dy*dy>radius*radius: continue srcy=slice(max(0,-dy),min(len(blocked),len(blocked)-dy)) srcx=slice(max(0,-dx),min(blocked.shape[1],blocked.shape[1]-dx)) dsty=slice(max(0,dy),min(len(blocked),len(blocked)+dy)) dstx=slice(max(0,dx),min(blocked.shape[1],blocked.shape[1]+dx)) inflated[dsty,dstx]|=blocked[srcy,srcx] - stride=3 hh,ww=inflated.shape[0]//stride,inflated.shape[1]//stride grid=inflated[:hh*stride,:ww*stride].reshape(hh,stride,ww,stride).any(axis=(1,3)) cell=resolution*stride;ox,oy=request['origin'] def index(xy): - p=(int((xy[1]-oy)/cell),int((xy[0]-ox)/cell)) + p=(math.floor((xy[1]-oy)/cell), math.floor((xy[0]-ox)/cell)) if not(0<=p[0]