Factor Graph Modeling of Rigid‐body Dynamics for Localization, Mapping, and Parameter Estimation of a Spinning Object in Space
- 15 December 2014
- journal article
- research article
- Published by Wiley in Journal of Field Robotics
- Vol. 32 (6) , 897-933
Abstract
This paper presents a new approach for solving the simultaneous localization and mapping problem for inspecting an unknown and uncooperative object that is spinning about an arbitrary axis in space. This approach probabilistically models the six degree‐of‐freedom rigid‐body dynamics in a factor graph formulation. Using the incremental smoothing and mapping system, this method estimates a feature‐based map of the target object, as well as this object's position, orientation, linear velocity, angular velocity, center of mass, principal axes, and ratios of inertia. This solves an important problem for spacecraft proximity operations. Additionally, it provides a generic framework for incorporating rigid‐body dynamics that may be applied to a number of other terrestrial‐based applications. To evaluate this approach, the Synchronized Position Hold Engage Reorient Experimental Satellites (SPHERES) were used as a testbed within the microgravity environment of the International Space Station. The SPHERES satellites, using body‐mounted stereo cameras, captured a dataset of a target object that was spinning at ten rotations per minute about its unstable, intermediate axis. This dataset was used to experimentally evaluate the approach described in this paper, and it showed that it was able to estimate a geometric map and the position, orientation, linear and angular velocities, center of mass, and ratios of inertia of the target object.Keywords
Funding Information
- Defense Advanced Research Projects Agency (NNH11CC25C)
This publication has 26 references indexed in Scilit:
- Information fusion in navigation systems via factor graph based incremental smoothingRobotics and Autonomous Systems, 2013
- SPHERES flight operations testing and executionActa Astronautica, 2009
- Estimation of a Spacecraft's Attitude Dynamics Parameters by Using Flight DataJournal of Guidance, Control, and Dynamics, 2005
- Unscented Filtering and Nonlinear EstimationProceedings of the IEEE, 2004
- Simultaneous Localization and Mapping with Sparse Extended Information FiltersThe International Journal of Robotics Research, 2004
- Attitude Error Representations for Kalman FilteringJournal of Guidance, Control, and Dynamics, 2003
- Correctness of Belief Propagation in Gaussian Graphical Models of Arbitrary TopologyNeural Computation, 2001
- Mass Property Estimation Using Coasting ManeuversJournal of Guidance, Control, and Dynamics, 1997
- Complete Orthogonal Decomposition for Weighted Least SquaresSIAM Journal on Matrix Analysis and Applications, 1997
- Closed-form solution of absolute orientation using unit quaternionsJournal of the Optical Society of America A, 1987