planning trajectories in dynamic environments using a gradient

12

Upload: trankhue

Post on 13-Feb-2017

223 views

Category:

Documents


1 download

TRANSCRIPT

Page 1: Planning trajectories in dynamic environments using a gradient

������������� ������������������������������ ����!"���#���%$ �������!&���'���( �)���&�*����+�,�����%�-!&�.�)/��0�

1�243657598;:=<?>7@BA=8C>7D4:E3242FDHGEIKJML8'NO@?LLQPEDR.SUTWV�XOYZS\[+]7^CYZ_a`bSEcH^;de_XZ[�VYZSUfgVa]�hCS\ijYZ]7[+S\ijYZSUfgVk�^bS\lm]7XZiOSnYoVp`bS=qr_6[�V0sHtuV�h;V6TvSU]Q^bwgV6xyrS\V+hbVzFV�XZS\V'{m{g|C}?~6~;{g�6�;}?q�_m[�VC};c�Y�V6zn��g�C�6�;�g�C�������=�Z�m�����g�b����6�;���u���m�b��C�g�W�;�E�Z��

��� �Q¡Q¢�£W¤6¡m¥ c�^¦YZ§bSUi.VXOYZSUfQzU]a¨�]aT;XZ_mT?_miO]pV6^¦]7©CYZ]Q^viOSU_6^0d4_6X�V�TWV�YZ§ TbzFV^v^bS\^bª[+]7YZ§b_C`�«WViO]g`¬_6^�YZ§v]�tu­K®r¯�V6zUªm_XZSnYZ§v[°YZ_0§WVgl�]�«?]7YOYZ]9X+T?]7XOde_XZ[�V6^bfQ]�SU^¬Vl�]9XO�¬`;�;^WV[+S\f±]Q^ClCSnXZ_m^v[+]7^CYg² ³)§v]'TvVYZ§¬Tvz\V6^b^vSU^vª [+]7YZ§v_C`�«b´vSUz\`bi�V¦^WVglCSU¯ªmVYZSU_m^�d4´v^vf9YZS\_6^ YZ§vVY�`;XZSUl�]7i.YZ§v]aXZ_6«?_6Y�YZ_g¨�VX�`0YZ§v]pª6_�V6zµVgl�_mS\`;S\^bª'YZ§v]a_m«b¯ijY�VfQzU]QiQ²r³)§v]0«WV6iOSUf [+]7YZ§v_C`¶SUi%l�]9XO�·d¸VijY¦V6^v`¹]7º+fQSU]Q^�Y'd4_6X¦V�XZ_m«?_Y'¨�SnYZ§d4]7¨»`b]7ª6XZ]Q]Qi�_6d�d4XZ]Q]g`;_m[%²E³)§b]¼T;XZ_mT?_6iO]g`0]9©;YZ]7^viOSU_m^¦SU^�YZ]Qª6X�V�YZ]Qi�YZ§v]�_6«vijY�V6f7z\]`C�b^vV6[+SUfQi½SU^¾YZ§b]pTvz\V6^b^vSU^vª'[+]7YZ§v_C`BYZ_%§WVgl�]a«?]7YOYZ]7X�T?]7XOde_XZ[�V6^bfQ]Qi�SU^�l�]7XO�`C�b^vV6[+SUf�]Q^Cl;SnXZ_6^v[+]Q^�YZiQ²C¿ ©;T?]7XZSU[+]Q^�YZi�§WVgl�]riO§v_g¨�^�YZ§b]r]9ÀE]Qf7YZSUl�]Q^b]QiOi�_6dMYZ§v]T;XZ_mT?_miO]Q`0]7©CYZ]Q^biOSU_m^¦SU^ V+l�]9XO�B`;�;^vV6[+SUf�]Q^Cl;SnXZ_6^v[+]Q^�Yg}Wª6SUl�]Q^¦«��%q�_m«?_�Á�´bTiO_�fQf7]7X�[�V�YZf9§b]QiQ²

 ÃvÄ�Å?ÆEǽȼÉ�ÊuÅEËZÇ�ÄÌ 8�Í9P¬ÎE248;:E:ED4:EÏ0De5p8BÐÑJE:M<E8CÒ%3:vÍQ8C2�Í78b5�Ó¾ÐÑ@;>p8CJEÍ9@;:=@;Ò%@;J=5�Ò%@;ÔED42F3'>7@;Ôu@CÍ756Õ×Ö�Ø;36>9Ù�8CÎEÚÎE2FDeL8CÍ9D4@;:¾Í9PM8�Í�D4:WØ;@;24Ø;3m5rÍ9PE3�JM5�3+@;Ð)8;:�8;J?Í9@b:E@;Ò%@bJ=5.Ò%@;ÔED42F3+>7@;Ôu@CÍ�PM8;5�Í9@ <?368;2 Û½D\Í7PÎ=8�Í7PÜÎE2e8C:E:=DF:E϶8C:M<Ý@;ÔM5ZÍQ8;L�243 8�Øb@;De<E8C:ML�3;ÕµÖ�ÞE8CÒ%ÎE24365�@Cм59J=LQPß8CÎEÎE24DeL8�Í7DF@b:=5'8C>73;à)8CD4>@;>%:=8�ØWÙ¶Í9>Q8�á¦L�L�@b:bÍ7>9@b2�G)3ÞWÎ=2F@b>78CÍ9D4@;:â8;:=<ÝÛ�@;>7Ó¹D4:ßP=@b5�Í9D42F3¾3:WØWDF>7@;:=Ò'36:vÍ�ã�5�JMLQPß8b55�JEÔEÚj59368¬@;>%5�Î=8bL�3�ägG)ÎM36@;ÎE243¾>93m59LJE3 <?J=>9D4:EÏå<ED4578;5�Í936>�@b>'<E8;:EÏ;36>9@bJ=5'5�DFÍ9J=8CÍ9D4@;:KG�@Cá¦L3Ûr@b>9Ó×GC>7@;Ôu@CÍ7D4L�59@?LL3>mGC3�ÍQLCÕ Ì 8�Í9PBÎ=248;:E:ED4:EÏ�De5�8±L>9DFÍ9DeL8;2?Í78b5�Ó�ÐÑ@;>�Í9PE3a5�JMLL�3m595�@CÐ×Í9P=@b5938CÎEÎE24DeL8�Í7DF@b:=5½8C:M< ÒB8;:vÙ <?D\æ×3>73:vÍ�8;ÎEÎE>7@b8;LQP=365.L8;:¾Ôu3pÐÑ@;J=:=<¾DF:�24D\Í73>Q8�Í7JE>93aÍ7@%Í78;LQÓW243Í9PE3%ÎE>7@;ÔE243ÒèçFé6êCëHÕ×ì·3242�ÓW:E@�Û½:�Í93mLQPE:EDeívJE365pÔ=8b5�3m<�@;:·>7@b8;<?ÚHÒB8CÎ,L@;:=5�Í9>7J=L�Í9D4@;:KG L�362F2<?36L@;Ò%ÎM@v5�DFÍ9D4@;:�G?@;>�8C>9Í9DFîMLD48;2 ÎM@;Í93:vÍ7D48;2×î=32e<E56G=8C>73¼Û½De<?362FÙ J=5�3m< ÕNO:�Ò%8;:WÙ 8CÎ=ÎE2FDeL8CÍ9D4@;:=5½Í9PE3�>9@bÔM@;Í75½P=8�Øb3pÍ9@0L@;Îu3�Û½DFÍ9P,8¦<?ÙW:=8;Ò%D4L+36:WØvD4>7@;:EÒ%3:vÍmG

DF:¹Û½PEDeLQP¶Í9P=3¦ÎE>7@;ÔE243Ò�@CнÎ=8�Í7P¶ÎE248;:E:ED4:EϬ8;:=<·@;Ô=5�Í78bL�243¦8�Ø;@;De<E8;:=L�3%Ôu36L�@bÒ%365+Ò�J=LQPP=8C>Q<?3>mGuÔM3mL8CJM5�3'Í9P=3'>7@;Ôu@CÍQ5�PM8�Ø;3�Í9@ Í78CÓb3�D4:vÍ9@�8;L6L�@;J=:bÍaÍ9PM8�Í�L�@b:?î=Ï;J=>78CÍ9D4@;:,@;Ð�Í9P=3Ûr@b>9Ó¦59Î=8;L3+LQP=8C:EÏb365.8;5�Í7DFÒ%3pï=@�Û�56ÕE1�Ò%@b:EÏ%@CÍ9P=3>�8CÎ=ÎE2FDeL8CÍ9D4@;:�<?@;ÒB8;DF:=56GEð½@bÔM@?ñrJEÎç\émò�ëEDe5�8pØ;3>7Ù+Ï;@W@?<�3�Þ?ÎM36>9D4Ò%3:vÍ78;2Wî=32e<�ÐÑ@;>�59J=LQP%8CÎEÎE24DeL8�Í7DF@b:=5)Ôu36L8;J=593rÍ7PE3�ð½@bÔM@?ñrJEÎL�@;Ò%Îu3�Í7D\Í7DF@b:=5�8C>73pLQP=8C>Q8;L�Í93>7D4ó36<0ÔWÙ08'PEDFÏbPE24Ù <?ÙW:=8;Ò'DeLp8C:=<¾PE@v5ZÍ7DF243p3:WØWDF>7@;:=Ò'36:vÍ6Õô DFæu36>936:vÍ 5�@b2FJEÍ9D4@;:=5%ÐÑ@b>0Î=8CÍ9PõÎE2e8C:=:EDF:=ϹDF:»<?ÙW:=8;Ò%D4L�36:WØvD4>7@;:EÒ%3:vÍQ5BP=8�Ø;3�Ôu336:

ÎE>9@bÎM@v5�3m<¬D4:¶2FDFÍ936>78CÍ9JE>73;Õµ1�î=>75�Í�Ï;>7@;J=Îå@;Ð�Ò%3�Í7PE@?<E5�<?@�:=@CÍ+Í78;Ó;3%D4:bÍ7@,8;L6L�@;J=:bÍ�8;:vÙ3�Þ?ÎE24D4LD\Í�>73ÎE>736593:vÍQ8�Í9D4@;:�@CÐuÍ9D4Ò%3�8C:=<'8C>73.Ò%@b5�Í924Ù�ÐÑ@?L�J=575936<�@;:%3�ÞWÍ936:=<?D4:EÏ+@;>�8b<E8CÎEÍ9D4:EÏ8�5�Í78;:=<E8C>Q<BÎ=8CÍ9P¾ÎE2e8C:E:ED4:EÏ'Ò%3�Í9P=@W< ÎE>7@;Îu@b5936<%ÐÑ@b>½5ZÍQ8�Í9DeL¼3:WØWDF>7@;:EÒ%36:bÍQ5Õ?ö.PE3aÏ;@v8C2uD45Í9@,P=8�Øb3B8�Ø;3>7Ù,Ð�8b5ZÍ'8C24Ï;@;>7DFÍ9PEÒ÷Í7@,ÎE2e8C:·Í9>Q8�øZ3mLgÍ7@;>7DF3m5pDF:Ý8,5�Í78CÍ9DeL%@;Ô=5�Í78bL�243¦L�@b:?î=Ï;JEÚ>78CÍ9D4@;:å8;:=<,>73Î=248;:,Í9P=3�Í7>78CøZ36L�Í9@;>7D4365a8�Í�8¦î=ÞW3m<,Í7DFÒ%3%D4:bÍ73>7Ø�8C2�Í9@¾Í78;Ó;3�DF:vÍ9@�8bLL�@bJE:vÍ

Page 2: Planning trajectories in dynamic environments using a gradient

3:WØWDF>7@;:EÒ%36:bÍQ8C2×LQP=8C:=Ï;365¼ç\é6ù=G�émúEG�ò=Gé�û?G�émü�ëjÕv1�:E@CÍ7PE3>.Ï;>7@;J=Φ@CÐ�Û�@;>7Ó?5�De5�Ô=8;5936<0@;:03ÞWÚÎE2FDeL�DFÍ924Ù L@;:=59De<?3>7DF:=ϱÍ7PE3aÍ9D4Ò'3�<EDFÒ%3:M5�D4@;:�<?JE>7DF:=Ï�Í7PE3+Î=8CÍ9P¾ÎE248;:E:ED4:EÏ%ÎE>7@WL36575ÕEýW@bÒ%3@CÐ)Í9PE@v5�3+Û�@;>7Ó?5.>9362FÙ @;:¾Í9P=3±8;575�J=Ò'ÎEÍ9D4@;:�@CÐ�ÓW:E@�Û½D4:EÏ%DF:,8b<?Ø�8C:=L3pÍ9PE3±<EÙv:M8CÒ%D4Lp36Ø;@;Ú2FJ?Í7DF@b:Ý@CÐ.Í7PE3036:vØWD4>9@b:EÒ%3:vÍ0ç þEG�é�ÿ�ëjÕµ1�5�Í9PE3¾L�@bÒ'Î=2F3Í93¦ÓW:E@�Û½2436<?Ïb3B@CнÍ7PE30<?ÙW:=8;Ò'DeL5@CнÍ9P=3 36:vØWD4>9@b:EÒ%3:vͱDe5±:=@CÍ'8�Ø�8;DF2e8CÔE243¦D4:ÝÒ%@b5�Í'L68;593656G�@CÍ7PE3>%8CJEÍ9PE@b>75±P=8�Ø;305�Í9JM<?DF3m<Í9PE3pÎu@b575�D4ÔED42FDFÍZÙ¦@CÐ�ÎE>736<?DeLgÍ7DF:EÏ�Í9P=3¼ÐÑJEÍ9JE>73p3Ø;@b2FJEÍ9D4@;:0@;Ð�Í7PE3p3:WØWDF>7@;:EÒ%36:bÍ�Í9@%ÎE2e8C: Í9P=3Í9>Q8�øZ36L�Í9@b>9D4365pç ÿCüEGé��WG7ÿ?é;G7ÿ;ÿ�ëjÕNO:¦Í9P=D45�Î=8;ÎM36>.8;: 8;ÎEÎE>7@b8;LQP%Í7@±Í7PE3pÎE>7@;ÔE243Ò @;Ð�Î=8�Í7P0ÎE2e8C:=:EDF:=Ï�D4:¾<EÙv:M8CÒ%D4L¼3:WØWDFÚ

>9@b:EÒ%3:vÍ75.De5.ÎE>7@;Îu@b5936<��mÕMö.PE3+Ï;36:E3>Q8C2×De<?368'De5�Í9@BD4:bÍ73Ïb>78CÍ93¼Í9PE3+@bÔ=5ZÍQ8;L2F3�� 5.<?ÙW:=8;Ò'DeL5LQP=8C>Q8;L�Í93>7De5ZÍ7D4L.D4:vÍ9@�Í7PE3aÎE248;:E:ED4:EϱÒ%3Í9PE@?< GWÔWÙBLQP=8C:EÏbDF:=ÏpÍ9PE36DF>.>73ÎE>736593:vÍ78CÍ9D4@;:%D4:¦Í9P=3>9@bÔM@;Í�� 5�L�@b:?î=Ï;J=>78CÍ9D4@;:¹5�ÎM8;L�3bÕ�ö.PEDe5�De5±8�Ïb3:E36>78;2�8CÎ=ÎE>9@v8;LQP¶8C24>93m8;<?Ù¬J=5�3m<¹D4:¹2FDFÍ936>78CÚÍ9JE>73;G�ç þEGQÿCüCëHGK8;:=<¶L8C:¶Ôu3¦J=5936<·Û½DFÍ9PÝ<?DFæu36>936:vÍ+Í9>Q8�øZ36L�Í9@b>9Ù�ÎE2e8C:=:EDF:=Ï�Ò'3Í9PE@?<E56Õµö.P=33�æ×36LgÍ7DFØb3:E3m595�@;Ð=Í9P=3.8;ÎEÎE>7@b8bLQP±<?3Îu3:M<E5)@;:�Í9PE3½59ÎM3mL�DFîML�ÎE2e8C:E:ED4:EÏpÒ%3�Í7PE@?< GC8C:=<�>7324DF3m5@;:¾PE@�Û»Í7PE3+DF:EÐÑ@;>7Ò%8CÍ9D4@;:�8CÔu@;J?ͽÍ7PE3+@;ÔM5ZÍQ8;L�24365.<?ÙW:=8;Ò%D4L65½8C>73¼ÍQ8CÓb3:¾DF:vÍ9@B8bLL�@bJE:vÍ6Õö.PE3%Ô=8;59D4L%8;ÎEÎE>7@b8;LQP�G=ÐÑ>7@;Ò-Û½P=D4LQP·Í9P=3BÎE>93m5�36:vÍaÛ�@;>7Ó�P=8;5+5�Í78;>�Í736< G De5+<?3m59L>9D4ÔM3m<

DF:ÜçFéù;ë�8;:=<�ÎE>7@�ØvDe<?3m5.ÐÑ@;>a8C:,3áBLDF36:vÍ�DFÒ%ÎE243Ò%36:bÍQ8�Í7DF@b:,@CÐ�8¦ÎM8�Í9P�Î=248;:E:ED4:EϦÒ%3�Í7PE@?<Ô=8;5936<¶@b:Ý:WJEÒ%3>7D4L68C2r8;>�Í7D\îuL�De8C2�Îu@CÍ73:vÍ9De8C2rî=3624<Ý59D4Ò'D42e8C>�Í7@âç ÿCò=G�é;éëHÕ�ö.PE30Ò%3�Í7PE@?<ÝD4:ç\é6ùCë�ãÑ>73�ÐÑ3>7>736<%D4:¦Í9P=D45�Î=8;ÎM36>�8b5rI Ì�� ä�P=8;5rØ;36>9Ù'Ï;@W@?<BÎu3>9ÐÑ@;>7ÒB8C:=L3�ÐÑ@;>.8�>7@;Ôu@CÍrÛ½D\Í7PÐÑ3Û <?36Ï;>733m5�@CÐ�ÐÑ>733m<?@;Ò�ÕuNO:,Î=8;>�Í7D4LJE248;>�Í7PED45aÒ%3�Í7PE@?<,L�@bÒ%ÎEJ?Í93m5¼80:=8�ØWDFÏv8�Í7DF@b:�ÐÑJE:=LgÚÍ9D4@;:·Í9P=8Cͱ8�Ø;@bD4<E5a24@?L8C2�Ò%D4:ED4Ò%8=GK>73659JE2\Í7DF:=ϾD4:¹Ø;36>9Ù�3æu3mLgÍ7DFØb3%Í9>Q8�øZ36L�Í9@b>9D43656Õ�@�Û�3Ø;36>ÔvÙ¶:E@;Í%L@;:=59De<?3>7DF:=Ï,Í9P=3¾<?ÙW:=8;Ò%D4L65±@;Ð�Í9PE3¾@;ÔM5ZÍQ8;L�24365±@CиÍ73:ÝÍ7PE3¾Ò'3Í9PE@?<â>93m5�J=2\ÍQ5±D4:JE:=<?3m5�D4>93m<ÝÔu3P=8�ØWD4@;>'@CÐ�Í7PE3�>9@bÔM@;Í�Û½PE36:ÜÐ�8bL�D4:EÏ·Ò'@�ØWD4:EϬ@bÔ=5�Í78;L2F3m5Õ��¼JE>%3�ÞWÍ73:=<?3m<Ò'3Í9PE@?< ã�I Ì � ÐÑ@b> ô ÙW:=8CÒ%DeL0Ö�:WØWD4>9@b:EÒ%3:vÍ6Gµ@;>%I Ì�� Ú ô Örä�Ï;D4Ø;3m5�J=5�ÔM3Í�Í73>%>93m5�J=2\ÍQ5DF:¹PED4Ï;P=2FÙ¶<?ÙW:=8CÒ%DeLB3:WØWD4>9@b:EÒ%3:vÍ75�8b5�L�@bÒ%Î=8C>736<·Û½DFÍ9P¹Í7PE30I Ì � GµÔEJ?Í'5�Í9D4242�Ó;363Î=5±82F@�Û L�@bÒ'Î=J?Í78CÍ9D4@;:=8;2�Í9D4Ò%308C:M<¹8�Ø;@;De<E5p24@?L8C2rÒ%DF:ED4ÒB8EÕ�ö.PE30I Ì � 8C:=<·Í7PE3 I Ì�� Ú ô Ö8C24Ï;@;>7DFÍ9PEÒB5)P=8�Øb3rÔu336:BDFÒ%ÎE243Ò%3:vÍ736<%8C:=<%L@;Ò%Î=8C>736<�Û½DFÍ9PB5�36Ø;36>78;2v3Þ?ÎM36>9D4Ò%3:vÍ75�Ôu@CÍ7PDF:�8%5�D4Ò±J=248CÍ936< 3:WØWD4>9@b:EÒ%3:vÍ�8C:=< Û½D\Í7P�>93m8C2×>7@;Ôu@CÍ75.D4:¾Í9PE3�ð�@;Ôu@WñrJEξ3:WØWDF>7@;:=Ò'36:vÍ6Õö.PE3½I Ì�� Ò%3�Í7PE@?<%D45)Î=>93m5�36:bÍ736<�DF:¦ýW3mLgÍ7DF@b:%ÿ¼Û½PED42F3½DFÍ75�3�ÞWÍ936:=5�D4@;:%I Ì � Ú ô Ö·De5�<?3�Ú

59L>9D4ÔM3m<%DF:¾ýW36L�Í9D4@;:0ò=Õ;NO: ýW3mLgÍ7DF@b:¦ù�3�Þ?Îu3>7DFÒ%36:bÍQ8C2M>93m5�JE2FÍ75�8C>73½Ï;D4Ø;36:BÛ½PED42F3¼DF: ý?36LgÍ7DF@b:û+8C:08;:=8C24Ù?5�De5�@;РÍ9PE3¼>936248CÍ936<¦Ûr@b>9Ó?5�De5�ÎE>736593:vÍ736< ÕWA�DF:=8;2F24Ù;GvL�@b:=L�24J=59DF@b:=5�8;>93�<E>78�Û½:BD4:Í9PE3+2e8;5�Í�5�3mLgÍ9D4@;:�Õ

� ����� �õÆ���È�Ë��µÄ�Å���� Å���ǽÈNO:,Í9P=D45+5936L�Í9D4@;:,Û�3'<E3657L�>7DFÔu3±Í7PE3'Ò'3Í9PE@?<¬ÎE>93m5�36:vÍ936<¬DF:ßç\é6ùCë½ã�I�DF:E3m8C> Ì >7@;Ïb>78;Ò%Ò'D4:EÏ� 8�ØWDFÏv8�Í7DF@b:0Ï;>Q8;<EDF36:bÍ.Ò%3�Í7PE@?< @b>½I Ì�� ägGEÛ½P=DF243+DF: Í9P=3+:E3�ÞWÍ�5936LgÍ7DF@b: Û�3+<?3657L�>7D4ÔM3aÍ9P=33�ÞWÍ936:=5�D4@;:¶Í7P=8�Í�Ûr3BÎE>7@;Îu@b593%Í9@¬DFÒ%ÎE>7@�Ø;3%DFÍ75�ÎM36>�ÐÑ@b>9ÒB8C:ML�365pÛ½P=3:¶Í9P=3 <?ÙW:=8;Ò'DeL5�@CÐÍ9PE3+36:vØWD4>9@b:EÒ%3:vͽD45�ÍQ8CÓb3:¾DF:vÍ9@B8bLL�@bJE:vÍ6Õö.PE3BI Ì�� Ïb>78b<?DF36:vÍaÒ%3�Í7PE@?<¬De5+Ô=8b5�3m<,@b:·8¾:WJEÒ%3>7D4L68C2�8C>9Í9DFîMLD48;2�ÎM@;Í93:vÍ7D48;2)î=32e<

8CÎEÎE>7@b8bLQPKÕ ö.PE3%Ò%3�Í9P=@W<¶578CÒ%ÎE24365aÍ7PE3¦L�@b:?î=Ï;J=>78CÍ9D4@;:å59Î=8bL�3%8C:=<¶8;5759DFÏb:=5p8 Ø�8;2FJE3'Í7@3Ø;36>9Ù 598;Ò'Î=2FD4:EÏ%ÎM@bDF:vÍ�J=59D4:EϦ8'2FD4:E368;>½ÎE>7@;Ï;>Q8CÒ%Ò%D4:EÏ'8;2FÏb@;>7D\Í7PEÒ�ÕEö.PE3+Ø�8C24JE365�ÐÑ@b>½Í9P=3598;Ò'Î=2FD4:EÏpÎM@bDF:vÍQ5�8C>73�Í9PE3�578CÒ%ÎE2436<'Ø�8C24JE365)@;Ð×8p:M8�ØvD4Ïb8CÍ9D4@;:±ÐÑJE:=LgÍ7DF@b:���Í7PED45�Ò'3m8C:=5�Í9P=8CÍ� ³)§vSUiuXZ]QiO]QVXZf�§¼SUi×TvVXOYZS\V6zUzn��iO´vTbT?_6XOYZ]g`½«��! 'cHkrq#"¸c�Y�VzUSFV^$ 'SU^bS\ijYOXO��_dW¿�`b´bfgVYZSU_6^M}�k�^bSUl�]7XO¯iOSnYH��V^W`+qr]7iO]gVXZf�§&%µ´b^W`;]7X�T;XZ_('H]Qf7Y�q�_m«?_�Á)VXZ]$"*)+ '´bznYZSU¯,)�ªm]Q^�Y�h��;ijYZ]Q[ ¨�SnYZ§±cH^�YZ]QzUzUSUªm]Q^�Y-×Sn©b]Q`'V6^v`. '_m«bSUz\]�q�_m«?_YZS\f�Á�_6[+T?_m^b]Q^�YZi/%9²

