Marginalized Point Mass Filter with Estimating Tidal Depth Bias for Underwater Terrain-Aided Navigation

<div>Horizontal position errors from two filters and tidal depth bias estimate from marginalized PMF for a single run with tidal depth bias in area B: (a) horizontal position error with <svg height="12.5794pt" id="M149" style="vertical-align:-3.29107pt" version="1.1" viewbox="-0.0498162 -9.28833 39.352 12.5794" width="39.352pt" 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="M494 514C482 587 419 712 303 712C238 712 174 667 174 603C174 561 205 514 249 449C219 438 187 422 162 407C93 366 23 283 23 177C23 69 87 -12 190 -12C244 -12 288 5 328 33C406 87 444 170 444 249C444 329 404 391 331 475C265 550 222 605 222 627C222 647 238 657 267 657C355 657 421 585 484 499L494 514ZM359 234C359 143 319 30 219 30C172 30 114 75 114 178C114 275 163 343 195 378C212 397 241 415 269 425C305 382 359 313 359 234Z"></path></g><g transform="matrix(.013,0,0,-0.013,6.722,0)"><path d="M475 445L452 468C423 436 401 426 385 426S352 427 305 436C268 443 216 448 185 448C156 448 128 425 102 382C89 360 77 338 64 304L89 291C117 340 143 380 190 380C214 380 268 376 295 373C320 370 344 371 362 374L70 101C32 65 23 36 23 18C23 5 27 -3 31 -8C36 -8 39 -6 42 -1C52 15 67 31 80 40S110 49 143 33C195 8 257 -20 290 -20C339 -20 382 11 439 129L416 148C366 74 334 55 305 55C278 55 236 68 203 81C169 94 141 100 122 96C205 170 348 308 411 376L475 445Z"></path></g><g transform="matrix(.0091,0,0,-0.0091,12.871,3.132)"><path d="M485 418C485 434 469 451 441 451C389 451 312 387 255 335C221 304 194 278 159 242H157L259 678C264 698 264 710 255 710C242 710 183 681 96 673L90 643L128 642C165 641 171 640 162 602L24 -5L31 -12C51 -4 81 4 110 9L145 181C154 195 180 220 205 242C233 170 263 106 291 53C318 1 335 -12 360 -12C383 -12 425 0 483 82L463 105C437 79 411 57 400 57C388 57 378 68 355 110C329 156 288 244 268 298C299 333 355 376 405 376C426 376 440 373 448 368C453 365 465 368 468 373C477 386 485 405 485 418Z"></path></g><g transform="matrix(.013,0,0,-0.013,21.65,0)"><path d="M535 323V373H52V323H535ZM535 138V188H52V138H535Z"></path></g><g transform="matrix(.013,0,0,-0.013,32.913,0)"><path d="M384 0V27C293 34 287 42 287 114V635C232 613 172 594 109 583V559L157 557C201 555 205 550 205 499V114C205 42 199 34 109 27V0H384Z"></path></g></svg> m; (b) tidal depth bias estimate with <svg height="12.5794pt" id="M150" style="vertical-align:-3.29107pt" version="1.1" viewbox="-0.0498162 -9.28833 39.352 12.5794" width="39.352pt" 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="M494 514C482 587 419 712 303 712C238 712 174 667 174 603C174 561 205 514 249 449C219 438 187 422 162 407C93 366 23 283 23 177C23 69 87 -12 190 -12C244 -12 288 5 328 33C406 87 444 170 444 249C444 329 404 391 331 475C265 550 222 605 222 627C222 647 238 657 267 657C355 657 421 585 484 499L494 514ZM359 234C359 143 319 30 219 30C172 30 114 75 114 178C114 275 163 343 195 378C212 397 241 415 269 425C305 382 359 313 359 234Z"></path></g><g transform="matrix(.013,0,0,-0.013,6.722,0)"><path d="M475 445L452 468C423 436 401 426 385 426S352 427 305 436C268 443 216 448 185 448C156 448 128 425 102 382C89 360 77 338 64 304L89 291C117 340 143 380 190 380C214 380 268 376 295 373C320 370 344 371 362 374L70 101C32 65 23 36 23 18C23 5 27 -3 31 -8C36 -8 39 -6 42 -1C52 15 67 31 80 40S110 49 143 33C195 8 257 -20 290 -20C339 -20 382 11 439 129L416 148C366 74 334 55 305 55C278 55 236 68 203 81C169 94 141 100 122 96C205 170 348 308 411 376L475 445Z"></path></g><g transform="matrix(.0091,0,0,-0.0091,12.871,3.132)"><path d="M485 418C485 434 469 451 441 451C389 451 312 387 255 335C221 304 194 278 159 242H157L259 678C264 698 264 710 255 710C242 710 183 681 96 673L90 643L128 642C165 641 171 640 162 602L24 -5L31 -12C51 -4 81 4 110 9L145 181C154 195 180 220 205 242C233 170 263 106 291 53C318 1 335 -12 360 -12C383 -12 425 0 483 82L463 105C437 79 411 57 400 57C388 57 378 68 355 110C329 156 288 244 268 298C299 333 355 376 405 376C426 376 440 373 448 368C453 365 465 368 468 373C477 386 485 405 485 418Z"></path></g><g transform="matrix(.013,0,0,-0.013,21.65,0)"><path d="M535 323V373H52V323H535ZM535 138V188H52V138H535Z"></path></g><g transform="matrix(.013,0,0,-0.013,32.913,0)"><path d="M384 0V27C293 34 287 42 287 114V635C232 613 172 594 109 583V559L157 557C201 555 205 550 205 499V114C205 42 199 34 109 27V0H384Z"></path></g></svg> m; (c) horizontal position error with <svg height="12.5794pt" id="M151" style="vertical-align:-3.29107pt" version="1.1" viewbox="-0.0498162 -9.28833 39.352 12.5794" width="39.352pt" 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="M494 514C482 587 419 712 303 712C238 712 174 667 174 603C174 561 205 514 249 449C219 438 187 422 162 407C93 366 23 283 23 177C23 69 87 -12 190 -12C244 -12 288 5 328 33C406 87 444 170 444 249C444 329 404 391 331 475C265 550 222 605 222 627C222 647 238 657 267 657C355 657 421 585 484 499L494 514ZM359 234C359 143 319 30 219 30C172 30 114 75 114 178C114 275 163 343 195 378C212 397 241 415 269 425C305 382 359 313 359 234Z"></path></g><g transform="matrix(.013,0,0,-0.013,6.722,0)"><path d="M475 445L452 468C423 436 401 426 385 426S352 427 305 436C268 443 216 448 185 448C156 448 128 425 102 382C89 360 77 338 64 304L89 291C117 340 143 380 190 380C214 380 268 376 295 373C320 370 344 371 362 374L70 101C32 65 23 36 23 18C23 5 27 -3 31 -8C36 -8 39 -6 42 -1C52 15 67 31 80 40S110 49 143 33C195 8 257 -20 290 -20C339 -20 382 11 439 129L416 148C366 74 334 55 305 55C278 55 236 68 203 81C169 94 141 100 122 96C205 170 348 308 411 376L475 445Z"></path></g><g transform="matrix(.0091,0,0,-0.0091,12.871,3.132)"><path d="M485 418C485 434 469 451 441 451C389 451 312 387 255 335C221 304 194 278 159 242H157L259 678C264 698 264 710 255 710C242 710 183 681 96 673L90 643L128 642C165 641 171 640 162 602L24 -5L31 -12C51 -4 81 4 110 9L145 181C154 195 180 220 205 242C233 170 263 106 291 53C318 1 335 -12 360 -12C383 -12 425 0 483 82L463 105C437 79 411 57 400 57C388 57 378 68 355 110C329 156 288 244 268 298C299 333 355 376 405 376C426 376 440 373 448 368C453 365 465 368 468 373C477 386 485 405 485 418Z"></path></g><g transform="matrix(.013,0,0,-0.013,21.65,0)"><path d="M535 323V373H52V323H535ZM535 138V188H52V138H535Z"></path></g><g transform="matrix(.013,0,0,-0.013,32.913,0)"><path d="M412 140C382 77 369 73 315 73H129L270 222C362 320 402 379 402 466C402 571 322 635 234 635C177 635 130 609 99 576L42 495L64 475C90 514 133 568 201 568C274 568 318 519 318 435C318 349 255 267 193 193C144 135 87 78 32 23V0H405C417 45 427 89 440 131L412 140Z"></path></g></svg> m; (d) tidal depth bias estimate with <svg height="12.5794pt" id="M152" style="vertical-align:-3.29107pt" version="1.1" viewbox="-0.0498162 -9.28833 39.352 12.5794" width="39.352pt" 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="M494 514C482 587 419 712 303 712C238 712 174 667 174 603C174 561 205 514 249 449C219 438 187 422 162 407C93 366 23 283 23 177C23 69 87 -12 190 -12C244 -12 288 5 328 33C406 87 444 170 444 249C444 329 404 391 331 475C265 550 222 605 222 627C222 647 238 657 267 657C355 657 421 585 484 499L494 514ZM359 234C359 143 319 30 219 30C172 30 114 75 114 178C114 275 163 343 195 378C212 397 241 415 269 425C305 382 359 313 359 234Z"></path></g><g transform="matrix(.013,0,0,-0.013,6.722,0)"><path d="M475 445L452 468C423 436 401 426 385 426S352 427 305 436C268 443 216 448 185 448C156 448 128 425 102 382C89 360 77 338 64 304L89 291C117 340 143 380 190 380C214 380 268 376 295 373C320 370 344 371 362 374L70 101C32 65 23 36 23 18C23 5 27 -3 31 -8C36 -8 39 -6 42 -1C52 15 67 31 80 40S110 49 143 33C195 8 257 -20 290 -20C339 -20 382 11 439 129L416 148C366 74 334 55 305 55C278 55 236 68 203 81C169 94 141 100 122 96C205 170 348 308 411 376L475 445Z"></path></g><g transform="matrix(.0091,0,0,-0.0091,12.871,3.132)"><path d="M485 418C485 434 469 451 441 451C389 451 312 387 255 335C221 304 194 278 159 242H157L259 678C264 698 264 710 255 710C242 710 183 681 96 673L90 643L128 642C165 641 171 640 162 602L24 -5L31 -12C51 -4 81 4 110 9L145 181C154 195 180 220 205 242C233 170 263 106 291 53C318 1 335 -12 360 -12C383 -12 425 0 483 82L463 105C437 79 411 57 400 57C388 57 378 68 355 110C329 156 288 244 268 298C299 333 355 376 405 376C426 376 440 373 448 368C453 365 465 368 468 373C477 386 485 405 485 418Z"></path></g><g transform="matrix(.013,0,0,-0.013,21.65,0)"><path d="M535 323V373H52V323H535ZM535 138V188H52V138H535Z"></path></g><g transform="matrix(.013,0,0,-0.013,32.913,0)"><path d="M412 140C382 77 369 73 315 73H129L270 222C362 320 402 379 402 466C402 571 322 635 234 635C177 635 130 609 99 576L42 495L64 475C90 514 133 568 201 568C274 568 318 519 318 435C318 349 255 267 193 193C144 135 87 78 32 23V0H405C417 45 427 89 440 131L412 140Z"></path></g></svg> m.</div>

Journal of Sensors

fig9

Figure 9

Figure 9: Marginalized Point Mass Filter with Estimating Tidal Depth Bias for Underwater Terrain-Aided Navigation 