Salvato in:
Dettagli Bibliografici
Autori principali: Goudar, Abhishek, Dümbgen, Frederike, Barfoot, Timothy D., Schoellig, Angela P.
Natura: Preprint
Pubblicazione: 2023
Soggetti:
Accesso online:https://arxiv.org/abs/2309.09011
Tags: Aggiungi Tag
Nessun Tag, puoi essere il primo ad aggiungerne!!
_version_ 1866910289408032768
author Goudar, Abhishek
Dümbgen, Frederike
Barfoot, Timothy D.
Schoellig, Angela P.
author_facet Goudar, Abhishek
Dümbgen, Frederike
Barfoot, Timothy D.
Schoellig, Angela P.
contents Range-only (RO) pose estimation involves determining a robot's pose over time by measuring the distance between multiple devices on the robot, known as tags, and devices installed in the environment, known as anchors. The nonconvex nature of the range measurement model results in a cost function with possible local minima. In the absence of a good initialization, commonly used iterative solvers can get stuck in these local minima resulting in poor trajectory estimation accuracy. In this work, we propose convex relaxations to the original nonconvex problem based on semidefinite programs (SDPs). Specifically, we formulate computationally tractable SDP relaxations to obtain accurate initial pose and trajectory estimates for RO trajectory estimation under static and dynamic (i.e., constant-velocity motion) conditions. Through simulation and real experiments, we demonstrate that our proposed initialization strategies estimate the initial state accurately compared to iterative local solvers. Additionally, the proposed relaxations recover global minima under moderate range measurement noise levels.
format Preprint
id arxiv_https___arxiv_org_abs_2309_09011
institution arXiv
publishDate 2023
record_format arxiv
spellingShingle Optimal Initialization Strategies for Range-Only Trajectory Estimation
Goudar, Abhishek
Dümbgen, Frederike
Barfoot, Timothy D.
Schoellig, Angela P.
Robotics
Range-only (RO) pose estimation involves determining a robot's pose over time by measuring the distance between multiple devices on the robot, known as tags, and devices installed in the environment, known as anchors. The nonconvex nature of the range measurement model results in a cost function with possible local minima. In the absence of a good initialization, commonly used iterative solvers can get stuck in these local minima resulting in poor trajectory estimation accuracy. In this work, we propose convex relaxations to the original nonconvex problem based on semidefinite programs (SDPs). Specifically, we formulate computationally tractable SDP relaxations to obtain accurate initial pose and trajectory estimates for RO trajectory estimation under static and dynamic (i.e., constant-velocity motion) conditions. Through simulation and real experiments, we demonstrate that our proposed initialization strategies estimate the initial state accurately compared to iterative local solvers. Additionally, the proposed relaxations recover global minima under moderate range measurement noise levels.
title Optimal Initialization Strategies for Range-Only Trajectory Estimation
topic Robotics
url https://arxiv.org/abs/2309.09011