Page 3: Planning trajectories in dynamic environments using a gradient

Í9PE3�>7@;Ôu@CÍ�L68C:'î=:=<B8;:'@bÎ?Í9D4ÒB8C2EÎM8�Í9P�G�øZJ=5�Í�ÐÑ@;2424@�Û½DF:EÏaÍ7PE3�<?3m59L3:=<?36:vÍ�Ï;>Q8;<?D43:vÍ�@CÐ×Í9P=3:=8�ØWDFÏv8�Í9D4@;:±ÐÑJE:=L�Í9D4@;:�Í9@p>93m8;LQP±Í9PE3½Ïb@b8C2HÕ�ö.PE3.Ò%3�Í9P=@W<%L68C:�Í78CÓb3�8b5)DF:=ÎEJ?Í�8p5�3Í�@CÐMÏb@b8;2ÎM@bDF:vÍ756G×Í9P=3�îM:=8C2�Îu@;D4:vÍ�@CÐ�Í7PE3BL�@bÒ'Î=J?Í93m<¬Î=8CÍ9P·Û½DF242�Ôu3'Í9PE3BÔu365�Í+@;:E3%Û½DFÍ9P·>93m5�Îu36L�ÍÍ9@ Í9PE3%L�@v5ZÍaÐÑJE:=L�Í9D4@;:å<ED457L�J=575936<,Ôu324@�Û+Õ×NO:¬@b>7<?36>�Í7@ ÔEJ=DF2e<,Í7PE3':=8�ØWDFÏv8�Í9D4@;:�ÐÑJ=:=LgÍ7DF@b:8�Î=8�Í7PÜL�@v5ZÍ�Ò�J=5�Í�Ôu3 <?3î=:E36<KÕ�1 ÎM8�Í9PÜD45�<?3�î=:=36<Ý8b5±8C:¹@b>7<E3>736<¶5�3ͱ@CÐ�578CÒ%ÎE24D4:EÏÎM@bDF:vÍ75

