Brigham Young University BYU ScholarsArchive All Faculty Publications 2001-8 Spline Based Path Planning for Unmanned Air Vehicles Kevin B. Judd Brigham Young University - Provo Timothy W. McLain Brigham Young University - Provo, [email protected] Follow this and additional works at: http://scholarsarchive.byu.edu/facpub Part of the Mechanical Engineering Commons Original Publication Citation Kevin Judd and Timothy McLain. "Spline based path planning for unmanned air vehicles", AIAA Guidance, Navigation, and Control Conference and Exhibit, Guidance, Navigation, and Control and Co-located Conferences, (). http://dx.doi.org/10.2514/6.2001-4238 BYU ScholarsArchive Citation Judd, Kevin B. and McLain, Timothy W., "Spline Based Path Planning for Unmanned Air Vehicles" (2001). All Faculty Publications. Paper 1513. http://scholarsarchive.byu.edu/facpub/1513 This Peer-Reviewed Article is brought to you for free and open access by BYU ScholarsArchive. It has been accepted for inclusion in All Faculty Publications by an authorized administrator of BYU ScholarsArchive. For more information, please contact [email protected]. "!#%$ !'&)( * +!,./021 3 4 !56$ !, 1 7 6(98:' ;=<?>A@CB%DFE GHJIJI KL@NM+OPRQSTUEV6WYX[Z@CB \]<^JZ_`PM<?BaPObcV6<?WQ ZBJ@CWYZd[efBJgh@CBJ<<?_@CBJg Di_`@NghQ ZjMlkmOhHJB9gnBJ@C><_`o@CPpS qf_Or>hOJsnK#tuvwx yz|{~}{ `p J` `a` ¡ ¢ £¤j??¥¦r`¥ §¦L `¨F £©?ª£«¬¯®±° ¨r`©£`¨a²|££ =[?` `¨§ §® ?9¨r ? ¢ `¨³´` c£Y` ?²¶µ|£ ·ª?¸¸FL ¸` £`FL¸ £¸¡¹£º¸` j ` ¢ f£»¼`¨F½r ?p ¢ ¾ ¶¬¯®m²¬ º¸` £`i±ª¦ ¢ £= £`i ¿p ` ´ ?? ¡ £i¸`Àj ± ´ªÁ`¨=£ § ´ £m¦ F [£¥¤? ¢ ¢ Lm¬¯®m²j¬¥ ££Â`¾ L¨`ª?i¡ ? Ã?~¸ `?À ¢ ´i¦ j Ä«? ¶¨r £Å° m ?ª ¨ R½r£ [?r £m¦)j «ÅÁ ¨r £Å°J` J ¬¯®Æ ¢ [ǦÈYiª¦ `¨a²Jµ| L £¨r`§É º?r £L cR½Y£L ³ %£]ª?i¡ ¦r`¨§jª £¾ f¬¯®Ê¤ c©Y£¦ ª?¦r ¨Fj?¸?9 ±j A²Ë§¨r`j¸£i ¢ £Ì£ Ä Y L £` ¢ ``À¥¦r¡ £ ¢ ¦¨r%?´ ª¦£ £rL m ´ ¡ ? ?`É F` ¸¡¹` ¡N £i§ j ¢ £ £`i¨r¸£ ¨¿? § ²¿µ|F¨`ª?j¸ £+ ? ? ¸ ¡ £»[r¡¹¦L ¼Y`ª¦| £f ¾ ¢ ¨r£`¨§ªÍ¾ª£ £²Îr¶¦£ £F ¸¦Ã¥ ` `¨ j [££¦¸ ±É `|9 É ? ?a² ?Ï%{³}Ð+ÑÓÒÊ{³Ð+Ï Ô ]F¦¨ ¥£¸¦`i¬A®Õ¨r`©£¡ c£ p ? F j²±)¸ j¨ ¨] p ¶ ¢ £:¶¨r ± ¶¸a»| RYj? j a Èh ¬¯®6ï¦ a£r ?± ¼ ¡ r` £A²9Ö ± `pÉ É`i| ¢ ª? £¨r` ¨L©Y£ ¢ £ÀYÃ|m¦j|j ` j p ¡ £`² Ö?£ £ ?`À[h ?¸ ¢ ¡ £fJ ¸i ª £`|£[ ` R©?£¨ ª?²¼µ| F£ £L £? :¶¦[` ª¦ ± i § £Â`9¥¬¯®m× Jª½r? ¦ ± ¸ ²J¨¨rá £j £?À ¾¨j £¸ £c ¾¬A®Ø¶¦¸ ¢ ´ È`Ä£ + ?¦`À[ º j ³£ £+ £¡ Ã2?£FL ¨ ¥ ± c¤? ¢ ¢ § ¬¯®m²Ù ½ £`]i ¦%¸ £F£ª£¦¨r¿£Ã¡ m¦Ú¦³ ¨r£¦`À ¨§££m¦U ¨¿L ½r¡ m¦"¸¨¾A c¬A®¶²rÛ¹¥£| ¶¨r¸£ ¢ £ | £? Ó È£ [ ?ª?¦a ` ?¨r£¥ j a ¡ c ?¦£¨ ¢ L ?È`¨F]Àa ?»¼£9 ? ª¦ ¬¯®)` ?¨rÀh¸ £ª£¦¨r£§ ¸¶ Ç?¦ »¥£Y9½r¨m¨rY i¸ £`²JÜ?i¦r £ ªÍ¾`ªf9`¸`?£ Yi i £c £? · ? J ¨r¸£ ¨f J ¥£ ` ¢ | ¸¨r`? ?É |¬A® ²µ|¥£©|` ]¬¯® ?¨¨r £ a ¦r?m ? L£?[¨r`j`¨[?=¦r¸¨rÉ ¦ª¼[ £rL £A²É ¨r ?³c L? ¢ £¡ iAr¡¹¦L |L R ¢ ±¨£ª©?`¨L¨r¦£ fi¸£a² Û¹£|£j?¸ ¥|ɬ¯®· ¾Ç¦ÈY ¨r [ »+j ic R©?¨f` ¥j?r¡¹¦i ` `² Ö?c ¸»¼] `ÀÉ£c£j?¸ fcL ?ÿ R©]ª?¸` © £©=ª?i¦r ¡ £j ``¨`² Ý £Ê Ê ¦ ¢ pÓ~ Þ£ £: ¢ ` »¥¨r£Ó¦¨r£`¨Àc¸`£ £6 ¿ ¶ ¢ `À ` ` Ê)¬¯®ßj £ £Æj ~ ª£©¨·£` `??a²5౨rL Øá âRãÉ?©?`= ¢ ¶©?©£»5 ¬¯®ä ¿ =£¸¦`É ?f»` f?¸ ¢ £¾¸?¦¡ £¸ `£``²Ûå·á æRãNÀ ] Ä £º ¢ £ ¾£È?¨Ä + ¿¨rY £´ r̪?? ££¿L ¸ j¨´¸ £?`²cµ|£± Y¸ `ç£ ª¨´£³ LÁj¨´¡ ` |¦ª £`À»¥££L¨r ¢ `¨ ¢ ºF ` £Y` ?Àr ¨§ £»¼`¨LLª± ` ?¨r¡¹¸ c¸¡ £¦r £a²µ|±¸ ¨r¡å cª?rÁ?¦ £¨`ª ¢ ` L¬A®%¸?¦¨£»f²Ü ¨r£À?¼ N²já èRã¨rª¡ ª ¢ `¯ É c£É»¥cÁ£ª¯ ¦¸¨c ª` ¤? ¢ £¼j ¶ c J¸ £J£[ ?i``² Ûå~á éãa ¶ §£ £i`i±¼¨`ª ¢ `¨¾ ¼¦ ` ~ j £+É Ä ª` ³¬¯®5j j²·Ö9á £À á êRã¨r`ª ¢ §`ª£¶ £ Õ ] £©£i ±j ] L ¢ £]² Ö¯£¦ ëF »[¶ ] ¦ £+»¥£Ä»¼ ?i¦¸¨¿ þìhÿíp îï`û ðNñó òpõCôªðNí õÿRLþö÷ øpõNùpñ ö ùúû9ÅÿRü¥ö ý ðNûñ ö¸þ ÿðCñóòpÅÿôõ õC ñ õð ý õ ýý ðí ý û9 ý ðCí ÿþ õCñ ö ë © c ɨ©`?¥¯ f ] ²Jµ| ¨r j¨f¨rp¦ ¯¬A®+j¸ £aÀR»¥££ ¸ ¨£` ¥f ?ª£r £a²|µ|m¬A®* [ £Ã£ a ¨r£JÂ` L¨r``¥ ¨§Ã¥¨r¸£ ¨§ É ¸ Ⱦ` ¨L ¼c ?ª ¢ f¨r? ```² Benchmark Problem 40 "$#&% Ô f9 mi[£j?¸ ¢ `ª £©`|£=` ¡ £¾ F f ?ª¥£¥ É R©?¨ J ` `² [ªÍ¾`?c»| R§FÁ¨=` f R©?£¨§ ±£ ¦ | ¥® ? ?¨£ ]À»¥£ »¥LÖ9£¦[æ |f ¢ £"¦¨r`ª?¸¨r` £a² Target Location Voronoi Diagram 35 40 30 35 25 30 20 25 15 kilometers kilometers ')(+*,-*/.10324.5,687:9;(=<),>?A@B,-*/9;( 10 5 20 15 10 Start Location Threats 0 −5 −25 5 −20 −15 −10 −5 0 kilometers 5 10 15 20 25 Ö9£¦ë= £=Îrª` zÐmÒÓ{~rÐ+Ï ³}Ð µ| ¾£ £¶±¨r©?£`¨L£L £¼»¼È £`¨Ä¦r§»¼ ?``²6Ûå´Á¸§ ?À| ª ¸ ]ª¦ i¬A®ç? Ã?¿ ~ ?ªÉm¸ ¦p`¨ ¢ ?¸¨º §r` £jf| `²5µ|¸º` ´£r £= ¿¦ `¨6Óª¡ ¸ ¦p¥ m® ? ?h¨r ? Þá ã¹²µ|® ? ?h¨r ? ¸ `¨m cÁj¨i ¢ `¸ ·¬A®Ó£r ¡ £] É [r` £A² Ý ££É©¨r£L LYr¨ ¿´ ªÀ9 F mm ¢ £§¨¦¾ i ³»¥¶ª? `ª¦ £©mj ¸` ?¨²Jµ|` a A¤ ¢ £¨¦[ ¦ r¡ £c ?¨r¦j9¸ £¯m [¬A®¶²µ|¥¸ªj¨m¸ ? ¦ ` i£rL £´ ?ç ¶Ác m ¢ ¦££¨~ § ¾É¦ ¢ ³ £¾»¥. £m¦äj | c¬¯®· ¤²µ|£¼ £m¦ ¢ ¦£§£ª £?À[¸º ]¨rª £¨Ä¤? £rL £Æ£] R© ££ ¢ £~ǦȣÄF ~ 6` ¶¬¯®m!² ª £`¨]£r? L ?] Éj ´ ` R»| R= ?5¬A®2£¶ ª¦£ `¨¿ ?c ¬¯®ä¤£` ³£Ã£ cj?¸?¾f rL a²)˼ Æ ` É ¼»¥£ ¢ ɨr£ª¦j `¨§=¨r ¢ £»f² 0 −5 −25 −20 −15 −10 −5 0 kilometers 5 10 15 20 25 Ö9?¦fæCJ® ?! µ|º® ?±¨r ? £=¸ ¦ª `¨Æ¦ Ä |r £§r? L £a² µ|` À? f¸ |¡ £ ¨L`¨L£Y` ?¾¨ ¢ ª?p ¨LÉ a² Ý ³ £ª`ª¾ ¾r` £ ¨ §`¨£r ?¿ ³ F `¸m `§r¨rm[ ® h¨r£ ]²Jµ|£| ¦`¨¾® ? ?h¨r ? »)ªj¸f|L Y´ f ?, ¾ª¦ `f¬A® £Y` ? ~ ?ªFr £a²Øµ|½=¸ 6£ ]¨r ¶»¥´ ³ § È?²fÙ ?´`¨m ® A¨r ? ä ?`¨§»¼ªD ` ª j¨´¦`ª²iµ|` É?¸c ¢ `¨~º F¬A®¶× ª½r? ¦É Fm= ¨ ²c ¦£ ci¬A® ¨ ¾¸£ ¦=L¦ß£Ó £¨`ª £¾ ¨Ä£ £ 9 ¿ë E)FG´«»¥H F´± §¨r£¸ ªi ¬¯®Óf [ °ªÀ¥ ?¸ R©`£ £~ Ä`¨F£i£©?¸`º £j ~ =¨r¡ ªL« i c` p° i c?¦ Fj»¼² []ª½ ª ª` ª¦ ?»?¦£¨i£Y©£©¼[£?? £ 9 ɪ?¸[ £ F`¨r?²% ¸ ` ¾| £¦ ¾ ` ¶ª¶ i ©? £r ?É ? Æ`¨r? ¨ ȳ `ÆÉ `¨³£ ª¡ ª?¦`²fÛå³ ±»? ÈhÀ ¶ fª?¸c»¼ ?` ª¦ `¨ ~j?§ £¿ ¨r- IAJ/EéÀ I=JKEærÀ¥ ¨ )â IAJ/EéÀ»¥` 4 I=J ¥m£ =J¨rM L²¥µ|É ` æ [ FÛå¸ ¦rÉ [` ? ¦ | ¨] ? ¦r£` ª[ ? rª ¨»¥ FfONQPL`¨r?±¥?©? ¢ ¾ ɽY¡ `¸£1 ` ë ë R NQPTSU VNKW J;X I JZ[ Y F G ë F F G G g \^]_ _^acb W J W \ed _acf W J W \ed acb W J W \ihj »¥` lä k ¯ YY¦ ¢ `9 `À)F J £¯ ¨r ?5´ëE æ§j?m? ¾ NQP _¨racf W W \ = NQP ` ²µ|[f ` ª¦ ¶` ?¸[£ ~ ~¸ ³ £? ]Àa ¦~ ?x Èr × c £¡ Ãäá yãNÀ[Áj¨f £»JªJª? ¢ ª»¼` £ h¬¯®6£r ? j¨ r` £ ¡ `²¼[=ª½ if¯m £¦r £F ¦ ¢ ¢ £ ¼¦¨F£=Ö¯£¦ x ² Voronoi Path 40 35 »¥§£=Ö9?¦ fè² 30 kilometers 25 20 15 10 5 0 −5 −25 −20 −15 −10 −5 0 kilometers 5 10 15 20 25 Ö9?¦ xz9Ûåã 9Ü? |{ Ö¯£¦ fèC µ|` Ü?¸Ü¼ £¦ £ Û¹¶F] ¸¦¨ j F ¿¬¯®F¤jÓ =ªj j``¨À ` |¦`ª ?J¤YÉ £f ± ª¦£ `¨J¸££f ?j?¸? ¼£ mr |¨r- Rmon UKpqW $J X I Jr µ|i ?¸±?c R©`£] £] `¨r?Lª " i»¼£ ¨§ ¦"¯c [ ¨¦`AªD R J Xts R mon UKpqW J «¸vë u s ° R NQPoScUVNKW J r µ|¥ª¼ s ¢ ª»¼d`e wc j¨¾ë|£©A¥¨r` £` ¤½Y ¢ £§ ¾ É»¼£[=½Y? ¦c L` [? ¦`?½Yj¨ræ¨rj¨rcj ª¦ a £ ªj j²i s © £¦Lª£? ± ¿ë»¼¦¨³` ¦f `À»¥Ã¾¸ `? ¨¶ ª½rj¸¦ | m] ¨ `Àj»¥£i ¾© £¦¶¸`[: w¾»¼¦£¨]` ¦ £~ É R©?£¨= ` ±½Y? ¦¶ ª½rj` J£?| ]`a² Ý Ã§Éª¥¨r `¨§|` ?§Ac® ? `¨``À¥~® ? ?±¨r Ì ¢ ` ¨»¥Ã Ö¼£¥` À c?¸¼»¼£¶ s »¼ ? ¸`f ±£© ` j ¢ £ ¨)} ¢ ª»¼m R½r£i¡ Jf ] [ ¨§f =`a²µ| »¥i i ] `¸¶? ¢ £F +? ? ¢ £[ aÀ ¢ ¦` mª? ¡ £ ¢ »`¾±»¶ ¢ p©?``²J˼ §¸ ¦ª £ f® ?h¨£ " ¨§ ` i¥| f»¼`¸ ª| = ¦r £j £¾£½Yj¸£©?À»¥£F£ £§£±»¥ ]?¦¥ £ Ø ¢ `ª £©``² ~[»¼©?À£ m±¸ £¶£] ?¶£¦r¤? ¢ £ ¢ º ¬¯®m²¯µ|Lª½Ym¸ `~c ]r¨r´ L ª? ® ¼ ~Á¨Ä rL CÀ?ªi¤? ¢ £§ aÀ |f£É ?| `¸ ɬA®¶² "$#Q" A,-*K?A24.5,687:9;(=<),>?A@B,-*/9;( µ| ?¸È» ¢ ª | È?J a£ ¦r¤ ¢ £ ´ j¨ ¸"¾ ] £¥¤? ¢ ¢ ɬ¯®m²µ|cÈ?¾¨r` i¼ ¢ ¦£¨f £ £º L £ £`ªÀ¯¸F j c ¾¨`ªr?~L ¬¯®+a¦r`¨ÉǦÈY?À`»¥££ ¨r`ª¡ £¿¥ § º ¶f ¶ R»| R= ?5§¬A®2£ ª?¦r ¨´ [ i¬¯®'¤£` mR½rL ɸ` |¾ a²´µ|É?©?`±§¬A®" ` ¢ £´ ` ªÇ?¦£ÈY£f f`»£r? L ?aÀ ¨É¾` ª¦ ¶L £¨r` ij ~»¥£iÃc¤j£] £§ è [ FÛå¸ ¦rÉ [` ? ¦ | ¨] ? ¦r£` ¼ p ? ?²¯µ¯c ȼ ¥ ¨j £` £É` ¡ ¢ £¼9 ¥¬A®¶À |® ? ? ¶ iY ¨É¦ ª¦ ¢ £f £`fáëiÀ RãA ±£F f = `? Q DQTQiAC;vQ;ClCT1z!o µ| ȱ»¿£A ±¨rªi£»º ±ª`ªA ` `fÈ`²Ûå´¦ ¢ f¸£É£ £AÀ` ?F ¡ ¢ ª»¼`´ÈY[ ? ¦Ç?¦¶ª¦ ¢ £mj?Y?£ Y£ ¨~»¥ +â² { ªY¦¨Ã?É»¥£ ££»Æ¦|¨r c É`?ªYªÍ¾ª£¼ `Ǧ£ ¨F` ?Ƹ£º¸``²:¼F ? ÈYÀ ¥?¦¨Ã? ¼m¦¸?£¨² µ|»¼ ` | ¼ ¥¨i |Á¸ª¦ ©? ?9 f`¨ º¾¨¨r£ÈYi ¨ ɧ `¨º¦ ©?¾ ? ¢ ?¿? ¾¨¨r£ÈY`²§µ|£m£©`±¦ ©? AÜ £Lª??Y¦²¶µ|i £¨ª?¨r £~£ j c iÁ¸ ¨r` £© £©³f ´ÁFª¦©³ ¨~ `¨¦ ©? m¦j ¢ ¾Ç?¦j É È`À9»¥ £»[±¦ ©? F R©?LÜ _ ª? £¦Ã?²mµ|i¦ ª?¨r £ºª ÕL Ǧ`?c f¾¸ª?¨~¨© ©? Á¸J¦ ©? ¨f¼ `¨mª¦©m¦¸ ¢ |`Ǧ ÈY`Àr»¥¼ Ç?¦`¨?¥Ü f ª? £¦Ã?²Jµ|` ª?¸ £?f»¥££©L?¦mª?¨r £É ?Ú»¥£º ¨r É É£¦ÈY»¥`²|µ|mL ££¦ ª?¨r £±ª?mÞ ¸ ¸c ¨³¨³r` £³ ɪ¦©?À ¨F ¸iÉ [ ¨§¨]¨r` £© ©?``² µ|È££§£Ö9£¦Fâ´ `` É i £?²¶µ| J»' ]© ] £r ?³ £¨¨rcÈY|£§ ¦] m»| RL ££Â± ±½rj¡ ¦ ¶i ´ § m »¥££¶±½ª¨r£ i¨rY £¶ªj i¬A®¶²µ|m½Y? ¦ [ i c | ` L R ¢ [Ǧ Â``¨ ¢ m` ¡ ¦ £ L¨r m¥ ¤ ¨r£ªª¶j ~r` £j i k R½r£L `À ¥ »¥F=Ö9£¦fé² Ý £ ±£ h ¸ ¦p`¨¾ ?*±® ? `¨`i £»| RYÉ f§j jÉ L ¾`Ǧ¨r¡ f ?Õ L` `¸c ` `ÀAª?p £]¾ j¨ ?ª]j?F º® c¨r£ Ì»¥ Ê ¸ ££` ¢ £` L?r £L N²J¾ £? ? ¢ ¶¨r©?£`¨c»¥c È`Ar` ` ¯r? L ¡ £+ ~ ¦m»¥ª?¸ ¦p´ ¸F¸p £j i a²fÛå´f¸p £AÀji r`¨r¦É?fª¡ ¸ ¦p ¶Ã£ 9j ~¸``ÀjÕ £ Á¸9® ? ?`¨r?À»¥£ ¢ ¥¨r£ª¦j `¨²9µ|Á =¸`¥¥ª` `¨§= ££ ¥ ``² [ iÁ¸aÀrÉ ]¥ £Â`¨ ¢ ¨ ɨr`ª £9 9£ X Q« ¡¸° X Q« ¡¸°p²J[i £±ÈY|£Á½r¨ ¼ c¬A®·j¸ ¸¼r £aÀY»¥££ mÁj J¸££mÈY[Á½r¨³ i£¨j? Á¥® ? ?`¨r?À ?¼ »¥F]Ö9?¦câ²JÊÈY`Àr£ ± ½¼A¦ ¢ £±j?£ £aÀ£¼ £L £?¥É £c¥ Ǧ`¨ ?¶¦?a² Starting Configuration using Decompositon Method 14 12 10 kilometers 8 6 4 2 0 −2 0 2 4 6 8 10 kilometers 12 14 16 Ö9?¦fCâ JÛåã ¯ÎY££ÉÖ9Ã¥2ÎY {J£LÎr`p¡ j¨£L¯Ûå 1{ µ| ¢ ?m ¸£¸ £¨i É R©? ¼ jªÁ`¨¶£Ã£ Y` ?¨r± ¨f`¨É¼ £ ¯¸ £`¨f ¢ ¯ ¼® ?¨r m£m ¸ ¨´²F[ºi¨r LÈYÉ£É ¨ |f¸p £F9 c»`¨``² Ö9?¦éCJÜ?¸Ü¼ £¦£ £f?¯Ûåã Y ¨mÖ9£ B{ ÎY` µ|[ | ¨L£ §ª?¸?¼ fj R ¢ ±` ¡ ª¦£ `¨ ¢ ! [ FÛå¸ ¦rÉ [` ? ¦ | ¨] ? ¦r£` Final Configuration using Decomposition Method R NQPTSU VN X [ Y [ «QF J ë ° G \^]_§J ¦]_ W \ 14 12 »¥£]´ª¦ © ¦=´ ¢ ³` ª¦ `¨ ¦ i 10 ¨ Q« ¡¸° X u ©/ª« N ª ¬^N ª N ª¬N « © « « ªª «N ° ª f ¬ « ªª N ° fª °¬ ® acf ª d ª |µ [ rjÁj¨rm £ j ¤ ¢ £ ¢ f¬A®ÊL R ¢ c? `¨§ | §r£Â` ? ¢ ¡ £ ºL££»¥]? ]À9»¥ÃIÊ `` £] £ ]¯ f ¯ KL °5L ¯ L&±²³ s R QN PoScU VN «ëu s ° I w ´Tµ5¶ · ²¸¡¹¡ º8 ¨ «»¡¸°u z¨ ¼ d V «e½ »¥` ¨i¼ V ` É] ½r¶¦ ª¦ © ¦F ? ¨r `¨:« 6¨rY iƸ £+= ¬¯®m² Ý 6 m¦ ?aÀ `Ǧ£ ±Ç¦ ?¨r ? i£´«CzÎ ¾|{°|¦j¸¨] §©R § m£Y` ?= ´£¨¨~È£Ó¸¦jÓ º»¼ RÄ L¨rª~ Ó F£Â``Fª½r? ¦= ³ ` `À ¢ ¦r m¨rY`¼ª½ª``¨Lª¦ © ¦ª? ²9µ|`¨ ` ¦ÃJ r`¨r¦É ¢ ¶¸`=£³Ö9?¦ ¿ yY²|Ûå £Á¦À? ¥ Èi£ [?r £m¦: ¾ ?¨rª¡ ` £`¨iØiÎ ¾|{º»¥££È`£É¦ © ¦|` ?¸ ¢ £ »¥ £F ɨrY £f` ¢ £ £`|¯ ɬA®¶² Ô ª¥¸ ¢ `¾ª? ¨À rª¨r¦ »¥Ã` É ?æj¸¨ m¦r¥ ¡ £m¦" §| fj?¸?¼Af£Ã£ F c® ?h`¨r?``² D!TÀQÁzÀÂÃ!T kilometers 8 6 4 2 0 −2 0 2 4 6 8 10 kilometers 12 14 16 Ö9?¦A yaÖ9j Îr£Ö9a%ÎY 1{J£ ÎYª?¨ £JÛå { uBÇ F XÆÅ È ÉËÌ Ê§Ì Å Å Å ¥» ` ÂFº£¶ F¨r¸ jª ¢ »` ³j? É ? £c ¨ ® ? ? §£»¥£ Ì £ c¨`ª¡ £]©?`p¼|c® ? F ¨ È ¥ Y¾£ §® ? a²ºÖ?É §£ £¶ ?m f A aÀr ɪ?¸|¦ª £ ¢ ª?iD R NQPoSU VN X [ Y Q« F J ° G J ] _ j »¥` Ík § ºY¦ ¢ ]¶¨r j?F?Ó |µ |£¦r ?¯ £ ' £¸9»¼± ?¨R¸ £?²%µ|= ¢ `ª £©=¾»2 ¿© + ´£r £ ® r`¨``²Jµ|[ h [¸££[ª? `¨ fi¨¨r£È]j?F F £ Rr ¨rj? r¼Á9`¨r?À»¥£ ¼`¨É f¸ c? ¢ £i F L® ?9j «¿ § ¸ £fªj ¨=§£¨r£f¾ `ª?¨ Ç?¦j ` j¸R°pÀ[»¥££~F©Y£ ª¦© ¦ ª¡ `¨²µ|L ?jc¾ £L ¸]ª? `¨ ¸ £?²Î RYiª£? i c® §|`Ǧ£©¡ ɸ Ri [ [¸£` ?9 ` ¸`ª £©|£?`²J £J f R©?¨r| ` `² Ý ££[ ir£Â` ? £¨¨r¥ÈY£ ¨¶ ¥£ ` `ª £i |»¼ ¦r¶ª¦£¨ ¢ ɦ `¨´¨¦ £¤£[?À[¶¦ £?J»¥£i»¥£ ¢ ¥©`¨¶£i?¨9 fª` ¥ ` ?¸ ¢ £ i¦r ? £=;ª£c F¦r ££Â¾ F¨rO}` ` a² µ|±¨rÄ }hjª[£L £¼ £? *£ j ¦ ` ¾£»¥¿ £i£Â` £¿¶¦r`¨ ¢ ª¡ ¶¨r m9¶ £É2 i® ?a ³ ? ±¤£¥ £²¼¥ £[¸ c ¨rª? Ã?aÀY ¦p? ¢ ±i££Â``¨À ?|¸»¥§FÖ9?¦ cêÀ ¢ £Øj ¢ `§ ¨r¦ª¨LmÁj¨r¶c¸££± £F»¥£§ ɨ `¨F£c| f® ?j A² ¢ `¸AÁa»¼[£¼¸`À»¥£È`£ [¦ © ¦ µ|³¨r =Ì ¿j?F ³¸£´¿ ª ?¸ £? ¢ £²ÓÖ¦L© ¢ £`L F`Ǧ£ ¨ ® h = ¢ É ª¦£ `¨§¦ i ª ? `m¨ªÁ¥ £©`¶ ?¸?À»¥i |£ â [ FÛå¸ ¦rÉ [` ? ¦ | ¨] ? ¦r£` Ö9£¦ëTwCªÁÃ?F|« r °lÛc{J£ j 9Ö ?¦³êC¿Ü?¸]ܼ ª¦ ?¾Ûå?Î{ ÆÎY¡ A c£f ?i``ÀÏL ¨ ¶ ÀY f £ ¢ ª»¼§ £¸``ÀÐÀ? j¨i £»| ¢ £| ½r¶¦*¦ © ¡ ¦ ?À ¨i¼ V À ¥ »¥F]Ö9?¦ Ñ ² « Ö9£¦Ñ C¹`j¸¨:{ ¢ £ µ|L J»?¦¨ ¢ FÁ¨~´« °c£Y` ?³? ³£¨¨r³È¾ ] ¦j¸ ~¸ j ££= RÄ ? ª£? É® ?A º j ¢ ?À ¢ ¦rf¨rY`± ª½`¨Fª¦ © ¦Éªj `² Ò[`»6© ¢ £`| f¨rª¡ Á¨=¸¦j] 3 I£[ ¶¸¦ÞJf»¼L`L`À I X Ï À¼ Ô¨ ÓÆ Ö¨ Õ· F¦ `¨+ º¨r`ª ¢ F £Y` ?§d ¶A fi¨¨r£ÉÈY`À ¥ »¥F=Ö9£¦Të w² Û¹£§¨r` £ ¨+¿Á¨½r £i?L ³rL © £¦`É+ Ó X8× « Ï ¶ Ð °f j¨ Õ XÚÙ « Ï ¶ Ð °p²¬¡ £¾` m ?j Àj j ¶jØ ?r £L 9Èj £j ±j£Ør £ ª?¦¨ ¢ ´ª?¦r ¨Ä¾ ¿ jªÁj]£¿ ²Æ¬[ ¡ ¦ £ÀJª£? `¨Y¡N5 £¦r £±? × ¨ Ù R© ££ ¢ £¨r¦ É£ª½ri ¢ £]²Ò[¦r¡ £` i¸?¦r?]? ÓØ jÜ ¨ Õ2 +¦r`¨· ¨ ¸ `¨±£É |Y?È?¡¹¦± ¢ £²¯¬[ ££Â£¨j¸£ j ¡ r¸`À`Y¦ ¢ `¯© £ ¢ `Ǧ£ ¨±¯ YÈ¡¹¦ ¢ £ ¢ `¨r¦jª`¨L ?*?¦ ɲJÛ¹ I+£¼¡ = |f` L©R ¢ ?ÀY `] É ¢ `" ¢ c £ ¨¾¶f?¨r£i` ? ª `T Ó Ý X Ó1EI «ëR° Ï Ý X ÏCEI «Cæ?° «è° Ý X ¼ JßÞ EI X ë E ¨ ¼ V I Ø Ø « µ|£± ?±à }h`p©?£] ¨r¦ª¨= ¢ £Þ §Á¨Y¡ £ Ó Ý X × Ý « Ï Ý Ð Ý °§ ¨ Õ X Ù Ý « Ï Ý Ð Ý °p²Ø5 ¢ ~£ ª?¸ ¦p`¨L£§j »¥j Ø £L?¥ É£©` ÏÝ j À Ýj ÀrØ Î¨ ÐÀ c¡ £m¦ ÓÝ j|¨ Õ§ £¦£ ¨± ¨cØ `¨²¯µA¥¦ £ £?È¡N¦m ¢ ¥¨r¦ £¤?9?ÀÁJ| ª Ï´ ¨ ¨ i¨j¸£ £Â¨´£ Ï´ Ý ¨ Ý ¦ I[²[µ|´?©?F ÏjÝ À Ý Àh § ¨ ÐÀj É ¢ £É£¦Ø `¨F Á¨ §r¶¦ ÓÓÝ jØ ¨ Õ² Ô ª ¶£m¦j¨À `¨j¸£ £Â¨ mÁ¨ ±ÈY|? Ã?³« °p² µ|¥rª`¨¦ ±[¸¦iL £Â¨£FÖ9£¦ëë?² j a, b, θ, κ L=a+b r^ = 1/κL ^ r, ^ θ a, a^ = a/L table lookup ^ σ, α ^ ^ ^ σ^ = f (a, r, θ) ^ ^r, θ) α^ = g^ (a, x = Lσ^ sin α y = –Lσ^ cos α x, y Ö9?¦ ë?ëÎY¦L ¾ µ9 ¢ £ÑáaYÈY¦§=ªr¨ µ|i¸ ¦ª £´ ¢ i£±¦ ª¦9£´ c »+¸ ? a¼r¶¦âÓ¾ ¨4Õ§?J Y±?©?eÏjÀ ¶ À)Ð j¨ ² Ý i Yɨrª|»¥ « °J¸¦¨ ¢ ÀJ¨ j` ¨| ´ =ª¦ ? j ££~ª é [ FÛå¸ ¦rÉ [` ? ¦ | ¨] ? ¦r£` £i£Â` £Är¡¹£?À»"¾£L £ L `L £?ÈY§~ ¶ ¢ £¶ §Á¨³ ª? `ª© £¦²¶µ|£ j``¨ ¦¶¥ £f £? 'ªj¸¨r ¢ ?² Ô [ ¦¥»¥ L£ i£»+É ¨r£¸¸¡ ¦ £[ f±ª £`¨]£] É ¢ ?²[Ör¡ ¸ jªÀ?J £©`ÉL ½r¶¦'ª¦ © ¦ÀR A £¶ »¥£9Á ¢ ª»¼³»£¸``À ` LYÈY¦~ ¢ £i»¥££ª?? £³= £¦r £A²iÛå¨r` ¨r££i?¸ ¢ £À ]½L `?i ª ¸ mA¦ `¨¶ ¨m m?r £Â ?É£9 `¨ £³»¥= ¶ ¢ `ª £©m ] R©¨F m »¥££ [ª½ª``¨r£¾ª¦ © ¦Éªj `²µ|[[ ££ ¶ ± rª¨r¦¦ `¨§ c£ ¨Á ª? ¾ `?²¯Û¹h ` [¸ £jf ¢ £¥ aÀ? ` ¦ ¢ `Ǧ `?J»¥£ ¢ ¥¦j¨r`¨i¦ £ ` ?¸ ¢ £ ~` ¢ i¦¨²Éµ|± Èii r¨~ ¢ ¦¸ £É¸`¼ [j R©±` ?¸ ¢ £c £¦r?a² ¬¥ ££Â`cªr¨À £¦r £i¦ c¥£?È¡ ¦ ¢ £³ ¢ ³ `ÓÖ9£¦`]ëRæº ¨Êëè²%µ|£ rª`¨¦ F¶` ¨¿ +]® ?£ ¦ £ ± ¸® £¶£` `¨²Jµ| c £? Æ 9»¼ ?¦ `¨cª?pa¸ ¸A£A ® ? ?Y¨r Ê9¦¸¨fª?p9 ¼ ?ª9¡ £=i® ?¯¨r ? FÀj ÈY§F ?ª?¦ ~¨r¸£ ¨ ÈÄ ¨r£ ¾ ³ ªF ¨ £ £Y` A ` £a²Ö¯£¦ ¾Të ¾¸»[¥ ¶ £¡ Ã,£~? ± ±É¸Y` i® ? ?J a² Ö9?¦iëRâi¸»[ɪ?i `¨F a² Final Configuration using Decomposition Method 12 11 10 kilometers 9 7 6 5 4 12 10 kilometers 8 6 2 0 4 6 8 10 kilometers 12 14 6 7 8 9 kilometers 10 11 12 13 }ã~z|Òä¼{¿z µ|³ Ó£ £¸ Ħ £¨Ó ¢ ©³»¼ ? `¨Ê£' Ó ¶¦£ £ÊY©Y£ ?`å ² ´ £ ¢ »¼ ? ¦ `¨%· %ê-ww~[ {|ÜÞ?³ £f ¸£m¦ ?`² m`¸ ?¸?ÀY c?£»¥ª` £¶»| |? `¨a² ¶¬¯®)£¤Y £Ã aÀ©Y£¦ F¦r¡ ÈY»¥Ór¡¹¦Æ ` ] ~¨r p ¨Æ ¨¬A® m¦jcÇ?¦£ÈY£F¨r ` £¶ L»' É =¾É ¡ `²9µ| 9£ R?¦rA£mÖ9£¦ëRâ|£9 ¦`¨f A £Ã£ ?ÈY»¥£`¨ r` A ¨f [ f¯ ?¨r£ `¨² ~»`©ÀA ¶ =£?i £]£¶ aÀ9 4 2 5 j ª¦ ¨©R ? £ ? m£9|` ¡ ¦ ³ ~ Ó` `¸¾¬A® §` ª¦ `¨ ÁÀ ¨ ¨rª ££i ¸¾ R»| R ? ¬¯®Ê £¦£ ¨L£ ``²JÛ¹|£¼`` ¶ ¬¯®Ä ¸ £f R©¼¨rª £¨f¤£¯£r? L ?É? ¸Ac ¥ R»| R²Ü¼ ª¦ ¶ ¦rm §¬¯® £ m¦r ¦i»¥Ã³£³¨ª `Ǧ£ [ £´¨r`f ª?rÁj¨r`ªÉ [ É ` £rL £Ä¾ª? `ªL ¨ª?i ²6µ|£¾£L¦j¸¦r¡ ££§[ ¦?²|µY ££À»% ` ɨr£ª©?`¨ ¨r¦£mf¨r¦ ?¯ ±¤£[ j¨L ɬ¯®%¶¦¸ Èm ¸¶ F `ª¦? § `£ ³ ¶ a²cµ|£ ¿Ç¦È£º ª¦£ `É §` ¤j??i j¨F¨ª £`¨]£r? L ?F £ ``© ¥ É£¶¡ `¨r ¨cL¬¯®mÀA ¨³ `~¦ ` £ j [¥ R©R ¢ ±»¥£c¤Y£i ¾` ª¦ ɨrª ££ 9 f ` i a² 14 0 4 Ö9?¦ëèC=Ö9j ÎY£´Ö9ÃL?ÎY`¨ ¨µ|¨ áa`JÛåã { Starting Configuration using Decomposition Method −2 8 16 Ö9?¦´ëæCmÛå |ÎY£FÖ9ö¶ÎYª?¨¿ ¨¿µ|¨ áa`JÛåã { y [ FÛå¸ ¦rÉ [` ? ¦ | ¨] ? ¦r£` Complete Path Computed using Decomposition Method 40 35 35 30 30 25 25 20 20 kilometers kilometers Decomposition Method 40 15 15 10 10 5 5 0 0 −5 −25 −20 −15 −10 −5 0 kilometers 5 10 15 20 25 −5 −25 −20 −15 −10 −5 0 kilometers 5 10 15 20 25 Ö9£¦ëDz ÎriY £¾[£? äæ{ rª Ö¯£¦ ëâCÎY £L[£? "Ö9 `¨ ¬ ¯®,£` ¶ ¾= = ¨¨r £j | L »¼F `©£¦j¸£¦ÈY»¥A²Û¹¨i ` ª¦ = `»j ¢ `¨±cA`» ` A £a²¯µ|£ ªj i£¥ »¥F=Ö9£¦ë`é² µ|§¨r¸`¨¿£§£+Ö9?¦´ë`é~ª` j?¨c´ ££ h FÁ¥ `¨F»¥Fɬ¯® ¢ ? § £ ?a² Ý £] =¬A®U« ` ¸` `¨ ¢ ¿ ´¨£ ¡ ¨j°LL££»¥ j AÀ¥ `©Y?¦¸£Ä¦ÈY»¥ Éj?r¡N¦aÀ¯ ¸`?`¨ ¢ ´ É»¥Ãª£ ¦¨·]² µ| ¢ ©Ärª`¨¦ £»¼`¨aÀ i`ºF® ?¼¨r ? Ú £¦£ ¨+ j¨¿ iY £ r`¨r¦F£L¸ ¸`¨²ÛåÄ R½Y£L £ ë² è±¸ªj¨À ¢ `¸ rj ? ¢ `i¦j¨¶ ¨ ¥Á ?i`h L ¢ `¾ iY ¨ ¢ m £? ]²|µ|m¬A®* R§» ¢ `£] L¤j£ `»·r¶¦Õ a²cäc £L`»·rá m¦)j AÀ?c¬¯®6L Rir£Â[± ` j¨r L a²¾Ûå¿ R½r£ `~â² ê] `¨`À¾ ¾ ? ¢ `¾r£Â¨² µ|`»r¶¦) ¾£ »¥§£§ cÁ?¦c ?¼ cȾ£?À»¥ÃF f? £¡ ] »¥] ¼É¨r ¨§££² ɬ¯®Mçj ¨]è?°É¨r`ª ¢ ¨§ r¨][ª?i¦r ¡ £j £¿ÍL``À £»¥£´= £ ¨r£ ?¸ ¢ £º¥j?r¡¹¦¿ `²³¬¸£=£i ¡ £¶ ? ?aÀ± ¢ £i m£ L` ?¸ ¢ £ ¼ ? ¢ ¶¨rj `¨f ¦?É [ ¶¦£ £É££¸¡ £i ɨr ¢ `¨] £? L`² Ð+Ï·ÍmÒ%z|rÐ+Ï·z Ûå F À¥~¨r`©`?§m ¿ Æ ¡ `É»¥?` f F` ¢ Lj ?m =¬¯®ä ? ¢ Ä` ¨²+µ|]È?¸ i ]ªr¨ më° ¢ £Ã´ §Á¨ § ¶ ³i »¥£¶ R©¨r£i ` T çhæ?°¼ É ¥ ± f ¡ `¨¾ ¥»¥ ±¨rY [ª? £i? `¨ ¢ é%Ï·Ðêë ã=Ñíìäîïã=Ï6{z µ|£+»? È»¼ ?¿Ã£ `¨Ø Æ[£+Ö?ä𥪡 ` áA ¢ ? ? ?À[£® `ª£`| £ p ¶ F Æà± ?¨r¦ ÓÎ ¦¨ÎY¦ ð[` ` Ë { ¡ ]²Aµ|£¯»? ȱ»| aj £c¸¦j?¸`¨ ¢ fÖ Ô BÎ ð ¥ R»¼ ¨Y¦ ¢ [;Ö - ?é?æ w&¡ w몡ëª&¡ ww- ë?² è } ñòñóCñ1ô3õ!ñ1ö áëªã 𥠨x~ɲ`Ë| ¸À÷?mܲ`˼` ¸?À ¨f˼ fɲ Ë| ¸ÈY² ø3ùûúùiü/ý^þoÿDüQþ)ùÆü&þ qùàþ)ý qù¹þBüàýlý !ù!ÿ"#þ$àü/ý% '&¢þoÿ() *qù,+² =? :Ûf ¦rL § {¦ ¢ ¸ÀrÛå²ÀATë ê yY² á æRãmÎrª¸É²¯Ë¼?¸) }J§² { º ´m¦L ¨ £A©?ª£``²µ¯` `À[£JÖªA ð¥` ` áA ¢ ? À?[£® ª£`A £`p ÀÎrr ¢ Të - ² á è ã {J²iÜ ¨r£ÀÎhM² ð[ ?¸¶¦ AÀ¾ Ú ¨ ¿M² { ??² ¬¯®*?j` £©f ´£ £²¥Ûå.-+ýcþ/ÿqù,+ þ0|ü13øú^ø3ø234Qÿ5ù678:9;</+,ü=Qþù83ù!ÿ>¹þùiü/ý^þ ¹þù/DýDùÀj[¦¦¸) æ w-ww² ê [ FÛå¸ ¦rÉ [` ? ¦ | ¨] ? ¦r£` Path Replan due to Pop−up Threats 40 35 30 kilometers 25 20 15 10 5 0 −5 −25 −20 −15 −10 −5 0 kilometers 5 10 15 20 25 Ö¯£¦ ë`éi{ §ð¥`£ F¨¦c Z{J?r¡N¦§µ|` á ã ´ Ȩr]˼À=´ © Ûc `©¨À¹´ È Ô ©? ¡ L ÀÆ ¨ Ô £`¨.ÎrY»¼ Â`Ȳ ¹þBü? üQþ)ù '@þDüý%A(BøC +þý%qü1!D)ùÃÿ¢ø3( 7)üQþ)ùp² ÎY ¡¹® £ Àr)æ ww-w² á âR ã ÷D }` Óm²à±¨rL A² { Æ Ä ¢ `L ¨= £¦r?²¥Ûå úEFEFEG9;)üQþ)ù 5øCàýcþH=5$ùÃÿ E3 IDüý^þ)ù J¹þù/DýDùÀ ?`coë w?Lâ KhTë w?êÀoë ² á éãɵcT² ´T áA É x¨ ðf²Ë¼ ¨²µA p ? £ £¥? ªY¨r£ `¨j¨rÂ`©¦j¾¶¦L `¨Æ F©`¡ ª£``²ÛåJ-+ý^þL7ÿqù+3þMlüN+øú^ø3øOP4Qÿ(ù6%8Q9;<L? +5)üQþ)ù8@ùÃÿR¹þùiü/ý^þ F¹þù/DýDùÀj[¦¦¸) æ ww-w² áyãɵAr¨Ö¨ Û² =Y ¨ Ý YÓܲΠ£ ££S² &Tü1)? )ü :&TDüNiþTÿ)ùÃÿZøC +þý%qü1!p3 ² {£ª&¡ ~ £NÀ Ûå²£iÀ Ò» ÷` ?Àræ ww-w² á ê ã =£¶Ë±² {J££ Â` `²=® `£F¦r ~»¥Ã ª? ¦¸£¿? ´ £? L`²Ûåt úEFEUE 9;)üQþ)ù øCDý^þH=(Jù!ÿVE3 IDüýcþù W¹þ)ù/Dýàù6ªÀ ?`cë?ë%ë Khëoë Àoë ?ê² á ã áA Ö á²|ÎrY¦L ÈX ² 6 *qùRYZBùDü=Qþù)B\[CH% ² ÷? Ý ££ ¨=ÎY`ÀTë ?êë?² ] þý%A+ [ FÛå¸ ¦rÉ [` ? ¦ | ¨] ? ¦r£`
© Copyright 2025 Paperzz