Path Planning and Replanning for Mobile Robot Navigation on 3D Terrain: An Approach Based on Geodesic

<div>The general case. The nonsymmetric routes <svg height="12.5338pt" id="M351" style="vertical-align:-5.529pt" version="1.1" viewbox="-0.0498162 -7.0048 66.7781 12.5338" width="66.7781pt" xmlns="http://www.w3.org/2000/svg" xmlns:xlink="http://www.w3.org/1999/xlink"><g transform="matrix(.013,0,0,-0.013,0,0)"><path d="M478 372C478 418 458 448 431 448C409 448 389 431 389 410C389 404 391 400 394 395C398 388 406 371 406 348C406 253 308 122 251 51H249C254 122 249 257 231 336C212 421 189 448 159 448C126 448 75 412 23 327L48 306C83 354 103 371 115 371C125 371 134 360 144 334C185 224 192 64 183 -19C146 -100 116 -202 110 -244L125 -261C154 -259 208 -234 222 -220C222 -194 225 -84 235 -23C247 -3 273 36 308 79C379 165 478 288 478 372Z" id="g113-225"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="501" vert-adv-y="501"></glyph.data></g><g transform="matrix(.0091,0,0,-0.0091,5.668,3.132)"><path d="M606 650H137L129 618C217 609 221 609 203 518L129 129C115 46 106 40 26 32L18 0H300L307 32C210 40 203 45 218 129L249 305H358C454 305 455 296 457 219H491L531 425H497C465 353 463 350 366 350H259L300 569C306 605 310 611 346 611H444C522 611 535 598 541 578C550 557 553 519 552 485L588 489L606 650Z" id="g50-71"></path><glyph.data ascent="3443" descent="-2856" horiz-adv-x="630" vert-adv-y="630"></glyph.data></g><g transform="matrix(.013,0,0,-0.013,15.416,0)"><path d="M535 323V373H52V323H535ZM535 138V188H52V138H535Z" id="g117-34"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="587" vert-adv-y="587"></glyph.data></g><g transform="matrix(.013,0,0,-0.013,26.678,0)"><path d="M478 372C478 418 458 448 431 448C409 448 389 431 389 410C389 404 391 400 394 395C398 388 406 371 406 348C406 253 308 122 251 51H249C254 122 249 257 231 336C212 421 189 448 159 448C126 448 75 412 23 327L48 306C83 354 103 371 115 371C125 371 134 360 144 334C185 224 192 64 183 -19C146 -100 116 -202 110 -244L125 -261C154 -259 208 -234 222 -220C222 -194 225 -84 235 -23C247 -3 273 36 308 79C379 165 478 288 478 372Z" id="g113-225"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="501" vert-adv-y="501"></glyph.data></g><g transform="matrix(.0091,0,0,-0.0091,32.346,3.132)"><path d="M620 667C620 684 593 710 552 710C515 710 459 687 409 634C360 582 334 506 320 433H247L215 400L220 388H310L259 80C224 -129 199 -161 185 -174C175 -183 160 -192 141 -192C123 -192 90 -181 75 -165C69 -158 64 -156 54 -164C39 -178 24 -195 24 -208C24 -231 61 -257 94 -257C124 -257 162 -243 209 -194C267 -134 303 -66 343 107C369 220 378 279 393 385L503 397L523 433H404C432 619 464 660 500 660C522 660 542 646 566 621C573 614 583 615 593 621C603 628 620 648 620 667Z" id="g50-103"></path><glyph.data ascent="3443" descent="-2856" horiz-adv-x="644" vert-adv-y="644"></glyph.data></g><g transform="matrix(.0065,0,0,-0.0065,37.069,5.233)"><path d="M452 139L416 148C386 81 373 77 319 77H141L282 220C372 312 414 373 414 464C414 569 332 635 240 635C181 635 132 609 101 574L42 493L70 467C98 506 143 562 209 562C280 562 324 515 324 435C324 347 261 272 197 197C148 139 89 84 34 29V0H417L452 139Z" id="g176-51"></path><glyph.data ascent="3439" descent="-2858" horiz-adv-x="494" vert-adv-y="494"></glyph.data></g><g transform="matrix(.013,0,0,-0.013,44.212,0)"><path d="M326 255C326 330 263 391 186 391S46 330 46 255S109 119 186 119S326 180 326 255ZM274 255C274 204 235 163 186 163S98 204 98 255S137 347 186 347S274 306 274 255Z" id="g117-73"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="371" vert-adv-y="371"></glyph.data></g><g transform="matrix(.013,0,0,-0.013,51.94,0)"><path d="M478 372C478 418 458 448 431 448C409 448 389 431 389 410C389 404 391 400 394 395C398 388 406 371 406 348C406 253 308 122 251 51H249C254 122 249 257 231 336C212 421 189 448 159 448C126 448 75 412 23 327L48 306C83 354 103 371 115 371C125 371 134 360 144 334C185 224 192 64 183 -19C146 -100 116 -202 110 -244L125 -261C154 -259 208 -234 222 -220C222 -194 225 -84 235 -23C247 -3 273 36 308 79C379 165 478 288 478 372Z" id="g113-225"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="501" vert-adv-y="501"></glyph.data></g><g transform="matrix(.0091,0,0,-0.0091,57.608,3.132)"><path d="M620 667C620 684 593 710 552 710C515 710 459 687 409 634C360 582 334 506 320 433H247L215 400L220 388H310L259 80C224 -129 199 -161 185 -174C175 -183 160 -192 141 -192C123 -192 90 -181 75 -165C69 -158 64 -156 54 -164C39 -178 24 -195 24 -208C24 -231 61 -257 94 -257C124 -257 162 -243 209 -194C267 -134 303 -66 343 107C369 220 378 279 393 385L503 397L523 433H404C432 619 464 660 500 660C522 660 542 646 566 621C573 614 583 615 593 621C603 628 620 648 620 667Z" id="g50-103"></path><glyph.data ascent="3443" descent="-2856" horiz-adv-x="644" vert-adv-y="644"></glyph.data></g><g transform="matrix(.0065,0,0,-0.0065,62.331,5.233)"><path d="M394 0V37C301 42 295 50 295 122V635C236 613 178 596 109 583V553L165 551C205 549 209 544 209 495V122C209 50 203 42 111 37V0H394Z" id="g176-50"></path><glyph.data ascent="3439" descent="-2858" horiz-adv-x="494" vert-adv-y="494"></glyph.data></g></svg> (purple) and <svg height="12.5338pt" id="M352" style="vertical-align:-5.529pt" version="1.1" viewbox="-0.0498162 -7.0048 68.1117 12.5338" width="68.1117pt" xmlns="http://www.w3.org/2000/svg" xmlns:xlink="http://www.w3.org/1999/xlink"><g transform="matrix(.013,0,0,-0.013,0,0)"><path d="M478 372C478 418 458 448 431 448C409 448 389 431 389 410C389 404 391 400 394 395C398 388 406 371 406 348C406 253 308 122 251 51H249C254 122 249 257 231 336C212 421 189 448 159 448C126 448 75 412 23 327L48 306C83 354 103 371 115 371C125 371 134 360 144 334C185 224 192 64 183 -19C146 -100 116 -202 110 -244L125 -261C154 -259 208 -234 222 -220C222 -194 225 -84 235 -23C247 -3 273 36 308 79C379 165 478 288 478 372Z" id="g113-225"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="501" vert-adv-y="501"></glyph.data></g><g transform="matrix(.0091,0,0,-0.0091,5.668,3.132)"><path d="M722 297H451L442 267C561 257 561 253 547 182L531 98C521 44 465 24 390 24C228 24 130 134 130 296C130 482 252 628 465 628C592 628 657 579 656 458L692 461C695 540 699 605 702 631C664 642 590 667 492 667C203 667 24 502 24 285C24 93 170 -17 368 -17C464 -17 543 11 617 28C613 43 612 68 620 106L635 182C649 255 652 258 716 268L722 297Z" id="g50-72"></path><glyph.data ascent="3443" descent="-2856" horiz-adv-x="734" vert-adv-y="734"></glyph.data></g><g transform="matrix(.013,0,0,-0.013,16.128,0)"><path d="M535 323V373H52V323H535ZM535 138V188H52V138H535Z" id="g117-34"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="587" vert-adv-y="587"></glyph.data></g><g transform="matrix(.013,0,0,-0.013,27.391,0)"><path d="M478 372C478 418 458 448 431 448C409 448 389 431 389 410C389 404 391 400 394 395C398 388 406 371 406 348C406 253 308 122 251 51H249C254 122 249 257 231 336C212 421 189 448 159 448C126 448 75 412 23 327L48 306C83 354 103 371 115 371C125 371 134 360 144 334C185 224 192 64 183 -19C146 -100 116 -202 110 -244L125 -261C154 -259 208 -234 222 -220C222 -194 225 -84 235 -23C247 -3 273 36 308 79C379 165 478 288 478 372Z" id="g113-225"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="501" vert-adv-y="501"></glyph.data></g><g transform="matrix(.0091,0,0,-0.0091,33.059,3.132)"><path d="M554 433L549 437C539 437 513 441 503 443C481 447 456 451 436 451C354 451 268 415 216 368C150 308 99 205 99 106C99 24 136 -12 165 -12C196 -12 243 14 268 33C318 70 374 118 415 181H419L395 39C374 -84 332 -149 295 -175C269 -193 245 -197 212 -197C137 -197 93 -156 76 -102C71 -87 61 -87 51 -96C36 -110 24 -130 24 -147C24 -183 76 -257 171 -257C226 -257 285 -227 323 -200C387 -155 455 -76 480 94C499 225 538 391 554 433ZM460 386C457 361 438 287 426 254C408 218 373 176 332 133C294 93 246 61 217 61C198 61 186 80 186 122C186 167 206 250 231 294C262 349 288 375 317 387C334 394 358 400 381 400C413 400 439 393 460 386Z" id="g50-104"></path><glyph.data ascent="3443" descent="-2856" horiz-adv-x="578" vert-adv-y="578"></glyph.data></g><g transform="matrix(.0065,0,0,-0.0065,38.091,5.233)"><path d="M452 139L416 148C386 81 373 77 319 77H141L282 220C372 312 414 373 414 464C414 569 332 635 240 635C181 635 132 609 101 574L42 493L70 467C98 506 143 562 209 562C280 562 324 515 324 435C324 347 261 272 197 197C148 139 89 84 34 29V0H417L452 139Z" id="g176-51"></path><glyph.data ascent="3439" descent="-2858" horiz-adv-x="494" vert-adv-y="494"></glyph.data></g><g transform="matrix(.013,0,0,-0.013,45.235,0)"><path d="M326 255C326 330 263 391 186 391S46 330 46 255S109 119 186 119S326 180 326 255ZM274 255C274 204 235 163 186 163S98 204 98 255S137 347 186 347S274 306 274 255Z" id="g117-73"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="371" vert-adv-y="371"></glyph.data></g><g transform="matrix(.013,0,0,-0.013,52.963,0)"><path d="M478 372C478 418 458 448 431 448C409 448 389 431 389 410C389 404 391 400 394 395C398 388 406 371 406 348C406 253 308 122 251 51H249C254 122 249 257 231 336C212 421 189 448 159 448C126 448 75 412 23 327L48 306C83 354 103 371 115 371C125 371 134 360 144 334C185 224 192 64 183 -19C146 -100 116 -202 110 -244L125 -261C154 -259 208 -234 222 -220C222 -194 225 -84 235 -23C247 -3 273 36 308 79C379 165 478 288 478 372Z" id="g113-225"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="501" vert-adv-y="501"></glyph.data></g><g transform="matrix(.0091,0,0,-0.0091,58.631,3.132)"><path d="M554 433L549 437C539 437 513 441 503 443C481 447 456 451 436 451C354 451 268 415 216 368C150 308 99 205 99 106C99 24 136 -12 165 -12C196 -12 243 14 268 33C318 70 374 118 415 181H419L395 39C374 -84 332 -149 295 -175C269 -193 245 -197 212 -197C137 -197 93 -156 76 -102C71 -87 61 -87 51 -96C36 -110 24 -130 24 -147C24 -183 76 -257 171 -257C226 -257 285 -227 323 -200C387 -155 455 -76 480 94C499 225 538 391 554 433ZM460 386C457 361 438 287 426 254C408 218 373 176 332 133C294 93 246 61 217 61C198 61 186 80 186 122C186 167 206 250 231 294C262 349 288 375 317 387C334 394 358 400 381 400C413 400 439 393 460 386Z" id="g50-104"></path><glyph.data ascent="3443" descent="-2856" horiz-adv-x="578" vert-adv-y="578"></glyph.data></g><g transform="matrix(.0065,0,0,-0.0065,63.664,5.233)"><path d="M394 0V37C301 42 295 50 295 122V635C236 613 178 596 109 583V553L165 551C205 549 209 544 209 495V122C209 50 203 42 111 37V0H394Z" id="g176-50"></path><glyph.data ascent="3439" descent="-2858" horiz-adv-x="494" vert-adv-y="494"></glyph.data></g></svg> (green) are generated. The circle designates a hazardous region. The tangent direction for scanning shown in the figure is orthogonal to the radial direction of the circle at <svg height="8.68572pt" id="M353" style="vertical-align:-0.0498209pt" version="1.1" viewbox="-0.0498162 -8.6359 8.15071 8.68572" width="8.15071pt" xmlns="http://www.w3.org/2000/svg" xmlns:xlink="http://www.w3.org/1999/xlink"><g transform="matrix(.013,0,0,-0.013,0,0)"><path d="M600 480C600 590 528 650 384 650H143L137 622C222 614 225 607 210 531L130 127C113 41 106 36 23 28L17 0H294L300 28C204 36 195 42 212 127L243 284L314 263C327 263 339 263 352 264C465 271 600 337 600 480ZM508 481C508 351 402 304 329 304C289 304 265 311 250 317L295 559C302 594 310 606 323 611C335 616 350 619 367 619C455 619 508 573 508 481Z" id="g113-81"></path><glyph.data ascent="3473" descent="-2876" horiz-adv-x="617" vert-adv-y="617"></glyph.data></g></svg>.</div>

Mathematical Problems in Engineering

fig5

Figure 5

Figure 5: Path Planning and Replanning for Mobile Robot Navigation on 3D Terrain: An Approach Based on Geodesic 