021436587�1:9,7�1<; � 9(=>=>=?9,7A@CB ãZé�ä5�J=LQP Í9PM8�Í6à

D 7�EGFIHKJD6LNM 3POG9(=>=?=>9 é 7QE Ò±J=5�ͽÔM3�8b<�ø�8;L3:vÍrÍ7@ 7�E ; � @;>½8C24@;:=ϱÍ7PE3�8�Þ?De5r@;Ð�Í7PE3pÛr@b>9Ó¦59Î=8;L3@;>½D4:�<?D48;Ï;@b:=8C2D6LNM 9SR DFÐ M!T3+R Í7PE3: 7QE T3#7<RD 7 @ Ò�J=5ZÍ�Ôu3+D4:0Í7PE3�5�3Í�@CÐ�Í9PE3pîM:=8C2KL@;:?î=ÏbJE>Q8�Í9D4@;:M5D6LNM 3POG9(=>=?=>9 é 7 E Ò±J=5�ͽ:E@CÍ�Ôu3+D4: Í7PE3�593�ͽ@CÐ�Í9PE3pîM:=8C2KL@;:?î=ÏbJE>Q8�Í9D4@;:M5U DFØb3:Ü8¬ÎM@bDF:vÍ 7QV G�8,Î=8CÍ9PÜÍ9P=8CÍ%5�Í78;>�ÍQ5�ÐÑ>7@;Ò 7QV 8C:=<Ü>93m8;LQPE3m5+@;:E3¾@CнÍ7PE3 î=:=8C2L�@;:Eî=Ï;JE>Q8�Í7DF@b:=5 7 @ Û½DF242�ÔM3�>936ÎE>93m5�36:vÍ936<�8b5 0WVX3Y5Z7QV[9�=?=>=?9,7 @ B ÕM1 L�@v5ZÍ�ÐÑJ=:=LgÍ7DF@b:�ÐÑ@;>a8Î=8�Í7P 0 De5p8C:·8C>7ÔED\Í7>78;>9Ù ÐÑJE:=L�Í9D4@;:#\ à�]_^` H G Û½PE36>93a] De5�Í7PE3%5�3Íp@;Ð�Î=8CÍ9P=56Õ ö.PED45ÐÑJE:=LgÍ7DF@b:¹L8C:¶Ôu3¦<?D4ØvDe<?3m<åD4:vÍ9@¾Í9P=305�J=Ò-@Cн8C:cbedAfSghbed�ihbkjIjZlmihfp<EJE3%Í9@�Í7PE3%Ð�8;L�Í+Í9P=8CÍÍ9PE3+>7@;Ôu@CÍ.D45.D4:�8'L3>9Í78;DF:�L�@b:?î=Ï;J=>78CÍ9D4@;:KGW8C:=<¾8C:onqp�r(nqjts(dQj(uIjtl�ihf�<EJE3pÍ9@'Í9P=3pL@b5�ͽ@CÐÒ'@�ØWD4:EÏ'ÐÑ>9@bÒ @;:=3aÎu@;D4:vͽÍ9@'Í9P=3+:E3�ÞWÍ�@;:=3;à

\Bã 0 V ä 3 E>vwVx E?v @Gy ã 7 E äwzE?v2V ; �x E?v @|{ ã 7 E 9k7 E>} � ä ã�ÿbä

Û½PE3>73 { 8C:=< y L8;: Ôu3�8C>7ÔEDFÍ9>Q8C>7Ù%ÐÑJE:=L�Í9D4@;:=56Õ� @;>7ÒB8C242FÙbG y <?36ÎM36:=<E5�@b:%PE@�ÛâL2F@v5�3.Í7PE3�>7@;Ôu@CÍ�D45�Í9@+@;ÔM5ZÍQ8;L�24365)@b>�Í9@�~7<E8C:=Ï;3>7@;JM58�>936Ï;D4@;:=56GWÛ½PEDF243 { De5.ÎE>9@bÎM@b>�Í7DF@b:=8C2uÍ7@%Í9PE3�Ö�J=L�24D4<E368C:�<?De5ZÍQ8C:=L3pÔM3ÍZÛr363:¾ÍZÛr@'Îu@;D4:bÍQ5Õö.PE30Ø�8C24JE3¾@CÐ�Í7PE3¾:=8�ØWDFÏv8�Í9D4@;:¶ÐÑJ=:=LgÍ7DF@b:�� V GµD4:â8åÎM@bDF:vÍ 7 V G)De5±Í7PE3�L�@b5�Í�@;Ð�Í9P=3Ò'D4:ED4Ò±JEÒ L�@v5ZͽÎ=8CÍ9P¾Í9P=8CÍ�5ZÍQ8C>9Í75�ÐÑ>7@;Ò Í7P=8�Í�Îu@;D4:vÍ6à

� V 3 Ò%D4:� v �h��������� � \Bã 0 �V ä ã�òvä

Û½PE3>73 0 �V De5¼Í9PE3 R ÚHÍ9P¬ÎM8�Í9P·5ZÍQ8C>9Í9D4:EϦÐÑ>7@;Ò Îu@;D4:vÍ 7:V 8C:M<,>7368;LQP=DF:EÏ0@;:E3'@CÐ�Í7PE3�î=:=8C2<?365�Í9D4:=8�Í7DF@b:=5½8C:M<I�÷De5.Í7PE3+:WJEÒ±Ôu3>½@;Ð)59J=LQP¾Î=8�Í7P=5Õñ�8C2eL�JE2e8�Í7DF:EϦÍ9PE3':=8�ØWDFÏv8�Í7DF@b: ÐÑJ=:=LgÍ7DF@b:�� V ÐÑ@;>a3Ø;36>9Ù¾Îu@;D4:bÍaDF:¬Í9PE3%L�@b:?î=ÏbJE>78CÍ9D4@;:

5�Î=8bL�3%<?D4>93mLgÍ924Ù;G×Û�@;JE2e<,>736ívJED4>73'8 Ø;36>9Ù�PED4Ï;P·L�@bÒ'Î=J?Í78CÍ9D4@;:=8;2µÍ7DFÒ%3bG 3Ø;36:,ÐÑ@b>p8¾59Ò%8;2F2L�@;:Eî=Ï;JE>Q8�Í7DF@b:·59Î=8bL�3;Õ�ö.PE3K�[�<�¬8C24Ï;@b>9DFÍ9P=Ò çFéùCërD45±J=5�3m<·Í9@,3á¦L�D43:vÍ924Ù·L@;Ò%ÎEJ?Í73BÍ9P=3:=8�ØWDFÏv8�Í9D4@;:åÐÑJE:=L�Í9D4@;:KÕµNjͱDe5�8�Ï;36:E3>Q8C24D4ó68�Í7DF@b:¬@;Ð�Í7PE3.�A�������[���q�&�c�&�q���q�:���[�q�âçFé6þ=G�ê�ëÍ9P=8CÍ�D45.Ô=8b5�3m<0D4:vÍ9@%Í7PE>9363pÒ%8;DF:�5�Í936Î=5à

D 8;575�D4Ï;:¾Ø�8C24JE3+ü'Í9@%3Øb3>7Ù¦Îu@;D4:bÍ�D4:¾Í9PE3pîM:=8C2KL@;:?î=ÏbJE>Q8�Í9D4@;:�8C:M< 8;:¾D4:?î=:=D\Í73+Ø�8;2FJ=3Í9@B36Ø;3>7ÙB@CÍ7PE3>½Îu@;D4:vÍ��D ÎEJ?ͽÍ7PE3+Ï;@v8C2K593�ͽÎM@bDF:vÍQ5½DF:�8;:#n�j�fSbe��sa��b�ihf��

Page 4: Planning trajectories in dynamic environments using a gradient

D 8�Íp368bLQP¬DFÍ93>Q8�Í7DF@b:¬@;Ð�Í9PE3%8C24Ï;@b>9DFÍ9P=Ò¾G×@bÎM36>78CÍ93±@b:¬3m8;LQP¬Îu@;D4:vÍa@;Ð�Í9P=3%8bLgÍ7DFØb3�24D45�Í6G>936Ò%@�ØvD4:EÏ'D\ͽÐÑ>7@;Ò Í9PE3+24D45�Í�8C:M< J=Îu<E8CÍ9D4:EÏBDFÍ75½ú�Új:E36DFÏbPvÔu@;>Q5pã�Ö�ÞWÎM8C:=59DF@b:0ÎEPM8;593mägÕö.PE3+3�Þ?Î=8;:=5�D4@;:¾ÎEP=8b5�3+De5.>73Îu368�Í736<¾JE:vÍ9D42KÍ7PE3Knqj(fSbe��sa��b�ihf.D45�:E@CÍ�36Ò'ÎEÍZÙ;Õ=öµ@BJEÎ×<E8�Í73�8ÎM@bDF:vÍ 7 Ûr3p@bÎM36>78CÍ93+8;5�ÐÑ@b2F24@�Û+àD ÐÑ@;>�36Ø;36>9ÙåÎM@bDF:vÍ��¾DF:¶Í7PE30úCÚH:E36DFÏbPWÔM@b>75a@CÐ 7 L@;Ò%ÎEJ?Í73¦D\ÍQ5�Ø�8C24JE3bG�8;<E<EDF:EÏ�Í7@�Í9P=3Ø�8C24JE3+@CÐ 7 Í9PE3+Ò%@�ØWDF:=Ï'L@b5�Í�ÐÑ>7@;Ò 7 Í9@.��8;:=< Í9PE3+D4:vÍ9>7DF:M5�DeLpL�@b5�ͽ@CÐG�WÕD D\ÐrÍ9PE3%:E36Û Ø�8C24JE3�ÐÑ@;> �BDe5p2F3m595�Í9P=8;:¬Í7PE3'ÎE>936ØWDF@bJ=5a@;:E3bGuJ=Îu<E8CÍ93�Í9PE3%Ø�8C24JE3�ÐÑ@;> �8C:=<¾ÎEJEÍ�D\Í�D4:vÍ9@'Í9PE3Kn�j�fSbe�ms��¡b�itfHÕNO:�A�D4Ï;JE>73%é+8C:¾JEÎu<=8�Í93�5�Í936Î�D45�59PE@�Û½:KÕ

Cnew= 39C old= 40

A = 14

C = 20

I = 5

p

q

¢�£?¤ ¥�¥W¥ ´vTE`bVYZ].ijYZ]7T

OV

Path A(Choosen one)

R

G

Path B

¢�£?¤ ¥(¦=¥ ­ XZ_m«vzU]Q[+i�`;´v]�YZ_a`;�;^WV[+S\f�_m«vijY�VfQzU]ö.PE3B:=8�ØWDFÏv8�Í7DF@b:åÐÑJ=:=LgÍ7DF@b:¹D45�L�@;Ò%ÎEJEÍ936<¹8bLL@;>Q<?DF:=Ï Í7@�Í9P=3¦DF:vÍ7>9D4:=59D4LBL@b5�ͱ@CÐ.Í9P=3

598;Ò'Î=2FD4:EϽÎu@;D4:bÍQ5 D4:pÍ9PE3�L@;:?îMÏ;JE>Q8�Í7DF@b:¼59Î=8;L3;Õ6ýWJ=ÎEÎM@v5�3)Í7PE3�@bÔ=5ZÍQ8;L2F3m5×DF:pÍ7PE3�Û�@;>7ÓW59Î=8bL�38C>73BÏ;D4Ø;3:¶ÔWÙå8�593�Í�@CÐ.@;Ô=5�Í78bL�243¦598;Ò'Î=2FD4:EÏ�Îu@;D4:bÍQ5Õ�IK3ÍX§Bã�¨näpÔu308�Ï;36:E3>7DeL±ÐÑJ=:=LgÍ7DF@b:8C:=<X©Mã 7 äµÍ7PE3�Ö�J=L2FDe<?3m8C:%<?D45�Í78;:=L�3�ÐÑ@b>)Í9PE3�578CÒ%ÎE24DF:=ÏaÎu@;D4:vÍ 7 ÐÑ>9@bÒ Í9PE3�L2F@v5�3m5ZÍ�578CÒ%ÎE243ÎM@bDF:vÍ+>936ÎE>736593:vÍ9D4:EÏ08;:å@bÔ=5ZÍQ8;L2F3bG=Í7PE3: y ã 7 ä 3 §¦ãk©uã 7 ä9ägÕ NO:·@;>Q<?3>¼Í9@�L�@bÒ%ÎEJ?Í93ª©uã 7 äÐÑ@;>�36Ø;3>7Ùå578CÒ%ÎE24D4:EÏ,Îu@;D4:bÍ�Ûr3BÒB8�Ù¶8CÎEÎE24Ù,Í7PE3I�[�<�å8;2FÏb@;>7D\Í7PEÒ-ÏbDFØWD4:EÏ�Í9P=3¦@;Ô=5�Í78bL�243598;Ò'Î=2FD4:EϱÎu@;D4:vÍ75.8;5rÍ7PE3�îM:=8C2 L�@b:?î=ÏbJE>78CÍ9D4@;:¦593�ÍmGW8;:=<08b5959D4Ï;:ED4:EϱD4:¦Í7PE3aDF:EDFÍ9De8C24D4ó68�Í7DF@b:ÎEP=8;593+8'Ø�8;2FJ=3pü�Í7@�Í7PE3+D4:bÍ7>9D4:=59D4LpL@b5�Í�ÐÑ@b>�8C242×Í9PE3�578CÒ%ÎE24D4:EÏ%ÎM@bDF:vÍ756Õ��¼:=L3$©uã 7 äpã�8;:=<Í9PE36: y ã 7 ä�ä�D45rL�@;Ò%ÎEJEÍ936<'ÐÑ@b>�3Øb3>7Ù±578CÒ%ÎE24DF:EÏ+Îu@;D4:vÍ 7 G;Ûr3�L68C:%3�Þ?36LJ?Í93¼8CÏb8;DF:�Í9P=3!�[�[�8C24Ï;@;>7DFÍ9PEÒ Í7@¦L�@;Ò%ÎEJEÍ93pÍ9P=3+:=8�ØWDFÏv8�Í9D4@;:0ÐÑJE:=L�Í9D4@;:KÕö.PED45¦Ò'3Í9PE@?<õPM8;5BÔu336: LQPE@b593:ßÐÑ@b>¦@;JE>03�ÞWÍ936:=5�D4@;: ÐÑ@b>0593Ø;36>78;2½>93m8;59@;:=56Õ�A�DF>Q5�Í

@CÐa8;2F2�Í7PE3�Ò'3Í9PE@?<âD45'Øb3>7Ù¶Ð�8;5�Í6à)D\ÍBDe5%ÎM@v5959D4ÔE2F3 Í9@¶8CÎ=ÎE2FÙÝÍ9PE3 Í9>Q8�øZ3mLgÍ9@b>9Ù¶ÎE2e8C:=:EDF:=Ï3Ø;36>9Ù¾é6übü+ÒB5�@;:08±Ï;>7D4<B@;Ð�é6übü�«½émü;üp598;Ò%ÎE2FD4:EÏ�ÎM@bDF:vÍ75�@b:08�Ò%@?<?365�Í�ñ Ì�¬ ã Ì 3:vÍ9D4JEÒÿCê;ê�­®�ó�ä�çFéù;ëHÕ¯­�@b>936@�Ø;3>mG�Í7PE3¶Ò'3Í9PE@?< î=:=<E5�8;: @;ÎEÍ9D4Ò%8;2pÎ=8�Í7P Û½DFÍ9P >93m5�Îu36L�Í Í7@Í9PE3¦L@b5�ͼÐÑJE:MLgÍ9D4@;:¶J=5936<KÕKö.PE@b593�Î=>9@bÎM36>�Í7DF3m5+8C>73�Øb3>7Ù�DF:vÍ936>93m5ZÍ7DF:=Ï0ÐÑ@b>pÍ9PE3Bð½@bÔM@?ñrJEÎ3:WØWDF>7@;:EÒ%36:bÍmGÛ½PEDeLQP�De5KÍ7PE3�36:WØvD4>7@;:EÒ%3:vÍKÍ7P=8�Í�Ûr3rJ=5936<pÐÑ@b>�@;J=>�3�Þ?Îu3>7DFÒ%36:bÍQ5Õ�ö.P=8;:EÓ?5Í9@¾Í9PE3B24@�Û L@;Ò%ÎEJ?ÍQ8�Í7DF@b:=8C2�>736ívJED4>936Ò%3:vͼÍ7PE3¦578CÒ%ÎE24DF:EÏ�@;Ð�Í9P=3¦L�@;:Eî=Ï;JE>Q8�Í7DF@b:å59Î=8;L3L8C:ÜÔM3�3�Þ?ÎE24@;DFÍ93m<¹D4:Ü@;>Q<?36>�Í9@·>7368;LQPÝ8·578�Í9De5�ÐÑÙvD4:EÏåÎE>93mL�De5�D4@;: ãZé6üåL�Ò D4:Ü@bJE>'L68;593mä�Õ�¼:BÍ9PE3¼@CÍ7PE3>rP=8C:=<KGCÍ9P=3¼ÓW:E@�Û½:BD4:?ÐÑ@;>7ÒB8�Í7DF@b:¦8CÔu@;J?Í�Í7PE3�36:WØvD4>7@;:EÒ%3:vͼã�5�JMLQP08;5�î=32e<

Page 5: Planning trajectories in dynamic environments using a gradient

5�P=8;ÎM3 8C:=<¹Îu@b59DFÍ9D4@;:¹@CÐ.îEÞ?3m<¹@;Ô=5�Í78bL�24365QäpL8;:¹ÔM3 368;59D42FÙ¶8C:=<¶3æu3mLgÍ7DFØb324Ù¬ÍQ8CÓ;36:¹DF:vÍ7@8;LL@;JE:vÍmÕw­�@;>73@�Øb3>mG×Í9PE30DF:vÍ9>7D4:=5�DeL¦L@b5�Í+ÐÑJE:=LgÍ7DF@b:ÜL8;:¹ÔM3¦Í78CD424@;>736<·DF:â8�Ø;3>7Ùå<EDF>736L�Í8C:=<B59DFÒ%ÎE243�ÒB8C:=:E3>mGCÍ7@�@;Ô?ÍQ8CD4:¦<?DFæu36>936:bÍ�Í9>Q8�øZ36L�Í9@b>9D43656GC8C:=<B59@�<?DFæu36>936:vÍrÔu3P=8�ØWD4@;>Q5)@CÐÍ9PE3+>7@;Ôu@CÍmÕ�@�Û�3Ø;36>6GuÍ7PE3¦I Ì � Ò'3Í9PE@?<¶<?3m59L>9D4ÔM3m<·DF:·Í9P=D45�5936L�Í9D4@;:¹<?@W365p:=@CÍ+Í78;Ó;3%D4:bÍ7@,8;L�ÚL�@;J=:bÍaÍ9P=3'<?ÙW:=8;Ò%D4L65�@;Ð�Í9PE3'3:WØWD4>9@b:EÒ%3:vÍ6Õ×ö.PEDe5¼De5p8¦24DFÒ%DFÍ78CÍ9D4@;:¬Û½P=3:åL@;ÎED4:EÏ Û½D\Í7PØ;3>7Ù�<?ÙW:=8CÒ%DeL±@bÔ=5�Í78;L2F3m5¼8;:=<,DFÍ+L8C:å>93m5�J=2\ÍpDF:å:E@;:EÚH@bÎ?Í9D4ÒB8C2)Î=8�Í7P=5aDF:·5�@bÒ%3'L>9DFÍ9DeL8;25�DFÍ9J=8CÍ9D4@;:=56ÕE1�5�8C:¾3�ÞE8CÒ%ÎE243;GED4:�A�DFÏbJE>93�ÿ�Û�3pL68C:�5�363pÍ9P=8CͽÐÑ@;>.Í7PE3+>9@bÔM@;Í�ð Í7@%>93m8;LQPÍ9PE3'Ï;@v8C2 U GuÎM8�Í9P±° Ûr@bJE2e<,Ôu3�Ôu3�Í9Í93>aÍ7P=8C:åÎ=8�Í7P·1±GuÛ½P=3:,Í7PE3'@;Ô=5�Í78bL�243�<?ÙW:=8;Ò'DeL5D45�L�@;:M5�De<?3>736<KG ÔEJ?Í�Í7PE30I Ì � Ò%3�Í7PE@?<¶Ûr@bJE24<¶LQPE@W@v5�3%Î=8CÍ9PÝ1�G�Í9P=8CͱDe5pÍ9PE30@;Î?Í7DFÒB8C2Í9>Q8�øZ36L�Í9@b>9ÙBÛ½DFÍ9P�>73659ÎM3mLgÍ.Í9@%Í7PE3�L�JE>7>73:vÍ.Í9D4Ò'3pÐÑ>Q8CÒ%3bÕ

² �����´³�µP¶·�¸� Å���ǽÈö.PE3�3�ÞWÍ936:=5�D4@;:ÜÍ9@·Í9P=3�I Ì�� Ò%3�Í7PE@?<ÝÐÑ@b>%8;ÎEÎE24D4L68�Í7DF@b:âD4: ô ÙW:=8CÒ%DeL�Ö�:WØWDF>7@;:EÒ%36:bÍQ5ã�I Ì � Ú ô Ö�ä�D45%Ô=8b5�3m<Ü@b:ß8b<E<?DFÍ9D4@;:=8;2½DF:EÐÑ@;>7Ò%8CÍ9D4@;:ß8CÔu@;J?ͦÒ%@�ØWDF:=Ïå@bÔ=5ZÍQ8;L2F3m5G)Û½PEDeLQP8C>730>73ÎE>736593:vÍ93m<¹ÔWÙÝ8,Øb324@WLD\ÍZÙ¶Øb36LgÍ7@;>mÕG�¼ÔM5�36>9Øb3¦Í9PM8�Í%Ûr3�<?@¬:=@CÍ%>93míbJ=DF>73¦Í7@åP=8�Øb3L�@;Ò%ÎE243�Í73�ÓW:E@�Û½2436<?Ïb3�@CÐ×Í7PE3a<EÙv:M8CÒ%D4L65�@;РÍ9PE3¼3:WØWDF>7@;:EÒ%36:bÍrDF:¾8;<?Ø�8C:ML�3±ãÑÍ9P=8CÍrÛ�@;JE2e<:E@CÍ�ÔM3rÎM@v5959DFÔ=2F3�D4:�ÒB8C:WÙpL8b5�3m57ä�G�ÔEJ?Í)@;:E24Ùp8;575�JEÒ%3�Í7@�ÓW:E@�Û¹8C:+3m5ZÍ7DFÒB8�Í7DF@b:+@CÐEØb324@WLD\ÍZÙØ;36L�Í9@b>75�ÐÑ@;>�Í7PE3'@;Ô=5�Í78bL�243656Õ � @;Í9DeL�3'8C2e5�@BÍ7P=8�ͼÍ9PEDe5a>93mívJEDF>73Ò%36:bÍaL8C:¬ÔM3�@;Ô?ÍQ8CD4:E36<�ÔWÙ8C:,8C:M8C24ÙW59De5.@CÐ�5�36:=59@;>�<E8CÍ78=G=8C:=<�DFÍ75�ÎE>736L�De59DF@b:¾De5½:E@;ͼL�>7DFÍ9DeL8C2�ÐÑ@;>½Í7PE3�Ò%3�Í7PE@?< GMÍ9P=8CÍD45±>9@bÔEJ=5�ͱ۽D\Í7PÝ>73659ÎM3mLgÍ+Í9@å3>7>9@b>75pD4:¹3Ø�8;2FJ=8CÍ9D4:EϬ59J=LQP¹Ø;362F@?LD\ÍZÙåØ;36L�Í9@b>756Õw­�@b>936@�Ø;3>mGÍ9PE3�ÎE>9@bÎM@v5�3m<¾3�ÞWÍ936:=5�D4@;:,<E@v3m5�:E@;ͼ<?36ÎM36:=<�@;:�Í7PE3�Í736LQPE:=D4ívJE3�JM5�3m<¾Í9@0L@;Ò%ÎEJ?Í73�Í9P=3Ø;324@?L�DFÍZÙ�Ø;3mLgÍ9@b>75�ÐÑ@;>pÍ7PE3%@;Ô=5�Í78bL�243656Õ�@�Û Í7PE@b593�D4:?ÐÑ@b>9ÒB8�Í7DF@b:·8;>93'@;ÔEÍ78CD4:E3m< G×Ò%8;DF:=2FÙ<?3Îu3:=<=5½@;:�5�Îu36LD\îuL+5�36:=5�@b>75r@CÐ�Í9P=3+>9@bÔM@;Í.8;:=<¾@;JE>.Î=8;>�Í7D4LJE248;>.DFÒ%ÎE243Ò%3:vÍQ8�Í9D4@;:�Û½D42F2ÔM3�<?3m59L>9D4Ôu36<¾248CÍ936>6Õ�°�Ù 59JEDFÍ78;ÔE2FÙ¦Í78CÓWD4:EÏBD4:bÍ7@BL�@;:M5�De<?3>Q8�Í7DF@b:0Í7PE3+D4:?ÐÑ@;>7ÒB8�Í9D4@;:�8CÔu@;JEÍÍ9PE3¦Øb324@?L�DFÍZÙ,Ø;3mLgÍ9@b>75pD4:·Í9PE30ÎE248;:E:ED4:EÏ�Ò%3�Í7PE@?<¶Ûr3¦59PE@�Û Í7P=8�Í�@;JE>+3ÞvÍ73:=59D4@;:¶Ï;D4Ø;3m5ÔM3Í�Í936>�>73659JE2\Í.Í7P=8C:¾Í9P=3+Ô=8;59D4LpI Ì�� 8C24Ï;@b>9DFÍ9PEÒ�ÕNO:¬@;>Q<?36>¼Í7@¾L248;>9DFÐÑÙ,PE@�Û Í9PE3BI Ì � Ú ô Ö D4:bÍ73Ïb>78CÍ93�Í7PE3B@;ÔM5ZÍQ8;L�243�<EÙv:M8CÒ%D4L65pDF:EÐÑ@;>9Ú

Ò%8CÍ9D4@;:,D4:vÍ9@ Í9PE3'ÎE2e8C:E:=DF:EÏ ÎE>7@WL36575GMÛr3'D4:bÍ7>9@?<?JML�3�Í7PE3%L�@;:ML�3ÎEͼ@CÐNbed�¹»ºAs�d:jts�gZsS¼qbklmd@CÐ�8;:0@bÔ=5ZÍQ8;L2F3bÕWö.P=D45½<?3î=:EDFÍ9D4@;:¾D45.ÔM8;5936<¦@b:¦Í7PE3aÐ�8;LgÍ.Í7P=8�Í.Í9P=3aD4:vÍ9>7DF:M5�DeLpL�@b5�Í y ã 7 ärD45Ï;3:=3>Q8C242FÙB24DFÒ%DFÍ93m< G=DHÕ 3bÕ?D\Í�De5�ü�ÐÑ@;>½Îu@;D4:vÍ75 7 59J=LQP Í9P=8CÍ!©Mã 7 ä¾½�¿WG?ÐÑ@;>�8�Í9P=>93m5�PE@b24<À¿WÕÁIÂ[ÃWÄ2ÅkÆ�ÅkÇQÄÉÈ_ÊQË spD4:?ï=JE36:=L�3½>73ÏbDF@b:$Ì�lCgÍnCdÎlqÏ�ihfÐn�j��>s»Ñ E b�iÒf Ë s¯i(s(fWl/̾i(nmÓ!ÔQ�?s�ÔAlmbed�fki7ÖÕ2Ë lmi(s×bed�f,ghbedAitbkjªjtl�ihf y ã 7 ä b�i Ó.l�pCb Ø stpÎÏ�u.f Ë sXlqÏ�ihfÐn�j��?s$Ñ EZÙ°�8b5�DeL8;2F24Ù Í9PE3'DF:Eï=JE3:ML�3'>936Ï;D4@;:�@CÐ�8;:¬@bÔ=5ZÍQ8;L2F3aÑ E D45�Í9P=3'8;>93m8¦5�J=>9>7@;JE:M<?DF:=ϦÍ9P=3@;Ô=5�Í78bL�243�Í7P=8�Í)Ûr3�Û.8C:v͵Í7@a8�Øb@;De< GmD�Õ 3;Õ�Í7PE3½5�3Í�@;ÐMÎu@;D4:bÍ�8C>7@;J=:=<aÑ E ÐÑ@;>)Û½PEDeLQP y ã 7 䯽âüEÕñr@;:=59D4<E3>7DF:EÏpÍ7PE3a@;Ô=5�Í78bL�243½ÎM@bDF:vÍZÛ½De5�3bGv8;:BDF:vÍ9>7D4:=5�DeL�L@b5�Í�ÐÑJE:=L�Í9D4@;:0<E3Îu3:=<?D4:EÏ�@;:E24Ù�@b:Í9PE3¦<?De5�Í78C:ML�34©uã 7 ä�G�Û½D42F2�>93m5�JE2FÍ�D4:¶LDF>QL�J=248;>.bed�¹»ºAs�d:jts.g8sмqbklmd�igG�8;5pDFÍ�L8;:åÔu305933:¶D4:AµD4Ï;J=>93'òEÕ ö.PE3�I Ì�� Ú ô Ö 3ÞWÍ93:M5�D4@;:�Í7P=8�ÍpÛ�3±ÎE>7@;Îu@b593±PE36>93'<?3�îM:E365p8BÐÑJ=:=LgÍ7DF@b: y ã 7 ä>93m5�JE2FÍ9D4:EÏ%D4:±bedÚ¹»ºAs�d:jZs×g8sмCbklCd�i�8;5½59PE@�Û½:¾DF:�A�D4Ï;JE>73pù=Õ1�5�D4:vÍ9JEDFÍ9D4Ø;362FÙ�59PE@�Û½:�DF:åAµD4Ï;J=>93m5�ò¦8;:=<�ù=G=Í9PE3'I Ì�� Ú ô Öõ3ÞvÍ73:=59D4@;:�De5�<?3m5�D4Ï;:E3m<

DF:ß5�J=LQPÝ8¬Û�8�ÙåÍ9@åÎE>73�ÐÑ3>�Í9>Q8�øZ3mLgÍ7@;>7DF3m5+ÐÑ@;>�Û½PEDeLQP¹Í9PE3¾ÎE>7@;Ô=8;ÔED42FDFÍZÙå@;Ð�L�@b2F24D459D4@;:=5¾ãÑ@b>Í9>Q8�øZ36L�Í9@b>9ÙpD4:bÍ73>Q5�3mLgÍ7DF@b:=57ä�Û½DFÍ9P%Ò%@�ØvD4:EÏa@;Ô=5�Í78bL�24365µD45)Ò%D4:ED4Ò±JEÒ�ÕCNO:�Ð�8;L�Í6G�Í9P=3rÐÑJ=:=LgÍ7DF@b:y ã 7 ä%D4:õI Ì�� Ú ô Ö Ò%@?<?D\îM365BÍ7PE3,59P=8CÎu3�@CÐpÍ9P=3obed�¹»ºAs�d:jts®g8sмqbklmd 8;LL@;>Q<?D4:EϬÍ7@¹Í9P=3

Page 6: Planning trajectories in dynamic environments using a gradient

Goal

Robot

Obstacle

Influence region

¢�£>¤ ¥(ÛE¥ iOSU[+TvzU]0S\^qÜW´b]Q^vfQ]¦XZ]7¯ªmSU_6^À"Ñtu­K®¯%

Goal

Robot

Influence region

Obstacle

¢�£>¤ ¥hÝu¥ ]7©CYZ]Q^v`b]g` SU^qÜW´v]7^vfQ]XZ]7ªmSU_m^À"ÑtM­�®�¯�R½¿Þ%

p

ßWà�á�âãWä�ã å æ

ç à�á&â¢�£>¤ ¥�è=¥ yµV6zU´v]Qi¦de_X¾f7_m[+Tv´;YO¯SU^vª$é&"�ê�%

DF:?ÐÑ@b>9ÒB8CÍ9D4@;:¶8CÔu@;J?Í+Í7PE3B@;Ô=5�Í78bL�243'<EÙv:M8CÒ%D4L65Gµ8;5+59PE@�Û½:åD4:¹A�DFÏbJE>93%ùMÕµñr@;:=5936ívJE36:bÍ72FÙÍ9PE3 ÔM36P=8�ØWDF@b>±@CнÍ7PE30>7@;Ôu@CÍ'D45±Ò%@;>73 8;<E36ívJ=8�Í73BÍ9@¬Í9PE3¾5�DFÍ9JM8�Í9D4@;:�G�59DF:ML�3¦Í7PE3 LQP=@b593:Î=8�Í7P¾Û½D4242KÔM3pÍ7PE3+@;:=3aÎM8;575�D4:EÏ'ÔM36PEDF:M<¾Í9PE3+@;Í9PE36>½>9@bÔM@;Í6G?Û½PEDeLQP De5�59PE@;>9Í936>½8C:�598CÐÑ3>mÕNjÐ=8½Ï;D4Ø;36:+ÎM@bDF:vÍ 7 ÔM362F@b:EÏb5KÍ9@�Í7PE3�D4:?ï=J=3:=L3�>73Ï;D4@;:p@;Ð=8C:+@;ÔM5ZÍQ8;L�243 Ñ E Í7PE3�D4:vÍ9>7DF:=59DeL

L�@b5�Í�ÐÑJE:MLgÍ9D4@;:%ÐÑ@b> 7 Û½D4242u<?36ÎM36:=<%:E@;Ír@;:=2FÙ�@;:%Í9P=3¼<?De5ZÍQ8C:=L3½ÐÑ>7@;ÒëÑ E G;ÔEJEÍ�8C2e59@+@;:%Í9P=3ÎM@v5�DFÍ9D4@;:¾@CÐ 7 Û½D\Í7P�>93m5�Îu36L�Í�Í7@'Í9PE3+Øb324@WLD\ÍZÙ0Ø;36L�Í9@b>�@;ÐGÑ E Õö.PE3>73�ÐÑ@b>93¼Í9PE3pÐÑJ=:=LgÍ7DF@b: y ã 7 ä�Û½DF242�<?36ÎM36:=<¾@;:¹ã�5933+A�D4Ï;JE>73�û;ägàD Í9PE3�<ED45�Í78;:=L�3 ©uã 7 ä½@CÐ�Í7PE3+Îu@;D4:bÍ 7 Û½DFÍ9P�>73659ÎM3mLgÍ.Í9@4Ñ ED Í9PE3'8C:EÏb2F3×ì�ã 7 ä½Ôu3�ÍZÛ�336:�Í9PE3±Ø;324@?L�DFÍZÙ Øb36L�Í9@;>¼8C:=<¾Í7PE3±24DF:=3�>93m8;LQPED4:EÏ%Í7PE3�L3:vÍ936>@CÐ�Ñ E GD Í9PE3+Øb324@?L�DFÍZÙQ� 5.Ò%@?<?JE243Kí��Àí¼@CÐ�Ñ E

ýW@ y ã 7 ä�D4:�I Ì�� Ú ô ÖßD45½ÏbDFØb3: ÔvÙ¾8�ÐÑJE:=LgÍ7DF@b:®§Bãk©uã 7 ä 9 ì�ã 7 ä 9 í¾�Iíä�Õö�@ÝL@;Ò%ÎEJ?Í73�Í9PE3¬DF:vÍ9>7D4:=5�DeL�L�@v5ZÍ0ÐÑJE:=LgÍ7DF@b: y ã 7 ä�Gr<?36ÎM36:=<?D4:EÏÝ@;: Í7PE3,Ø�8C24JE3m5¦<?3�Ú59L>9D4ÔM3m<08;ÔM@�Øb3;GCÍ7PE3pI Ì�� 8C24Ï;@b>9DFÍ9P=Ò P=8b5�ÔM363: 5924DFÏbPbÍ72FÙBLQP=8;:EÏ;3m< Õvìå3a>936ÎE>736593:vÍr3m8;LQPÒ'@�ØWD4:EÏ'@;Ô=5�Í78bL�243p8b5.8'LDF>QL�243+8C:=< Û�3aJM5�3aÍ9P=3a>7@;Ôu@CÍ�593:=59@;>Q5rÐÑ@;>.@;ÔEÍ78CD4:ED4:EÏ=GE8Cͽ3Ø;36>9Ù:E3Û�ÎE2e8C:E:ED4:EÏ,LÙWL2F3bG�ã�8;:¶365�Í9D4Ò%8CÍ9D4@;:·@CÐ7äpÍ9PE30L3:vÍ936>6G×Í7PE3B>Q8;<?D4J=5�8;:=<,Í7PE3¦Øb324@WLD\ÍZÙØ;36L�Í9@b>½@CÐ�368bLQP @bÔ=5ZÍQ8;L2F3bÕ=ö.PE3+Ô=8b5�DeL+5ZÍ7>9JMLgÍ9J=>93+@;еÍ7PE3±8C24Ï;@b>9DFÍ9P=Ò D45�Í9PE3�598;Ò'3+8b5�<?3�Ú59L>9D4ÔM3m<'DF:¦ýW3mLgÍ9D4@;:Bÿ?G;ÔEJ?Í�Í9P=3½DF:vÍ9>7D4:=5�DeL½L�@v5ZÍ)ÐÑJE:MLgÍ9D4@;:�G�Í9PE3½D4:EDFÍ9De8C24DFóm8�Í7DF@b:%8;:=<'JEÎ×<E8�Í735ZÍ73Î=5.ÐÑ@b>�L�@bÒ'Î=J?Í9D4:EÏ'Í9PE3+D4:vÍ9>7DF:M5�DeLpL�@b5�Í�LQP=8C:=Ï;3;Õ=ý?ÎM3mL�DFîML8;2F24Ù×àé;Õ y ã 7 ä 3 §Bãk©uã 7 ä 9 ìrã 7 ä 9 í¾îIí6ägÕÿ?Õ.NO:¶Í9PE30DF:EDFÍ9De8C24D4ó68�Í7DF@b:¹5ZÍ73ζÛr3BPM8�Ø;3'Í9@,>73Î=>93m5�36:bÍpÍ7PE3¦Ø;362F@?LD\ÍZÙ,Øb36L�Í9@;>¦ã�Ò%@W<EJE2F38C:=<¶P=368;<EDF:EÏWä+@;Ð.3m8;LQP¶@;ÔM5ZÍQ8;L�243¦D4:Ý368bLQP¶@CнÍ9P=30598;Ò%ÎE2FD4:EÏ,Îu@;D4:vÍ75�>936ÎE>736593:vÍ9D4:EÏÍ9PE3 L�3:vÍ73>�@;Ð.8;:·@bÔ=5�Í78;L2F3��KÛ�3BÏ;D4Ø;3%Í9@�3m8;LQP·@CÐ.Í9P=@b593BÎM@bDF:vÍ�8�PED4Ï;P¶Ø�8C24JE3¦8;:=<ÎEJ?ͽÍ7@Bó3>7@�Í9PE3+Ø�8C24JE3m5½@CÐ)8C242×Í9PE3+@;Í9PE36>�598;Ò'Î=2FD4:EÏ%ÎM@bDF:vÍQ5Õ

òEÕ.NO:¬Í7PE3%JEÎ×<E8�Í73%5�Í936ÎKG DFÐ�Í9P=3':=3Û L@;Ò%ÎEJ?Í736<·L�@v5ZÍaÐÑ@;>+8 ÎM@bDF:vÍ×�¬ã�N�ã�í?ä�äp8b<�ø�8;L3:vÍÍ9@¦8'Îu@;D4:bÍ 7 De5½Ï;>7368CÍ936>�Í7PE3:¾Í9P=3�8;LgÍ7J=8C2µL�@b5�Í6àD JEÎ×<E8�Í73pÍ9PE3�L@b5�ͽ@CÐ�Í9PE3+Îu@;D4:vÍ!�WGD ÎE>7@;Î=8;Ïb8CÍ93¼Í9PE3+Øb324@WLD\ÍZÙ0Ø;36L�Í9@b>.8;:=< ÎM@v5�DFÍ9D4@;:�@CеÍ9PE3+@bÔ=5�Í78;L2F3+L3:vÍ936>6GD ÎEJ?ÍaíBDF:¾Í7PE3Knqj(f,be�msa��b�ihf�Õ

Page 7: Planning trajectories in dynamic environments using a gradient

NO:�Î=8C>9Í9DeL�JE2e8C>¼8�Í�3m8;LQP,5�Í93άÛr3�:=336<¾Í7@¦ÎE>7@;Î=8;Ïb8CÍ93pÍ9P=3±Ø;362F@?LD\ÍZÙ Ø;36L�Í9@b>�8C:=<�Îu@CÚ5�DFÍ9D4@;:·DF:EÐÑ@;>7Ò%8CÍ9D4@;:åDF:¶8C242)Í9PE3%Îu@;D4:vÍ75aÍ9PM8�Í�8C>73�ÎM8C>9Ía@;Ð�Í9P=3'D4:?ï=J=3:=L3'>73ÏbDF@b:¬@;Ð�Í9P=3@;Ô=5�Í78bL�243�ÔM3mL8;J=5�3�Í9PE@v5�3rDF:EÐÑ@;>7Ò%8CÍ9D4@;:�8;>93r:E33m<?36<+D4:+Í7PE3�L@;Ò%ÎEJ?ÍQ8�Í7DF@b:�@CÐ?Í7PE3�D4:vÍ9>7DF:=59DeLL�@b5�Í.ÐÑJE:=L�Í9D4@;:�N�ãÑÎMä�Õ

ï�ð È ñ�ò+óÞô,Â[òÖÂ[Ä:ÆÚõ&Æ�Å,Ç�Äö.PE3·<E3657L�>7DFÔu36<»I Ì�� Ú ô Ö Ò%3�Í7PE@?< PM8;5 ÔM363: D4Ò%ÎE243Ò%3:vÍ93m<»@b: <?DFæu36>936:vÍ ÓWDF:M<E5¾@CÐÒ'@bÔED42F3�>7@;Ôu@CÍQ5G68C:=<+593Øb3>Q8C2C3ÞWÎu3>7D4Ò'36:vÍ75KD4:pÍ9P=3rð½@bÔM@?ñrJEÎ×­�De<E<?243�ÚZýWDFó63�3:WØWD4>9@b:EÒ%3:vÍç\émò�ëKP=8b5.ÔM363:�ÎM36>�ÐÑ@b>9Ò%3m< ÕNO: @bJE>½DFÒ%ÎE243Ò%36:bÍQ8�Í7DF@b: Í7PE3pÐÑJE:=L�Í9D4@;:®§Bã,©Mã 7 ä 9 ìrã 7 ä 9 í¾îIí6ärD456à

ö÷ ø�ù M�ú ©Mã 7 ä¾ûcüùþý \Bã,ìrã 7 ä 9 í»îIíä/©Mã 7 ä M�ú ©Mã 7 ä¾½cü°8;:=<À\Bãkì�ã 7 ä 9 í»îÎíä�©uã 7 ä¾ÿ ùü M�ú ©Mã 7 ä¾½cü°8;:=<À\Bãkì�ã 7 ä 9 í»îÎíä�©uã 7 ä�� ùÛ½PE3>73

D ù De5.Í7PE3+DF:vÍ7>9D4:=59D4LpL�@v5Zͽ@;Ð)8%578CÒ%ÎE243aÎu@;D4:vÍ�DF:M5�De<?3+8C:�@;ÔM5ZÍQ8;L�243;ÕD ü D45�Í7PE3+>78b<?D4J=5.@CÐ�Í9PE3�8;JEÏ;Ò%36:bÍ736< @;Ô=5�Í78bL�243;ÕD \Bãkì�ã 7 ä 9 í¯îIíä 3 ìrã 7 ä�������� ��� z� ��AE@;>�PEDFÏbPE3>�Ø�8;2FJ=3�@CÐGìrã 7 ä½Í9PE3�Ø�8;2FJE3±@CÐ�\Bãkì�ã 7 ä 9 íÒîÀí6ä.Ôu36L�@bÒ%365½PED4Ï;P=3>mGM59@%Í9P=8CÍ

Í9PE3�D4:?ï=JE36:=L�3�>73ÏbDF@b:Ü>73659JE2\ÍQ5B5ZÍ7>93Í7LQPE3m<â8;2F@b:EÏåÍ9PE3,8CÞW3m5'@CÐ�Í7PE3�@;ÔM5ZÍQ8;L�24365'Øb324@WLD\ÍZÙØ;36L�Í9@b>6ÕWAE@b>�24@�Û�3>�Ø�8;2FJ=3¼@;лí»îIí�Í9PE3pØ�8C24JE3a@CÐ�Í7PE3¼ÐÑJE:=LgÍ7DF@b:Î\Bã,ìrã 7 ä 9 í¾îIí6ä�Ôu36L@;Ò%365PEDFÏbPE3>mGE59@�Í7P=8�ͽÍ7PE3+D4:?ï=JE36:=L�3�>73ÏbDF@b:0De5½Ï;>7368CÍ936>rÐÑ@b>½Ï;>7368CÍ93>.Ø�8C24JE3m5.@CÐ�Í9PE3+@bÔ=5ZÍQ8;L2F3m5Ø;324@?L�DFÍZÙBÒ%@W<EJE2F3bÕEö.PE3¼ÐÑJE:=LgÍ7DF@b:�P=8;5�Ôu33:�LQPE@v5�36:0Ôu36L8;J=593¼DFͽD45.8'Ø;36>9ÙB59DFÒ%ÎE243aÐÑJE:=LgÚÍ9D4@;:¦Í7P=8�Í.Ï;D4Ø;3m5�J=5.8±>93m8;59@;:=8;ÔE2F3¼5�P=8;ÎM3�ÐÑ@;>rÍ9PE3aD4:?ï=JE36:=L�3a>936Ï;D4@;:¬ã�5�D4Ò%DF2e8C>rÍ9@±Í9PE3a@;:=3>936ÎE>93m5�36:vÍ936<åD4:åîMÏ;JE>73%ùvägÕµö.PE3¦Ø�8C24JE3%@CÐ�Í9PE30Î=8C>Q8CÒ%3�Í73>Q5aP=8�Ø;3%Ôu33:·Í7JE:E36<·ÐÑ@b>+Í9P=35�Îu36LD\îML+8;ÎEÎE24D4L68�Í7DF@b:KÕ

� ¶���� �KÆ=Ë��Y�µÄ�Å��#��Ä�È������vÉ��OÅ��NO:%Í9PEDe5r5936L�Í9D4@;:%Û�3�ÎE>736593:vÍ�5�@bÒ%3�3�Þ?Îu3>7DFÒ%3:vÍQ5�ÒB8;<?3�D4:¦@b>7<?36>)Í9@±59PE@�ÛâÍ9PE3¼DFÒ%ÎE>7@�Ø;3ÚÒ'36:vÍ'D4:ÜÍ7PE3�ÎM36>�ÐÑ@b>9ÒB8;:=L�3 @CÐ�Í7PE3¾I Ì�� Ú ô Ö Ò%3Í9PE@?< Õ�ö.PE3¾3�Þ?Îu3>7DFÒ%36:bÍQ8C2.3:WØWD4>9@b:?ÚÒ'36:vÍaP=8b5�Ôu336:�Í9P=3'ð½@bÔM@?ñrJEÎ�­,D4<E<E2F3ÚOýWD4ó3±î=32e<,D4:=5�Í78;2F2436<�D4:¬@bJE>�2e8CÔu@;>Q8�Í7@;>7Ù;G=Í9P=8CÍD45¼5�24DFÏbPvÍ924Ù >736<?JML�36<¾Û½DFÍ9P,>73659Îu36LgÍ�Í9@0LJE>9>73:vÍ�>7JE243656Õ=AE@b>�Í9P=3�DFÒ%ÎE243Ò%36:bÍQ8�Í7DF@b:,@CÐ)Í9P=3Ò'3Í9PE@?<%Û�3½P=8�Ø;3.J=5936<B578CÒ%ÎE24D4:EÏ+>78CÍ93½@;Ð�émü;üaÒ%Ò¾Õvö.PE3�ÒB8CD4:%>9@bÔM@;Í�5�36:=59@;>�De5�8+L�@b2F@b>L8CÒ%36>78¦8;:=<�Í7PE3'3�Þ?ÎM36>9D4Ò%3:vÍ75¼P=8�Øb3�ÔM363:åÎM36>�ÐÑ@b>9Ò%36<¬@;:¬<ED\æ×3>73:vÍpÓvD4:=<E5¼@CÐr>9@bÔM@;Í756GÛ½D\Í7P�<ED\æ×3>73:vͽÓWDF:E36ÒB8�Í9DeL5pã�JE:EDeL�Ù?L�243�Új2FD4Ó;3+8;:=<0P=@;24@;:E@bÒ'@bJ=5r@;:E3m57ä�ÕEö.PE3pÒ'3Í9PE@?<¾P=8b58C2e5�@%Ôu33:�J=5936< ÔWÙBÍ9P=3±ý Ì�� ð Ò%D4<E<E2F3Új59DFó63pÍ93m8CÒ <?J=>9D4:EÏ%Í9P=3 U 36>9ÒB8;:®�¼Îu3:�ÿCübübÿEÕìå3�P=8�Øb3 Îu3>9ÐÑ@;>7Ò%36<ÜÍZÛr@¶ÓWD4:=<E5%@CÐp3�Þ?Îu3>7DFÒ%36:bÍQ5à)Í7PE3�î=>Q5ZÍB@b:E3�D45%ÔM8;5936<â@;: 8

5�D4Ò±JE2e8�Í7DF@b:¬36:vØWD4>9@b:EÒ%3:vÍ6G×D4:åÛ½P=D4LQPåÛr3'P=8�Ø;3%L�@b2F2436L�Í93m<¬8¾5�3Íp@;Ð�ívJ=8;:bÍ7D\ÍQ8�Í7DFØb3�<E8CÍ78��Í9PE3+5936L�@b:=<BÓWD4:=<0@;Ð�3�Þ?Îu3>7DFÒ%36:bÍQ5�P=8;5�Ôu33:¾<?@;:=3¼@b:0>7368C2×>7@;Ôu@CÍQ5GW5�J=Ô=5ZÍQ8C:vÍ9De8C2424Ù¦L�@;:EÚî=>9Ò%D4:EÏ'Í9PE3+Ôu3PM8�ØvD4@;>Q5�@;Ô?ÍQ8CD4:E36<¾D4:¾59D4Ò±JE2e8�Í7DF@b:KÕ

Page 8: Planning trajectories in dynamic environments using a gradient

NO:�Í9P=3.59D4Ò±JE2e8�Í7DF@b:�36:vØWD4>9@b:EÒ%3:v͵Û�3�Ò%8b<?3�Í9PE3½8b5959JEÒ%Î?Í9D4@;:±Í9P=8CÍ)Í9PE3.>7@;Ôu@CÍ75�ÓW:E@�ÛDF:¶3Øb3>7Ù�DF:M5ZÍQ8C:vÍ+Í9PE3¦LJE>7>936:bÍ+Îu@b59D\Í7DF@b:=5+8C:M<,Í7PE3BØ;362F@?L�DFÍZÙ,Øb36LgÍ7@;>p@CÐ�Í9P=3B@;Ô=5�Í78bL�243656GDF:·Í9P=3¦3�Þ?Îu3>7DFÒ%3:vÍQ5+Û½D\Í7P¶>93m8C2�>7@;Ôu@CÍQ5aÍ9PE@v5�3BD4:?ÐÑ@;>7ÒB8�Í7DF@b:åP=8�Øb3%ÔM363:¹3�ÞWÍ7>78bLgÍ93m<¬ÔWÙ5�@;иÍZÛ�8;>93aØWD459DF@b: Ò%@?<?JE24365½ÐÑ>9@bÒ DFÒB8;Ï;365.8bLívJED4>93m<0ÔWÙBÍ7PE3�L�@b2F@b>.L68CÒ%3>Q8EÕ wð È !�"ó�Â$#mÅkò+Â<Ä:Æ�õAô&%ÚÂ�Æ�Æ�Å,Ä�'AµD4Ï;J=>93m5aê�8;:=<#�¦ÎE>736593:vÍ�8¦ÍZÙWÎEDeL8;2�5�DFÍ9JM8�Í9D4@;:å@?LL�J=>9>736<¬DF:¹8C242�Í9PE3B3Þ?ÎM36>9D4Ò%3:vÍ75aÛ�3P=8�Ø;3�ÎM36>�ÐÑ@b>9Ò%36<KÕuö.PE3%>7@;Ôu@CÍp5�PE@bJE2e<,>7368;LQP,8 Ï;@v8C2�ÎM@bDF:vÍmGuÛ½P=DF243'8 Ò%@�ØWDF:EÏ @;Ô=5�Í78bL�243L�>7@b575�3m5BÍ9P=3¬ÎE2e8C:E:=36<õÍ7>78CøZ36L�Í9@;>7Ù;ÕrNO: A�DFÏbJE>73åê¹Í7PE3·>9@bÔM@;Í J=593650Í9PE3·I Ì � Ò%3�Í7PE@?<Í9@�ÎE2e8C:åÍ9PE3%Í7>78CøZ36L�Í9@;>7D4365aÛ½PED42F3BD4:¹AµD4Ï;J=>93K�¦Í9PE3¦I Ì�� Ú ô Ö @;:E3bÕKö.PE3BÔE2e8;LQÓ,<?@;Í75+D4:Í9PE3pî=ÏbJE>7365.>73ÎE>736593:vÍ�598;Ò%ÎE2F3pÎu@;D4:vÍ75½D4:?ï=JE36:=L�3m<¾ÔvÙ0Í9PE3+Ò%@�ØWD4:EÏ%@;Ô=5�Í78bL�243;GWÍ9P=3+2FD4:E3655ZÍQ8C>9Í9D4:EÏ�ÐÑ>7@;Ò�Í9PE3¾>9@bÔM@;ͱ>73ÎE>736593:vÍ+Í9P=30ÎE2e8C:E:=36<¶Í7>78CøZ36LgÍ7@;>7Ùå8CͱÍ9PM8�Í�D4:=5�Í78;:bÍmÕ�ö.P=3Í9>Q8�øZ36L�Í9@b>9Ù,Î=248;:E:E36<·D4:¹AµD4Ï;J=>93I� J=59D4:EÏ�Í9PE3¦I Ì�� Ú ô Ö Ò%3�Í9P=@W<¶De5+Ôu3�Í9Í93>�Í9P=8;:¶Í9P=8CÍÎE248;:E:E3m< D4:�A�DFÏbJE>93+ê%8;5�Í7PE3pÐÑ@;2424@�Û½DF:EÏ'3�Þ?Îu3>7DFÒ%36:bÍQ5½5�P=@�Û+Õ

¢�£>¤ ¥)(=¥ tM­�®â[+]7YZ§v_C` ¢�£>¤ ¥+*E¥ tu­K®r¯�R½¿,[+]7YZ§v_C` wð-, !�"ó�Â$#mÅkò+Â<Ä:Æ.%0/.Å*Æ.1Põ2%ÚÅkò232ô,õ&Æ�Ç4#NO:BÍ9PEDe5�593�Í�@CР3�Þ?Îu3>7DFÒ%36:bÍQ5�Í7PE3�>7@;Ôu@CÍ�P=8b5�Í7@±>7368;LQPB8+Î=>93m<?3�î=:=36<B593�Í�@;Ð�LQPE36LQÓ�ÎM@bDF:vÍ75DF:,5936ívJE36:=L�3bG=Û½PED42F3�8¦5�D4Ò±J=248CÍ936<¾@bÔ=5ZÍQ8;L2F3+ÐÑ@b2F24@�Û�5.Í7>78CøZ36LgÍ7@;>7DF3m5�Í9P=8CÍ�D4:bÍ73>Q5�3mLgÍ�ÒB8;:vÙÍ9D4Ò'3m5�Í9PE3½5�Í78;:=<E8C>Q<+Î=8CÍ9P'@CÐMÍ9PE3.>7@;Ôu@CÍ6Õ�1�:'3�ÞE8;Ò'Î=2F3.@CÐu5�J=LQP�3�Þ?Îu3>7DFÒ%3:vÍQ5)D45�Ï;D4Ø;36:±D4:AµD4Ï;J=>93�ú=GCDF:%Û½PEDeLQP'Í9PE3�>9@bÔM@;Í)PM8;5)Í7@+>93m8;LQP'D\Í73>Q8�Í9D4Ø;362FÙ�Í9PE3�LQP=36LQÓ�Îu@;D4:vÍ75�PED4Ï;P=2FD4Ï;PvÍ93m<Û½D\Í7P�LDF>QL�243656G?Û½PED42F3�8'Ò%@�ØWDF:=Ï'@bÔ=5�Í78;L2F3aÒ%@�Ø;3m5�8;2F@b:EÏ'Í9PE3+Ôu@;2e<¾Î=8�Í7PKÕö.PED45µÓWDF:M<�@CÐE3Þ?ÎM36>9D4Ò%3:vÍ75�P=8�Øb3�ÔM363:�ÎM36>�ÐÑ@b>9Ò%36<�ÔvÙpÒ%368b5�J=>9D4:EÏ�Í7PE3.8�Ø;3>Q8CÏb3�Í9D4Ò'3

:E33m<?36<pÐÑ@b>�Í7PE3�>7@;Ôu@C͵Í9@¼>93m8;LQPpÍ9P=3�:E3ÞvÍ�ÎM@bDF:vÍ)DF:�Í9PE3�5�3míbJ=3:=L3;G�L�@;:M5�De<?3>7D4:EÏ�<?DFæu36>936:vÍØ;324@?L�DFÍ9D4365�ÐÑ@;>¼Í9PE3�>9@bÔM@;Ía8C:M<�Í9PE3�@;Ô=5�Í78bL�24365¼8C:=<,L@;Ò%Î=8;>9D4:EÏ%Í9P=3'I Ì�� Ò%3Í9PE@?<,8;:=<D\ÍQ5r3ÞWÍ93:M5�D4@;:0I Ì�� Ú ô Ö�Õ?ö.PE3�Í78CÔ=2F3aDF:¾A�DFÏbJE>93aþ�59PE@�Û�5�Í9PE3+8�Ø;36>78;Ï;3�Í9D4Ò%3Bã¸ÐÑ>7@;Ò 8¦é�ûÒ'D4:WJ?Í93m5½3�Þ?3mL�J?Í7DF@b:¾@;еÍ7PE3�3ÞWÎu3>7D4Ò'36:vÍQä�:E3636<?3m<¾Í9@B>7368;LQP Í9P=3+:E3�ÞWͼLQPE3mLQÓ¦Îu@;D4:bÍmGEÐÑ@b><?D\æ×3>73:vͽØ;362F@?LD\Í7DF3m5.@CÐKÍ7PE3+>9@bÔM@;Í.8;:=< @CÐ�Í7PE3p@;Ô=5�Í78bL�243+8C:=< L�@;Ò%Î=8;>9D4:EÏ�Í9PE3pØ�8C24JE3m5.@CÐI Ì�� ã�JEÎEÎu3>�L�362F2e5Qä�Û½DFÍ9P%I Ì � Ú ô ÖßãÑ24@�Û�3>�L�362F2e57ä�ÕCö.PE3.Ø�8C24JE365�D4:±Í7PE3�Í78CÔ=2F3½59PE@�Û�5µÍ9P=8CÍI Ì�� Ú ô ÖâÏ;3:=3>Q8C242FÙ'ÎM36>�ÐÑ@b>9ÒB5�Ôu3�Í�Í73>�Í9PM8C: I Ì�� GW59D4:=L�3aD\ͽDe5�Ï;3:=3>Q8C242FÙB8CÔ=2F3�Í9@B8�Ø;@bD4<L�>7D\Í7D4L68C2K59D\Í7J=8�Í7DF@b:=5.DF:�Û½PEDeLQP¾Í9PE3+>7@;Ôu@CÍ�Í9>Q8�øZ3mLgÍ7@;>7ÙBDF:vÍ936>75936L�Í75�Í7PE3+@;Ô=5�Í78bL�243pÎ=8�Í7PKÕ

Page 9: Planning trajectories in dynamic environments using a gradient

¢�£>¤ ¥65=¥ h;SU[a´bzFV�YZSU_m^']9©bT?]9XZS\[+]7^CY�VzEiO]7YOYZSU^vª

1000 mm/sec

2000 mm/sec

Vel Max

800 mm/sec 1600 mm/sec

Robot RobotVel Max

Vel Max

Vel Max

5.9 sec6.3 sec

5.8 sec

Obst.

Obst.

6.3 sec

6.5 sec 6.2 sec

5.9 sec

5.6 sec

¢�£>¤ ¥.7=¥ h;SU[a´bz\VYZSU_m^�]7©;T?]7XZSU[+]Q^�Y�V6z?XZ]QiO´vznYZi wð�ï !�"ó�Â$#mÅkò+Â<Ä:Æ.%0/.Å*Æ.18#mÂ<õ�ô�#mÇ:9 ÇAÆ+%ö.PE3�5�3mL�@b:=< 593�ͽ@;Ð�3ÞWÎu3>7D4Ò'36:vÍ75.P=8b5.ÔM363:�<?@;:=3+@;:¾>93m8C2 >7@;Ôu@CÍ75�ÔWÙ L@;:=59De<?3>7DF:=ϱÍZÛ�@>9@bÔM@;Í75aÍ9PM8�Í6G D4:¶@;>Q<?3>aÍ7@¾>7368bLQP¬ÍZÛ�@�<?D\æ×3>73:vÍ+ÍQ8C>7Ï;3�ÍpÎu@b59D\Í7DF@b:=5G Ò�J=5�Í�ÎE248;:¬Í7>78CøZ36L�ÚÍ9@;>7D4365rÍ9P=8CÍ�DF:vÍ73>Q5�3mLgÍ.368;LQP¾@CÍ7PE3>mÕ?1�2e5�@%D4:0Í7PEDe5�L8b5�3aÛr3pP=8�Øb3¼36Ø�8C24J=8�Í736<BÍ7PE3�8�Ø;36>78;Ï;3Í9D4Ò'3�ÐÑ@b>B>93m8;LQPED4:EϬÍ9PE3�ÍZÛ�@¬ÍQ8C>7Ï;3Í%Îu@;D4:vÍ75B8;:=<ÜÛ�3�P=8�Ø;3¾@;ÔEÍ78CD4:E3m<Ü>73659JE2FÍ75B59DFÒ%D4248;>Í9@¦Í7PE3'@;:E3m5�ÎE>736593:vÍ736<�D4:,Í7PE3�Î=>936ØvD4@;JM5¼5936L�Í9D4@;:KGuDF:åÛ½PEDeLQP�Í9PE3%I Ì � Ú ô Ö 8C24Ï;@b>9DFÍ9PEÒÏ;3:=3>Q8C242FÙBÎu3>9ÐÑ@;>7ÒB5.ÔM3Í�Í936>6ÕNO:�Ð�8;LgÍa8%ÍZÙWÎED4L68C2�5�DFÍ9J=8CÍ9D4@;:,8;>9De5�D4:EÏ%D4:�Í9PEDe5�3Þ?ÎM36>9D4Ò%3:vÍ78;2µ593�Í�Í7DF:=ϦD45�>936ÎM@b>�Í736<�D4:

AµD4Ï;J=>93m5 émü¬8;:=<»ébé;G�Í9P=8CÍB>936ÎE>93m5�36:vͱÍ9P=3�8bLgÍ7J=8C2�Í9>Q8�øZ3mLgÍ7@;>7DF3m5+ÐÑ@;2424@�Ûr3m<ÝÔWÙ¶Í9PE3¾ÍZÛ�@>9@bÔM@;Í756G;Û½PE@v5�3�D4:EDFÍ9De8C2uÎM@v5�DFÍ9D4@;:M5�; � 8C:=<<; J 8;>93�59PE@�Û½:BD4:BÍ9P=3�243�иͽ5�De<?3�@;РÍ9PE3�î=Ï;J=>93m58C:=<0Í9PE3pÍQ8C>7Ï;3Í.Îu@;D4:vÍ75>= � 8;:=<�= J 8C>73aD4:¾Í9PE3+>7D4Ï;PvÍ�5�De<?3;ÕNO: Í7PE3pî=>Q5ZÍ�L68;593aÔu@CÍ7P¾Í9PE3�>7@;Ôu@CÍQ5.J=593¼Í7PE3�I Ì � Ò%3�Í9P=@W<KG=8C:=< Í7PE3D4>�Ôu3P=8�ØWD4@;>.D45:E@CÍa@;Î?Í7DFÒB8C2�5�D4:=L3±@;:=3�>9@bÔM@;Í�ãÑ>7@;Ôu@CÍ'émä½8;2FÛ.8�Ù?5.Í9>7D4365�Í9@¦Î=8b595�DF:,ÐÑ>9@b:bÍa@CÐ)Í9P=3�@;Í9PE36>@;:E3bÕvö.PE3a5�3mL�@b:=<¦L8b5�3bGbD4:¦Û½PEDeLQP0Ôu@CÍ7PBÍ9P=3¼>7@;Ôu@CÍQ5�J=593�Í7PE3pI Ì�� Ú ô Ö¹Ò%3�Í7PE@?< G?5�P=@�Û�5DF:=5�Í93m8;<¬Í9P=8CÍ+Í9PE3¦8b<E<?DFÍ9D4@;:=8;2�DF:EÐÑ@;>7Ò%8CÍ9D4@;:·8CÔu@;J?Í+Í7PE3%@;Ô=5�Í78bL�243%<EÙv:M8CÒ%D4L65pP=8;5pÔu336:ÎE>9@bÎM36>924Ù,3ÞWÎ=2F@bD\Í736<·DF:¶Í7PE30I Ì�� Ú ô Ö Ò%3Í9PE@?<·ÐÑ@;>±ÎE248;:E:ED4:EÏ,8�Ôu3�Í�Í73>+Í7>78CøZ36L�Í9@;>7Ù,D4:ÎE>93m5�36:=L�3 @CÐaÒ'@�ØWD4:EϬ@bÔ=5�Í78;L2F3m5Õ � @;Í9DeL�3�8C2e5�@åÍ9PM8�Í%DF: 8C:WÙ¹L8b5�3 Í9PE3 Í9>Q8�øZ3mLgÍ7@;>7DF3m5±D4:AµD4Ï;J=>93�ébé�8C>73½:E@CÍ�@;Î?Í7DFÒB8;2�Gv8;5�Í7PE3Ù'Û�@;JE2e<%ÔM3¼D\Ð�8;:WÙ±>7@;Ôu@CÍ�Û�@;JE2e<%ÓW:E@�ÛßDF:08b<?Ø�8C:=L3Í9PE3aÍ9>Q8�øZ3mLgÍ7@;>7Ù'Î=248;:E:E36<0ÔWÙ%Í9PE3p@CÍ7PE3>mÕ?ö.PWJ=5rÍ9PE3p>7@;Ôu@CÍ75�3ÞW3mL�J?Í73a8'59Ò%8;2F2×Îu@;>9Í9D4@;: @CÐÍ9PE36DF>½Î=8CÍ9P¾DF:¾Î=8;>78;2F2432 8;5.D4: Í9PE3pÎE>73ØWD4@;J=5.L8b5�3bÕ&�@�Û�3Ø;36>6GvD4: Í7PEDe5½L8;593;G?8Cͽ8%L3>9Í78CD4:ÎM@bDF:vÍr@b:E3�@;РÍ9PE3¼>9@bÔM@;Í75¼ã�59ÎM3mL�DFîML8;2F24Ù%>9@bÔM@;ͼémä�D45�8CÔ=2F3½Í7@�<?3Í93mLgͽ5�J=LQP¦59DFÍ9J=8CÍ9D4@;:08;:=<<?36LD4<?3m5�Í9@BÎ=8b595.Ôu3P=DF:=< Í7PE3+@CÍ7PE3>½>7@;Ôu@CÍmÕ

? �c�@�/�µÅ&��ÈBA Ç�Æ�C1�Ò%@;:EϬÍ9PE3¾5�36Ø;36>78;2�Í93mLQPE:EDeíbJ=365�ÎE>9@bÎM@v5�3m<¶DF:ÜÍ9PE3 2FDFÍ936>78CÍ9JE>73BÐÑ@b>�Î=8CÍ9PÝÎ=248;:E:ED4:EϬD4:<?ÙW:=8CÒ%DeL�36:WØvD4>7@;:EÒ%3:vÍQ5G×Û�3'PM8�Ø;3'Ò%8;DF:=2FÙ¬L@;Ò%Î=8;>93m<,@;J=>p8;ÎEÎE>7@b8bLQP�Í9@�8CÎ=ÎE>9@v8;LQPE3m5Í9P=8CÍ)PM8�Ø;3�Ôu336:�3Þ?ÎM36>9D4Ò%3:vÍ93m<�D4:±Í7PE3�ð�@;Ôu@WñrJEÎ%<?@;ÒB8;DF:KG�Ôu@CÍ7P±Ôu36L8;J=593rÛ�3�LQP=@v@v5�3�DFÍ

Page 10: Planning trajectories in dynamic environments using a gradient

¢�£>¤ ¥m¥ED=¥ tM­�®â[+]7YZ§v_C` ¢�£?¤ ¥�¥<¥W¥ tM­�®�¯�R.¿¬[+]7YZ§b_C`8;5�@bJE>�Í7365�Í9Ôu36< GW8C:M<%ÔM3mL8CJM5�3�D4:BÍ7PED45�<?@bÒ%8;DF:¦8±5�@b2FJ?Í7DF@b:%Í9@±Í9PE3�Î=>9@bÔE2F36Ò @;ÐK@;Ô=5�Í78bL�2438�Ø;@;De<E8;:=L�3p8C:=< Î=8CÍ9P�ÎE2e8C:E:ED4:EÏB8CÒ%@b:EÏ%Ò'@�ØWD4:EÏ'@;Ô=5�Í78bL�243aDe5.Î=8;>�Í7D4LJE248;>924ÙB:E3636<?3m< Õö.PE3pÛr@b>9Ó0<E3657L�>7DFÔu36< DF:¹ç ú�ëKÎE>736593:vÍQ5½8C:�8CÎEÎ=>9@v8;LQP¦Ô=8b5�3m<¾@;:¾Ò'@?<?DFî=3m< Îu@CÍ73:vÍ9De8C2

î=32e< Õ=ö.PE3+Ò%3Í9PE@?<¾ÐÑ@?L�J=59365�@;: Í9PE3�Ïb3:E36>78CÍ9D4@;: @CÐ)2F@�Û 2F36Ø;32µL�@;Ò%ÒB8C:M<E5�Í9P=8CÍ�3:=8;ÔE243Í9PE3'>9@bÔM@;Í�Í9@�<?>7DFÔ=ÔE2F3±Í9PE3'Ô=8;2F2)8CÒ%@;:=Ïb5�Í�Ò%@�ØvD4:EÏ @;Ô=5�Í78bL�243;G=Ô=J?Íp<E@0:E@;Íp8b<E<?>736575½Í9P=3ÎE>9@bÔE243Ò @Cм2F@?L8;2.Ò'D4:ED4ÒB8EG)Í9PM8�ÍBD45'Øb3>7Ù·D4Ò%ÎM@b>�ÍQ8C:vÍ%DF: 8åL>9@�Û�<E36<Ý<?ÙW:=8;Ò%D4L¾3:WØWDFÚ>9@b:EÒ%3:vÍ6GE24D4Ó;3±ð½@bÔM@?ñrJEÎ,59@WL6L�36>��?Û½PE36>93±@CиÍ936:,5�36Ø;36>78;2 >9@bÔM@;Í75�8;>93�L2F@v5�3pÍ7@BÍ9PE3±Ô=8C242�Õ�¼JE>a8;ÎEÎE>7@b8bLQP,@;:�Í7PE3%@CÍ7PE3>aP=8C:M< GK8;5a8C24>93m8;<?Ù�Îu@;D4:vÍ936<¬@;J?ÍmG×Ï;3:=3>Q8�Í93m5�:M8�ØvD4Ïb8CÍ9D4@;:ÐÑJE:=LgÍ7DF@b:=5.Í7P=8�Í�<?@W3m5.:E@CÍ�L@;:vÍ78;DF:=5�24@?L8C2 Ò%D4:ED4Ò%8=Õö.PE3±ÎE>7@;Ô=2F36Ò @;Ð�2F@?L68C2�Ò'D4:ED4ÒB8¦De5¼D4:=5�Í93m8;<,8b<E<?>736575�3m<�DF:Üç ùCëjÕ×Û½PE3>73+Í7PE3'8;J?Í9P=@;>Q5

ÎE>9@bÎM@v5�3¾8,Ò%3�Í7PE@?<ÜÔM8;5936<¹@b:â8¬L@;Ò�ÔEDF:M8�Í9D4@;:Ü@CÐ�>Q8C:=<E@;Ò#3�Þ?ÎE24@;>Q8�Í7DF@b:Ü8C:=<ÝÔED48b5�3m<Ò'@;Í9D4@;:'Í9@�Û.8C>Q<E5�Í7PE3�Ï;@v8C2EL@;:?î=ÏbJE>Q8�Í9D4@;:�ÕCö.PED45�Ò%3�Í9P=@W<B<E@+:E@CÍr59@;24Ø;3½L@;Ò%ÎE243�Í9362FÙ�Í9P=3ÎE>9@bÔE243Ò @;Ð�24@?L8C2 Ò%D4:ED4Ò%8=GEÔEJ?Í�>736<EJ=L�3m5�Í9PE36DF>½@?LLJE>7>936:=L�3bÕ1 <?DFæu36>936:bÍ'8CÎEÎE>7@b8bLQPåDe5+ÎE>736593:vÍ736<¶D4:»ç û�ëHG Í7PEDe5�Û�@;>7Ó¬De5pÐÑ@?L�J=5936<¶@b:Ý8C:¶PWÙvÔ=>9De<

Î=8�Í7P ÎE2e8C:=:EDF:=Ï'Ò%3Í9PE@?< Í9P=8CÍ�LQPE@W@b593�Í7PE3+ÔM3m5ZͽÎ=8CÍ9P�ÎE2e8C:E:=DF:EÏB8;2FÏb@;>7D\Í7PEÒ <?3Îu3:M<?DF:=Ï@;:�Í9P=3�59ÎM3mL�DFîML�59D\Í7J=8�Í7DF@b:KÕ×ý?DFÒ�JE248CÍ9D4@;:�3ÞWÎu3>7D4Ò'36:vÍ75�59PE@�Û Í9P=8CÍ�Í7PE3±PWÙWÔE>7D4<¾Ò%3�Í7PE@?<@;J?Í7ÎM36>�ÐÑ@b>9Ò 8;2F2×Í7PE3+5�D4Ò%ÎE2F3+Ò%3Í9PE@?<E56G?ÔEJ?ͽ:E@%Ï;JM8C>Q8C:vÍ9363�De5.Ï;D4Ø;3: @;: Í9PE3p@bÎ?Í9D4ÒB8C24D\ÍZÙ@CÐ�Í9PE3�LQPE@v5�36:¦Í7>78CøZ36LgÍ7@;>7Ù;ÕAµD4:=8;2F24Ù;Gvç\éëvÎE>736593:vÍQ5�8C:�8;<E8;Î?Í9D4Ø;3�Î=248;:E:E3>mGÔM8;5936<p@;:�8�5ZÍQ8�Í7D4L�ÎE248;:E:E36>rã�<E3Ø;362F@bÎM3m<

DF:�ç ÿ�ëÑägG�Í7P=8�Í�Í7>9D4365�Í7@�5�24DFÏbPvÍ924Ù±LQP=8C:=Ï;3�Í9PE3½Î=248;:'Û½P=DF243.Í9PE3½36:WØvD4>7@;:EÒ%3:vÍ�L�@b:?î=ÏbJE>78CÍ9D4@;:3Ø;@b2FØb3656Õ�ö.PE3½3�Þ?Îu3>7DFÒ%3:vÍQ5)>936ÎM@b>�Í736<'5�PE@�ÛâÏ;@W@?<±>73659JE2FÍ75�ÐÑ@b>)Í9PEDe5�8CÎ=ÎE>9@v8;LQP���PE@�Û�3Øb3>mGÍ9PE3·Í9D4Ò%3å>736ívJED4>736< ÐÑ@b> Í7PE3åÍ9>Q8�øZ36L�Í9@b>9Ù Ï;36:E3>Q8�Í7DF@b:õD45¾:E@;Í�L@;:=5�Í78;:v;۽DFÍ9P >93m5�Îu36L�ÍÍ9@Ý@bÔ=5ZÍQ8;L2F3¬L@;:?îMÏ;JE>Q8�Í7DF@b:KG�8C:=<»DF:õÎ=8;>�Í7D4LJE2e8C>¦Ôu36L@;Ò%365 íbJ=D\Í73¬PED4Ï;PõD4:õÎ=8C>9Í9DeL�J=248;>5�DFÍ9J=8CÍ9D4@;:=5+ã�3;Õ Ï=ÕEÛ½P=3: Í9PE3�8b<E8CÎ?ÍQ8�Í7DF@b: @;еÍ7PE3+ÎE2e8C:E:E3m<¦Í7>78CøZ36L�Í9@;>7Ù%Ð�8CD42e57ä�ÕìõD\Í7P�>93m5�Îu36L�Í�Í7@¦8C242 Í9P=3±<?De59LJ=595936<¾8CÎ=ÎE>9@v8;LQPE3m5rÍ9PE3�Î=>93m5�36:bͽÛ�@;>7Ó¦De5�8':E@�Ø;362K8�Í�Ú

Í93Ò%Î?Í'Í9@å3�Þ?ÎE24@;DFÍ�Í9P=3 @bÔ=5ZÍQ8;L2F3m5�<?ÙW:=8CÒ%DeL¦D4:?ÐÑ3>7>736<¶ÐÑ>7@;Ò�Í9PE3¾3:WØWD4>9@b:EÒ%3:vͱ<?JE>7DF:=ÏÍ9PE3pÍQ8;59Ó¦3�Þ?36LJ?Í9D4@;:�Õ?NO: Ð�8bLgÍmGWÍ9PE3�I Ì�� Ò%3�Í9P=@W<¾De5.Ï;J=8;>78;:vÍ933m<BÍ7@'Î=248;:¾@bÎ?Í9D4ÒB8C2×Í7>78CÚøZ36LgÍ7@;>7DF3m5�Û½DFÍ9PB24@�ÛâL�@bÒ%ÎEJ?Í78CÍ9D4@;:=8;2?Í9D4Ò%3�>736ívJED4>936Ò'36:vÍ75)D4:B>93m8C2FÚ�Í7DFÒ%3½8C:=<%ÔWÙ'8�Ø;@;De<?D4:EÏ2F@?L8;2=Ò%D4:EDFÒB8=Õ&�¼JE>.I Ì � Ú ô ÖÝ3�ÞWÍ936:=5�D4@;:BÒB8;DF:vÍ78;DF:M5�8C242MÍ9PE3a8CÔu@�Ø;3�8b<?Ø�8C:vÍ78;Ï;365�@CРÍ9P=3I Ì�� Ò%3Í9PE@?<¹ãÑD4:=L2FJ=<EDF:EÏ02F@�Û L�@bÒ'Î=J?Í78CÍ9D4@;:=8;2 Í9D4Ò%3mägGMÔEJ?ÍaÎM36>�ÐÑ@b>9ÒB5.Ò±JMLQP�ÔM3Í�Í936>�D4:PEDFÏbPE24Ù0<?ÙW:=8CÒ%DeL+5�DFÍ9JM8�Í9D4@;:M5Õö.PE3+Ï;36:E3>Q8C2K8;ÎEÎE>7@b8;LQP @CÐ�D4:bÍ73Ïb>78CÍ9D4:EÏ'Í9PE3+@bÔ=5ZÍQ8;L2F3m5½<?ÙW:=8CÒ%DeL+DF:EÐÑ@;>7Ò%8CÍ9D4@;:¾DF:vÍ7@

Í9PE3'Î=8�Í7P,ÎE2e8C:E:=DF:EÏ ÎE>7@WL36<?J=>93bGMLQP=8;:EÏ;D4:EÏBÍ7PE3±@bÔ=5ZÍQ8;L2F3±L@;:?îMÏ;JE>Q8�Í7DF@b:=5�8bLL�@b>7<EDF:EÏb2FÙbG

Page 11: Planning trajectories in dynamic environments using a gradient

L�@;J=24<�ÔM3½8;2459@�3ÞvÍ73:=<E36<±Í9@p@CÍ7PE3>)Î=8CÍ9P'ÎE248;:E:ED4:EÏaÒ'3Í9PE@?<E5��C8;5)8;:�3Þ?8;Ò%ÎE2F3.8a5�JEDFÍ78;ÔE243Ò'3Í9PE@?<·ÐÑ@b>�8C:¶3�æ×36L�Í9D4Ø;3B3�ÞWÍ73:=59DF@b:åÔM8;5936<·@;:·Í9P=D45�8;ÎEÎE>7@b8bLQP¬De5pÍ9PE30@;:E3B<?3m59L>9D4ÔM3m<DF: ç��mëjÕ�NO:õÍ9PEDe5¾Ûr@b>9ÓâP=8C>7Ò%@;:EDeL�ÐÑJE:MLgÍ9D4@;:M5¾8;>93¬J=5�3m<õD4:»@;>Q<?3>0Í9@ßL�@;Ò%ÎEJEÍ93å8¹ÐÑ>9363Î=8�Í7P0ÐÑ@b>�8�>7@;Ôu@CÍmG?J=59DF:EÏB8'Îu@CÍ936:vÍ9De8C2×î=3624<�8CÎ=ÎE>9@v8;LQPKÕWö.PE@v5�3aÐÑJE:=L�Í9D4@;:=5�L�@;:vÍQ8CD4:0Ø;36>9ÙDF:vÍ936>93m5ZÍ7DF:=ϦÎE>7@;Îu3>9Í9D43656G=5�JMLQP,8;5�L@;Ò%ÎE243�Í936:E36575�D4:�Í7PE3�Î=8CÍ9P¬L68C2eL�JE2e8�Í7DF@b:KGE>7@;ÔEJ=5�Í9:=36575Í9@BJE:=8;:vÍ9DeL�D4Î=8�Í736< @;Ô=5�Í78bL�24365.8C:=<¾>Q8CÎEDe<¾L�@;Ò%ÎEJEÍ78�Í7DF@b:KÕ

F GåÇrÄ�Ê���É��WËZÇ�Ä��NO:¹Í9PEDe5%8C>9Í9DeL�2430Û�3¦P=8�Øb30ÎE>736593:vÍ93m<¹8C:Ü8;ÎEÎE>7@b8bLQPåÍ7@·L@;Îu30Û½DFÍ9PÜ<EÙv:M8CÒ%D4L 3:WØWD4>9@b:?ÚÒ'36:vÍ75B3ÞvÍ73:=<EDF:EÏÝ8¶Øb3>7ÙÝ3�á¦LDF36:bͦÒ%3Í9PE@?<âÐÑ@;>¦ÎM8�Í9P ÎE2e8C:=:EDF:=ϹÎE>93m5�36:vÍ936<âD4: ç\é6ùCëjÕö.PED45�Ò%3�Í7PE@?<ÝP=8b5�Ôu33:ßLQPE@b593:¹Ôu36L68CJ=5930DFÍ�De5'8CÎEÎE>7@;Î=>9De8�Í736<·ÐÑ@;>�@;JE>�Í93m5ZÍ7DF:=Ϭ3:WØWDFÚ>9@b:EÒ%3:vÍ�ã�ð½@bÔM@?ñrJEÎMägÕEö.P=3aÔM8;59D4LaDe<?368'@CеÍ9PE3+I Ì�� Ú ô Öâ>7324D4365�@;: Í9PE3pD4:vÍ93Ïb>78CÍ9D4@;: @CÐÍ9PE3%D4:?ÐÑ@;>7ÒB8�Í9D4@;:·8CÔu@;J?ÍpÍ7PE3%Ø;324@?L�DFÍZÙ�@CÐ�Ò'@�ØWD4:EϾ@;Ô=5�Í78bL�24365aDF:vÍ7@0Í7PE3%Î=8�Í7PåÎE2e8C:=:EDF:=Ï8C24Ï;@;>7DFÍ9PEÒ�Õ�NO: Î=8C>9Í9DeL�J=248;>6G�D4: Í9PE3�Î=>93m5�36:bͦD4Ò%ÎE243Ò%3:vÍ78CÍ9D4@;:KG�Í9PE3¬<EÙv:M8CÒ%D4L65%@CÐpÍ9P=3@;Ô=5�Í78bL�24365rP=8�Ø;3¼ÔM363:0D4:vÍ936Ï;>Q8�Í93m<¦D4:¦Í7PE3aI Ì�� Ò%3�Í9P=@W<KG?Ò'@?<?DFÐÑÙWDF:=ϱÍ7PE3+L�@b5�Í�ÐÑJ=:=LgÍ7DF@b:J=5�3m<�ÐÑ@;>�L@;Ò%ÎEJ?Í7DF:EÏ�Í9PE3½Ïb2F@bÔ=8C2E:M8�ØvD4Ïb8CÍ9D4@;:±ÐÑJE:=LgÍ7DF@b:KÕb1�2\Í7PE@;J=Ï;P%Í9P=D45�3ÞWÍ93:M5�D4@;:B<?@W365:E@CͽÏ;JM8C>Q8C:vÍ9363�@;ÎEÍ9D4Ò%8;2×Í9>Q8�øZ3mLgÍ9@b>9D4365.8;2F@b:EÏ�Í7PE3pÍ9D4Ò%3p<EDFÒ%3:M5�D4@;:KGWÍ7PE3+Îu3>9ÐÑ@;>7Ò'3m<03ÞWÚÎM36>9D4Ò%3:vÍ75'5�P=@�Û Í7P=8�Í�Í9PE3�I Ì � Ú ô Ö Ò'3Í9PE@?<¹Îu3>9ÐÑ@;>7Ò%36<¹Ôu3�Í9Í936>±Í7P=8C:ÜI Ì�� GµÛ½PE36:Ð�8;L�D4:EÏ'Ð�8;5�Í�Ò%@�ØWDF:EÏ'@;ÔM5ZÍQ8;L�243656G?Ó;363ÎED4:EÏ'Í9P=3�598;Ò'3+L@;Ò%ÎEJ?ÍQ8�Í9D4@;:M8C2 >736ívJED4>936Ò'36:vÍ6Õö.PE3�I Ì � Ò%3�Í7PE@?<¦8C:=<BÍ9PE3¼3�ÞWÍ936:=5�D4@;:BPM8�Ø;3½Ôu33:0DFÒ%ÎE243Ò%3:vÍ736<B@b:B>9@bÔM@;Í9DeL½ÎE2e8�Í�Ú

ÐÑ@;>7Ò%5±Û½D\Í7PÝ<?DFæu36>936:bÍ'ÓWDF:E36ÒB8�Í9DeLBÒ%@?<?32e50ã�JE:EDeL�Ù?L�243�Új24DFÓb3¦8C:=<¶PE@b2F@b:E@;Ò%@bJ=57ä�Õ�1�5±Í9P=3ÎE>93m5�36:vÍ�Ûr@b>9Ó�De5pÐÑ@?L�J=5936<·@b:åÍ7PE3¦Ïb3:E36>78CÍ9D4@;:¬@;Ð�3æu3mLgÍ7DFØb3%Í9>Q8�øZ36L�Í9@b>9D4365aÐÑ@b>�<?ÙW:=8CÒ%DeL3:WØWDF>7@;:EÒ%36:bÍQ5GMÛr3%<?De<,:E@;ͼD4:WØ;365�Í9D4Ïb8CÍ93+Í7PE3'D4575�J=365¼>936248CÍ936<�Í9@¦Í7PE3'2F@�Û 243Øb32)L�@;:vÍ7>9@b2@CÐ�Í7PE3B>7@;Ôu@CÍ9DeL'ÎE2e8�Í�ÐÑ@b>9Ò�Õ ì·3B>78CÍ9PE36>pÎE>9@�ØWDe<?36<å8�5�D4Ò%ÎE2F3BD4Ò%ÎE243Ò%3:vÍ78CÍ9D4@;:·@Cн8¾2F@�Û2F36Ø;32�>9@bÔM@;ͽL@;:vÍ9>7@;24243>.Í9PM8�Í�Ï;D4Ø;36:0Í7PE3±<?3m5�D4>736< Í9>Q8�øZ3mLgÍ9@b>9Ù¦8;:=< Í9PE3±>9@bÔM@;Í.ÓWD4:E3ÒB8CÍ9DeLÒ'@?<?362�G De5�8;ÔE2F3�Í9@,<E>9D4Ø;3�Í9PE3B>7@;Ôu@CÍ+8C24@;:=Ï0Í7PE3%Í9>Q8�øZ3mLgÍ9@b>9Ù¾ÐÑJE2Fî=242FD4:EÏ�Í7PE3¦8CÎEÎ=2FDeL8CÍ9D4@;:L�@;:M5ZÍ7>78;DF:vÍ756GvÍ9P=8CÍ�DF:¾Í7PE3�ð½@;Ôu@WñrJ=ξL68;593p8;>93pPED4Ï;P�59ÎM3636<�8C:=< >7368;59@;:M8CÔE243¼Î=>93mL�De5�D4@;:KÕö.PE3¦>73Îu@;>9Í936<·3ÞWÎu3>7D4Ò'36:vÍ75±59PE@�Û Í9P=8CÍ�Ôu3�Í9Í93>�>93m5�J=2\ÍQ5±L8;:¹ÔM30@;Ô?ÍQ8CD4:E36<¶ÔWÙ·DF:?Ú

Í93Ïb>78CÍ9D4:EÏ�DF:vÍ7@ Í7PE3¦Î=8CÍ9P·ÎE2e8C:E:ED4:EÏ�Ò%3�Í7PE@?<åÍ9PE3¦D4:?ÐÑ@b>9ÒB8�Í7DF@b:å@b:¬Í7PE3¦@bÔ=5ZÍQ8;L2F3m5a<EÙbÚ:=8CÒ%DeL56GC8C:=<�Í9P=8CÍ�Í9PE3.ÎE>7@;Îu@b5936<±3�ÞWÍ936:=5�D4@;:�DF:%PED4Ï;P=2FÙ�<?ÙW:=8;Ò%D4L�3:WØWD4>9@b:EÒ%3:vÍ75µÍ9J=>9:E3m<@;J?Í�Í7@¦Ôu3�3�æ×36L�Í9D4Ø;3±8;:=<¾D\ÍaP=8;5�8bLgÍ7J=8C242FÙ DFÒ%ÎE>7@�Ø;3m< Í9PE3�Îu3>9ÐÑ@;>7ÒB8C:=L3+@CÐ�Í9PE3�>9@bÔM@;Í9DeLÎE248CÍ�ÐÑ@b>9Ò�Õb1¼5�ÐÑJ?Í7JE>73�Ûr@b>9Ó×G�Û�3�8C>73�L�J=>9>73:vÍ924Ù±D4:WØ;3m5ZÍ7DFÏv8�Í9D4:EÏaÍ9P=3�ÎM@v5959D4ÔEDF24DFÍZÙ�@;Р8;ÎEÎE24ÙvÚDF:EÏ�8±59DFÒ%D4248;>�3�ÞWÍ73:=59DF@b:%ÐÑ@;>�<?368;2FD4:EÏ�Û½DFÍ9P¦Ò%@�ØWD4:EÏ�@;ÔM5ZÍQ8;L�24365�Í9@±@;Í9PE36>�Î=8CÍ9PBÎE2e8C:=:EDF:=ÏÒ'3Í9PE@?<E56Õ

���@HZ��Æ���Ä�Ê:���{m²>I;²KJ)VzUYZ]7i.V6^v`'®¼²ML�SUz\`;XZ]9YZ§M²G)r`vVTbYZSUl�].TvVYZ§%TbzFV^v^b]7X�de_6X�§vSUªm§%`;�;^WV[+S\f�]Q^Cl;SnXZ_6^v[+]Q^�Yg²NPORQSOMT�U6V�WYXRXRXRZ4NPORQSO.[]\KO_^S^a`�bdceO)bgfiheT�U6VdjYk=}ml6~m~6~;²lC²Ò)�².J�SUfQf9§bS¸}�n¼²�Ár²�Á)ViZV6zUSU^v_;}CV6^v`phbV^�YZS\zUzUS¸²W­Kz\V6^b^vSU^vª.iO§b_6XOYZ]QijY�«?_6´v^W`;]g`;¯�fQ´;XZlmV�YZ´bXZ]�TWV�YZ§vid4_6X�V.fQz\V6iOi)_dE^v_6^v§v_6zU_m^v_6[+SUf�lm]Q§vSUfQzU]QiµV6[+_6^vª½_m«bijY�V6fQzU]QiQ²4o]bpO_O_^a`ph.qsr�t.u�Owv&[yx$`zj�{@{�{|jarM[~}T@O)r_v_`�bp`�rK^a`�O.r�NPORQSO.[-q�^gu��.rmh��&UE[�O.���.[-q�O.rb}u{Q�m�R��²

|;²>I;²+Jµ_6XZ]Q^bijYZ]QSU^M²v³)§v]�lm]Qf7YZ_6X��v]Qz\`�§bSUijYZ_mª6X�V[p¯Ñd¸V6ijY�_6«vijY�V6f7z\]�Vgl�_6S\`vV6^bfQ]�d4_6XK[+_m«bSUz\]µXZ_m«?_6YZiQ²NPORQSO.[-q�^gu��.rKh<�&UE[�O.���)[-q�O.r$��j�{@{�{��$bp�)r$u��R^g[-q�O.rMu�O.rv}µy�_mzU´v[+]+��� c�iOiO´v]+��|Y� l.�6�<�Yl�m�C}{Q�m�C{m²

Page 12: Planning trajectories in dynamic environments using a gradient

�b²>I;²RJµXZ´bfQ]�V6^v`  ²6yµ]QzU_6iO_b²Wq�]gVzU¯ÑYZSU[+])X�V6^v`b_6[+S\w7]g`¼TvVYZ§aTbz\V6^v^bSU^vª�d4_6X�XZ_m«?_6Y�^vV�lCSUª�V�YZSU_m^M²c�^djar�o]bpO_^a`S`ph.qsrEt.u�O�v�jpN>��\m��WYXRX)W�}WhC¨�SnYZwQ]9XZzFV^W`E}���f7YZ_6«?]7X�l6~m~+lC²�C²�h?²MJ�´vfa�?}v³�²Wh;f�§v[+SnYOYg};V^W`ª �Jµ]Q]7YZwm²µ­KzFV^v^bS\^bª+V6^v`�]7©;]Qf7´bYZSU^vª�'j_mSU^�Y�^WVglCSUª�VYZSU_6^'Y�V6ip�CiSU^'V6´bYZ_6^v_6[+_m´vi�XZ_6«?_6Y�iO_�fQfQ]7Xg²�c�^djar�NPORQSOMT�U6V�jar$[~}�\M�.��VYO.uSqsUE�a}Wh;]gV�YOYZz\]6}�l6~6~;{6²� ²Ò)�XS�CS\^�q�²KÁr² cH^�YZ]QªX�VYZSU^vª¦«?]Q§vVgl;SU_X�V6z¸} T?]7XZfQ]QT;YZ´WV6z�V^W`�¨)_XZz\`|�C^b_�¨�zU_C`;ªm]'SU^�XZ]gVf7YZSUl�]^vVgl;SUªmVYZSU_m^=²µc�^dNPORQSO.[-q�^gu��.rmh��&UE[�O.rmO.��UEu�\M�.uS[~`���u���}vTvV6ªm]7i�{Q~R���W{6l.lC} {Q�m�m~C²�C²�Ár²uc9² Á�_m^v^b_mzUzn��V^W`�q�²:)�²�nrXZ´vT?]7^M²d��^ YZ§v]�V6TbTvzUSUfgVYZSU_6^¬_d�§WV�XZ[+_m^vSUf+de´b^vf7YZSU_6^vi�YZ_XZ_6«?_6YZSUfQiQ²&�EO.UEbarK�+f�Owv�NPORQSO.[-q�^>\$�)uS[~`���uZ}×{g~q"��Ú%�� �m|C{����.� � }K{g�m�6|;²

�;²>J�²�R½V6[�ViQ}�tK²�Á�´vijYZ_C`;S\_;}�V6^v`¹­×²�tMSU[�V;² ) [+_C`bS �W]g`¶T?_YZ]Q^�YZS\V6z��v]Qz\`bi±[+]7YZ§v_C`åd4_6XXZ_6«?_6Y�^vV�lCSUª�V�YZSU_m^%VTvTbz\SU]g`�YZ_p`CXZS\«b«vzUSU^vª¼S\^�XZ_m«?_YZSUf½iO_�fQfQ]7Xg²Kc�^eo]bpO_^6}�O�v&NPORQSOMT�U6V<WEXRX)W\M�.��VYO.uSqsUE�a}[-v´$�C´b_+�6V;}MI�V6TvV6^=}Kl~m~Rl�²

�;²�­×²2-×SU_6XZSU^vS�V6^v`�¡×²)hC§vSUzUzU]7Xg²� '_6YZSU_m^·Tvz\V6^b^vSU^vª�SU^·`;�;^WV[+S\f�]Q^ClCSUXZ_6^v[+]Q^�YZip´biOSU^vª YZ§b]XZ]7zFV�YZSUl�]�lm]QzU_�fQSnYH��TvVX�Vm`;SUªm[%²¢j�{�{@{£jar$[~}�[email protected]_v_`�bp`�rK^a`�O.r¢NzORQSO.[-q-^gue�.rmh��&UE[�O.���.[-q�O.rb}lm_mz¸²U{+� � � ~��E� � �C}u{Q�m�6|;²

{Q~;²Ò)�²:-b´�'jSU[+_XZSÑ}u­×²u®�²u®rSi�;Snd4_6XZ´$�?}×V6^W`À ² ²�n�´vTbY�VC²ª)r`vVTbYZSUl�]p^vV�lCSUª�V�YZSU_m^�_6d�[+_6«vSUzU]XZ_6«?_6YZi�¨�SnYZ§±_m«bijY�V6fQzU]½Vgl�_6SF`bV6^bfQ]m²�NzORQSO.[-q-^gu>�.rKh��&UE[�O.���.[-q�O.rM��j�{�{@{¤�$bp�.rMu��R^g[-q�O.rMu>O.rv}y�_mzU´b[+]+�?{g|pc�iOiO´v]+�M�M� �6� � � � ~;{m}u{g�m�+�C²

{6{m²½q�²G)�²PI�V�XZlCS\iQ² Á�_mzUzUSUiOSU_m^b¯ÑdFXZ]Q]¾YOX�Vh'j]Qf7YZ_XO�ÝTvz\V6^b^vSU^vª�´biOSU^vª�YZ§v]0`bSUijY�V^vfQ]¦YOX�V6^bijde_6XZ[+iQ²¥<`S^axY�.r$q�^S�+f+{]rEt.qsrK`a`�baqsr�t¦�$b��.r$u��R^g[-q-O.r�O�v�[yx$`]jarMuS[-qs[-UE[-q�O.r0O�v�{]rEt.qsrK`S`�b�uZ}� %¿�{Q~�"¸^C´v[¼«?]7X|Ú%��U{g�R���W{Q�;{m} {Q�m�+�C²

{_lC²½q�²¨§½SU^v`b]Qz¸} Ra²¨L�iO´M}�Ib² Ár²�tuVYZ_6[a«?]m} V6^W`,h?² q�_�f��?²<§½S\^b_C`;�;^WV[+SUf+[+_6YZSU_m^,Tvz\V^v^vSU^bªV6`b[+SUijY [+_�lCSU^vª�_m«vijY�VfQzU]m²moPb�O_O_^�`ph.qyrEt.u&O�v][yx$`PWYXRXRX&j�{@{�{¢jarM[~}�[email protected]_v_`�bp`�rK^a`�O)r�NzORQSO.[-q-^gu�)rKh��&UY[�O)���.[-q�O)rv}�l~m~6~;²

{Q|;²�L�²�§½SnY�V6^b_b}! ²¯)riZVm`bV;}�©a²�§½´b^vSn��_6iO§vS¸}.c�²½®�_C`bV;}½¿�²���iZVQ¨�VC}�V6^v`ªL¼²¯ %VYZiO´v«vVX�VC²q�_m«?_�f7´vT4��) f9§vV6zUzU]Q^vª6]±T;XZ_m«bz\]7[ de_6X¼VS�V^W` XZ_6«?_6YZSUfQiQ²±cH^¬«¨`p^g[-UYbp`�­�O.[~`¦qsr��&ba[-q ®�^gq��+fjarM[~`gfsf q¯t�`�rm^�`9}bl�_6z\´b[+]a{g|6�R��}WTWVªm]Qi�{��v{g�C}u{g�6�m�C²

{g�b²�§½´;XOYz§½_m^b_mzUSUªm]m²2)ߪX�Vm`bSU]Q^�Y�[+]7YZ§b_C`±d4_6X�XZ]gV6znYZSU[+].XZ_m«?_Y�fQ_m^�YOXZ_mz¸²P��jpN��]\v}$l6~6~m~C²{_�C²>J�²¨§.XZ]QfQw7[+]7Xg².)�TvTvzUSUfgV�YZS\_6^�_6d�TvVX�V6[+]9YZ]7XaiOTvV6fQ]±`;S\iOf9XZ]7YZSUwgVYZSU_m^�d4_6XpzU_�fgVz)^WVglCSUª�V�YZS\_6^V[+_m^bª�[+_�lCSU^vª�_m«bijY�V6fQzU]QiQ²@NzORQSO.[�¥<O.[-q-O.rd�.rmh�T@O)r$[-bpO.f ��°+±R±R±�}�NPO6¥<OYT@O¬² ±R±�}mo]bpO_^a`S`ph+�qyrEt.u�Owv>[yx$`�³�qsbaua[�ceO)bS´)u�xMO�V¬O.rv}bTWVªm]Qi�{g�6|��W{Q�m�;}M{g�6�m�;²

{ � ²>I;²?Ár²vtuV�YZ_m[a«?]6²�NzORQSO.[@¥<O.[-q�O.r�oPfi�.r$rMqsrEt6²�§½zU´�¨)]9X»)�fgVm`;]Q[+SUf½­K´v«vzUSUiO§v]9Xg}M{Q�m�;{6²{_�C²>I;²W 'SU´;X�V�V6^v`µ©a²�hC§vSnX�V6S¸²Ö '_C`;]QzUz\SU^bª�[+_6YZSU_m^¬´v^bfQ]7XOY�V6SU^�YH�,_d½[+_�lCS\^bª _6«vijY�VfQzU]Qi±d4_6XXZ_6«?_6Y+[+_YZSU_m^,Tvz\V6^b^vSU^vª;²,cH^2j�{@{�{£jar$[~}>[email protected]_v_`�bp`�rK^a`�O.rµNPORQSO.[-q�^gue�.rKh��&UY[�O)���.[-q�O)r$�o]bpO_^a`S`ph.qsr�t.u�}�j)T�Nz�¶² XRX}bl�_6z\´b[+]�y�_mzU´v[+].�v|C}vTvV6ª6]Qi�l.l+����Yl+l � |C}:l6~6~m~;²

{Q�;²�n¼²6�rXZS\_6zU_b}.n¼²gkrz\SUlCS¸}�V6^v`! ²gyµ]7^W`bSnYOYZ]QzUzUS¸²�­ V�YZ§�Tvz\V6^b^vSU^vª)d4_6X [+_6«vSUzU]KXZ_6«?_6YZi×lCS\V�ip��]QzU]7YZ_6^_6^�d4´vwQw7��[�V6TbiQ²�jar$[~`gfsf qit�`�r$[��&UY[�O)���.[-q�O)r¬�.rmh¦\mO�v�[�T@O.��VmUE[-qsr�t6}M{Q�m� � ²

{Q�;²�h?²6³)§bXZ´v^=}�)�².J�´$�m]Q^M}6· ².J�´;XZª�VXZª;}�Ra²�-v_g©E}6³�²�-;XZ_m§vzUSU^vª6§WV´viKRa²)L�]Q^b^vSUªb}6³�².L�_de[�V6^b^M} ²�§.XZ]QzUz¸}KV6^v`�³�²�h;f�§v[+S\`CYg². %VT�z\]QVXZ^vSU^bª V^W`�§bS\ª6§b¯�iOT?]Q]g` ^WVglCS\ªmVYZSU_m^,SU^�q&L�c�®��¼²c�^���j��~QS�.ug`Sh�¥<O+Qgq-f¯`>NzO+QaO)[-u¦Z&T@�.ug`�uS[-U$h)q�`�u�Owv�uaUM^S^a`�uSuyvaUMf�bpO+QaO)[�uS�)ua[~`���uZ² 'cH³õ­KXZ]QiOiQ}Á)V[a«;XZSF`;ªm]m} ª)�}vRa²Y§½_XOYZ]Q^$�6V6[+T=}bq�² ­×²$Jµ_m^WViOiO_b}EV^W`±q�²bq�²[ '´;XZTv§��±]g`bSnYZ_6XZiQ}={g�6�m�C²l~;²! ²4©)V[�V6[+_YZ_b}: ²�h;§bS\[�V6`vVC} V6^v`�)�² '_m§bXZS¸²<��^;¯�zUSU^v]�^vV�lCSUª�V�YZSU_m^,_6d�[+_6«vSUzU]�XZ_6«?_6Y´b^W`;]7XaYZ§b]�]7©;SUijYZ]Q^bfQ]'_d½`;�;^vV6[+SUfgV6zUzn��[+_�lCSU^vª¦[a´bzUYZSUTbz\]±_m«bijY�V6fQzU]m²¬c�^¸��uSu�`���Q�f �¬�)rKh�m�.u�´�oPfi�.r$rMqsrEt.��WYXRX+°)��o]bpO_^a`S`ph.qsr�t.u�Owv�[yxM`�j�{@{�{¸jarM[~}�\$�)��VYO.uSqsUE�¹O.rv}ml6~6~;{6²l�{m²�Lr´vSU[+SU^vª�©µ´,V6^v`�³u_m^bª¦iO´M²Î) `b]QijYZSU^WV�YZSU_m^¬`;XZSUl�]Q^�^vVgl;SUªmVYZ_6X¼¨�SnYZ§å`C�;^WV6[+SUf�_m«bijY�V¯f7z\]a[+_6YZSU_m^0TbXZ]g`;SUf7YZSU_m^M²¦oPb�O_^�`S`ph.qsr�t.u¦O�v�[yx$`�j�{@{�{ªjar$[~}�[email protected]�v_`�bS`�rm^�`0O.r�NPORQSO.[-q�^gu��)rKh�&UE[�O.���.[-q�O.rb}�l~m~;{6²l.lC²½®�²+L�²�Ár²)©µ´v^vª�V6^v`+Ár²+©µ]m²[)rl�_6SF`bV6^bfQ]�_6dE[+_�lCSU^vª�_6«vijY�VfQzU]QiµYZ§;XZ_m´vª6§a«?]Q§vVgl;SU_6´bXKde´biOS\_6^V^W`'[+_YZSU_m^%T;XZ]g`bSUf7YZSU_m^=²�cH^<\$�)ua[~`���uS�@¥<�.rM�]�)rKh�T��+Qa`�b�rK`�[-q�^guS�&°+±R±.ºE}�°+±+±+º¦j�{@{�{»jarM[~}T@O)r_v_`�bp`�rK^a`�O.rb}vl�_6zU´v[+]�y�_mzU´b[+]+�Y�b}bTWV6ª6]Qir|.��l6���C|)��l6�C}:��f7Y½{Q�m�m�C²l|;²Ò)�²$¡E]QzUSU^vip����²KkriOS\^bªpTWV�YZ§�YOX�V^vijde_XZ[+i�YZ_aªm´bS\`b].YZ§v]�iO]gVXZf�§'de_X��v^W`;TWVYZ§±SU^dlR¼²�j��.N&Nr}{Q|Y� |;{_�_��|Rl+��}K{g�m�)�b²