Absil, P A, Mahony, R, and Sepulchre, R. 2009. Optimization on Matrix Manifolds. Princeton, NJ: Princeton University Press.

Anderson, S, and Barfoot, T D. 2015 (28 September–2 October). Full STEAM Ahead: Exactly Sparse Gaussian Process Regression for Batch Continuous-Time Trajectory Estimation on SE(3). In: Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

Anderson, S, Barfoot, T D, Tong, C H, and Särkkä, S. 2015. Batch Nonlinear Continuous-Time Trajectory Estimation as Exactly Sparse Gaussian Process Regression. Autonomous Robots, 39(3), 221–238.Google Scholar

Arun, K S, Huang, T S, and Blostein, S D. 1987. Least-Squares Fitting of Two 3D Point Sets. IEEE Transactions on Pattern Analysis and Machine Intelligence, 9(5), 698–700.Google Scholar

Bailey, T, and Durrant-Whyte, H. 2006. Simultaneous Localisation and Mapping (SLAM): Part II State of the Art. IEEE Robotics and Automation Magazine, 13(3), 108–117.Google Scholar

Barfoot, T D, and Furgale, P T. 2014. Associating Uncertainty with Three-Dimensional Poses for Use in Estimation Problems. IEEE Transactions on Robotics, 30(3), 679–693.Google Scholar

Barfoot, T D, Forbes, J R, and Furgale, P T. 2011. Pose Estimation Using Linearized Rotations and Quaternion Algebra. Acta Astronautica, 68(1–2), 101–112.Google Scholar

Barfoot, T D, Tong, C H, and Särkkä, S. 2014 (12–16 July). Batch Continuous-Time Trajectory Estimation as Exactly Sparse Gaussian Process Regression. In: Proceedings of Robotics: Science and Systems (RSS).

Bayes, T. 1764. Essay towards Solving a Problem in the Doctrine of Chances. Philosophical Transactions of the Royal Society of London.

Besl, P J, and McKay, ND. 1992.AMethod for Registration of 3-D Shapes. IEEE Transactions on Pattern Analysis and Machine Intelligence, 14(2), 239–256.Google Scholar

Bierman, G J. 1974. Sequential Square Root Filtering and Smoothing of Discrete Linear Systems. Automatica, 10(2), 147–158.Google Scholar

Bishop, C M. 2006. Pattern Recognition and Machine Learning. Secaucus, NJ: Springer.

Box, M J. 1971. Bias in Nonlinear Estimation. Journal of the Royal Statistical Society, Series B, 33(2), 171–201.Google Scholar

Brookshire, J, and Teller, S. 2012 (July). Extrinsic Calibration from Per-Sensor Egomotion. In: Proceedings of Robotics: Science and Systems.

Brown, D C. 1958. A Solution to the General Problem of Multiple Station Analytical Stereotriangulation. RCA-MTP Data Reduction Tech. rept. 43 (or AFMTC TR 58-8). Patrick Airforce Base, Florida.

Bryson, AE. 1975. AppliedOptimal Control: Optmization, Estimation and Control. NewYork: Taylor and Francis.

Chen, C S, Hung, Y P, and Cheng, J B. 1999. RANSAC-Based DARCES: A New Approach to Fast Automatic Registration of Partially Overlapping Range Images. IEEE Transactions on Pattern Analysis and Machine Intelligence, 21(11), 1229–1234.Google Scholar

Chirikjian, G S. 2009. Stochastic Models, Information Theory, and Lie Groups: Classical Results and Geometric Methods. 2 vols. New York: Birkhauser.

Chirikjian, G S, and Kyatkin, A B. 2001. Engineering Applications of Noncommutative Harmonic Analysis: With Emphasis on Rotation and Motion Groups. Baca Raton, FL: CRC Press.

Chirikjian, G S, and Kyatkin, A B. 2016. Harmonic Analysis for Engineers and Applied Scientists. Updated and Expanded ed. New York: Dover.

Corke, P. 2011. Robotics, Vision, and Control. Springer Tracts in Advanced Robotics 73. New York: Springer.

Davenport, P B. 1965. A Vector Approach to the Algebra of Rotations with Applications. Tech. rept. X-546-65-437. NASA.

D'Eleuterio, GMT. 1985 (June). Multibody Dynamics for Space StationManipulators: Recursive Dynamics of Topological Chains. Tech. rept. SS-3. Dynacon Enterprises Ltd.

de Ruiter, A H J, and Forbes, J R. 2013. On the Solution ofWahba's Problem on SO(n). Journal of the Astronautical Sciences, 60(1), 1–31.Google Scholar

Devlin, K. 2008. The Unfinished Game: Pascal, Fermat, and the Seventeenth-Century Letter That Made the World Modern. New York: Basic Books.

Dudek, G, and Jenkin, M. 2010. Compuational Principles of Mobile Robotics. New York: Cambridge University Press.

Durrant-Whyte, H, and Bailey, T. 2006. Simultaneous Localisation and Mapping (SLAM): Part I The Essential Algorithms. IEEE Robotics and Automation Magazine, 11(3), 99–110.Google Scholar

Dyce, M. 2012. Canada between the Photograph and theMap: Aerial Photography, Geographical Vision and the State. Journal of Historical Geography, 39, 69–84.Google Scholar

Fischler, M, and Bolles, R. 1981. Random Sample Consensus: A Paradigm for Model Fitting with Applications to ImageAnalysis and Automated Cartography. Communications of ACM, 24(6), 381–395.Google Scholar

Furgale, P T. 2011. Extensions to the Visual Odometry Pipeline for the Exploration of Planetary Surfaces. PhD thesis, University of Toronto.

Furgale, P T, Tong, C H, Barfoot, T D, and Sibley, G. 2015. Continuous-Time Batch Trajectory Estimation Using Temporal Basis Functions. International Journal of Robotics Research, 34(14), 1688–1710.Google Scholar

Green, B F. 1952. The Orthogonal Approximation of an Oblique Structure in Factor Analysis. Psychometrika, 17(4), 429–440.Google Scholar

Hartley, R, and Zisserman, A. 2000. Multiple View Geometry in Computer Vision. New York: Cambridge University Press.

Hertzberg, C, Wagner, R, Frese, U, and Schröder, L. 2013. Integrating Generic Sensor Fusion Algorithms with Sound State Representations through Encapsulation of Manifolds. Information Fusion, 14(1), 57–77.Google Scholar

Holland, PW, and Welsch, R E. 1977. Robust Regression Using Iteratively Reweighted Least- Squares. Communications in Statistics – Theory and Methods, 6(9), 813–827.Google Scholar

Horn, B K P. 1987a. Closed-Form Solution of Absolute Orientation Using OrthonormalMatrices. Journal of the Optical Society of America A, 5(7), 1127–1135.Google Scholar

Horn, B K P. 1987b. Closed-Form Solution of Absolute Orientation Using Unit Quaternions. Journal of the Optical Society of America A, 4(4), 629–642.Google Scholar

Hughes, C. 1986. Spacecraft Attitude Dynamics. New York: Dover.

Jazwinski, A H. 1970. Stochastic Processes and Filtering Theory. New York: Academic.

Julier, S, and Uhlmann, J. 1996. A General Method for Approximating Nonlinear Transformations of Probability Distributions. Tech. rept. Robotics Research Group, University of Oxford.

Kaess, M, Ranganathan, A, and Dellaert, R. 2008. iSAM: Incremental Smoothing and Mapping. IEEE TRO, 24(6), 1365–1378.Google Scholar

Kaess, M, Johannsson, H, Roberts, R, Ila, V, Leonard, J J, and Dellaert, F. 2012. iSAM2: Incremental Smoothing and Mapping Using the Bayes Tree. IJRR, 31(2), 217–236.Google Scholar

Kalman, R E. 1960a. Contributions to the Theory of Optimal Control. Boletin de la Sociedad Matematica Mexicana, 5, 102–119.Google Scholar

Kalman, R E. 1960b. A New Approach to Linear Filtering and Prediction Problems. Journal of Basic Engineering, 82, 35–45.Google Scholar

Kelly, A. 2013. Mobile Robotics: Mathematics, Models, and Methods. New York: Cambridge University Press.

Klarsfeld, S, and Oteo, J A. 1989. The Baker-Campbell-Hausdorff Formula and the Convergence of the Magnus Expansion. Journal of Physics A: Mathematical and General, 22, 4565–4572.Google Scholar

Lee, T, Leok, M, and McClamroch, N H. 2008. Global Symplectic Uncertainty Propagation on SO(3). Pages 61–66 of: Proceedings of the 47th IEEE Conference on Decision and Control.

Long, AW, Wolfe, K C, Mashner, M J, and Chirikjian, G S. 2012. The Banana Distribution Is Gaussian: A Localization Study with Exponential Coordinates. In: Proceedings of Robotics: Science and Systems.

Lowe, D G. 2004. Distinctive Image Features from Scale-Invariant Keypoints. International Journal of Computer Vision, 60(2), 91–110.Google Scholar

Lu, F, and Milios, E. 1997. Globally Consistent Range Scan Alignment for Environment Mapping. Autonomous Robots, 4(4), 333–349.Google Scholar

MacTavish, K A, and Barfoot, T D. 2015 (June 3–5). At All Costs: A Comparison of Robust Cost Functions for Camera Correspondence Outliers. Pages 62–69 of: Proceedings of the 12th Conference on Computer and Robot Vision (CRV).

Madow, WF. 1949. On the Theory of Systematic Sampling, II. Annals of Mathematical Statistics, 30, 333–354.Google Scholar

Mahalanobis, P. 1936. On the Generalized Distance in Statistics. Pages 49–55 of: Proceedings of the National Institute of Science, vol. 2.Google Scholar

Matthies, L, and Shafer, S A. 1987. Error Modeling in Stereo Navigation. IEEE Journal of Robotics and Automation, 3(3), 239–248.Google Scholar

Maybeck, S. 1994. Stochastic Models, Estimation and Control. New York: Navtech Book and Software Store.

McGee, L A, and Schmidt, S F. 1985 (November). Discovery of the Kalman Filter as a Practical Tool for Aerospace and Industry. Tech. rept. NASA-TM-86847. NASA.

Murray, RM, Li, Z, and Sastry, S. 1994. AMathematical Introduction to Robotic Manipulation. Boca Raton, FL: CRC Press.

Papoulis, A. 1965. Probability, Random Variables, and Stochastic Processes. New York: McGraw-Hill.

Peretroukhin, V, Vega-Brown, W, Roy, N, and Kelly, J. 2016 (May 16–21). PROBE-GK: Predictive Robust Estimation Using Generalized Kernels. Pages 817–824 of: Proceedings of the IEEE International Conference on Robotics and Automation (ICRA).

Rasmussen, C E, and Williams, C K I. 2006. Gaussian Processes for Machine Learning. Cambridge, MA: MIT Press.

Rauch, H E, Tung, F, and Striebel, C T. 1965. Maximum Likelihood Estimates of Linear Dynamic Systems. AIAA Journal, 3(8), 1445–1450.Google Scholar

Särkkä, S. 2006. Recursive Bayesian Inference on Stochastic Differential Equations. PhDthesis, Helsinki University of Technology.

Särkkä, S. 2013. Bayesian Filtering and Smoothing. New York: Cambridge University Press.

Sastry, S. 1999. Nonlinear Systems: Analysis, Stability, and Control. New York: Springer.

Shannon, C E. 1948. A Mathematical Theory of Communication. The Bell System Technical Journal, 27, 379–423, 623–656.Google Scholar

Sherman, J, and Morrison, W J. 1949. Adjustment of an Inverse Matrix Corresponding to Changes in the Elements of a Given Column or Given Row of the Original Matrix. Annals of Mathematics and Statistics, 20, 621.Google Scholar

Sherman, J, and Morrison, W J. 1950. Adjustment of an Inverse Matrix Corresponding to a Change in One Element of a Given Matrix. Annals of Mathematics and Statistics, 21, 124– 127.Google Scholar

Sibley, G. 2006. A Sliding Window Filter for SLAM. Tech. rept. University of Southern California.

Sibley, G. 2007. Long Range Stereo Data-Fusion from Moving Platforms. PhD thesis, University of Southern California.

Sibley, G, Sukhatme, G, and Matthies, L. 2006. The Iterated Sigma Point Kalman Filter with Applications to Long-Range Stereo. In: Proceedings of Robotics: Science and Systems.

Simon, D. 2006. Optimal State Estimation: Kalman, H Infinity, and Nonlinear Approaches. Hoboken, NJ: Wiley-Interscience.

Smith, P, Drummond, T, and Roussopoulos, K. 2003. Computing MAP Trajectories by Representing, Propagating, and Combining PDFs over Groups. Pages 1–8 of: Proceedings of the IEEE International Conference on Computer Vision.

Smith, R C, Self, M, and Cheeseman, P. 1990. Estimating Uncertain Spatial Relationships in Robotics. Pages 167–193 of: Cox, I J, and Wilfong, G T (eds.), Autonomous Robot Vehicles. New York: Springer.

Stengel, R F. 1994. Optimal Control and Estimation. New York: Dover.

Stillwell, J. 2008. Naive Lie Theory. New York: Springer.

Stuelpnagel, J. 1964. On the Parameterization of the Three-Dimensional RotationGroupM. SIA. Review, 6(4), 422–430.Google Scholar

Su, S F, and Lee, C S G. 1991. Uncertainty Manipulation and Propagation and Verification of Applicability of Actions in Assembly Tasks. Pages 2471–2476 of: Proceedings of the IEEE International Conference on Robotics and Automation, vol. 3.Google Scholar

Su, S F, and Lee, C S G. 1992. Manipulation and Propagation of Uncertainty and Verification of Applicability of Actions in Assembly Tasks. IEEE Transactions on Systems, Man, and Cybernetics, 22(6), 1376–1389.Google Scholar

Thrun, S, and Montemerlo, M. 2005. The GraphSLAM Algorithm with Applications to Large- Scale Mapping of Urban Structures. International Journal on Robotics Research, 25(5/6), 403–430.Google Scholar

Thrun, S, Fox, D, Burgard, W, and Dellaert, F. 2001. Robust Monte Carlo Localization for Mobile Robots. Artificial Intelligence, 128(1–2), 99–141.Google Scholar

Thrun, S, Burgard, W, and Fox, D. 2006. Probabilistic Robotics. Cambridge, MA: MIT Press.

Tong, C H, Furgale, P T, and Barfoot, T D. 2013. Gaussian Process Gauss-Newton for Non- Parametric Simultaneous Localization and Mapping. International Journal of Robotics Research, 32(5), 507–525.Google Scholar

Triggs, W, McLauchlan, P, Hartley, R, and Fitzgibbon, A. 2000. Bundle Adjustment: A Modern Synthesis. Pages 298–375 of: Triggs, W, Zisserman, A, and Szeliski, R (eds.), Vision Algorithms: Theory and Practice. New York: Springer.

Umeyama, S. 1991. Least-Squares Estimation of Transformation Parameters between Two Point Patterns. IEEE Transactions on Pattern Analysis and Machine Intelligence, 13(4), 376–380.Google Scholar

Wahba, G. 1965. A Least-Squares Estimate of Spacecraft Attitude. SIAM Review, 7(3), 409.Google Scholar

Wang, Y, and Chirikjian, G S. 2006. Error Propagation on the Euclidean Group with Applications to Manipulator Kinematics. IEEE Transactions on Robotics, 22(4), 591–602.Google Scholar

Wang, Y, and Chirikjian, G S. 2008. Nonparametric Second-Order Theory of Error Propagation on Motion Groups. International Journal of Robotics Research, 27(11), 1258– 1273.Google Scholar

Wolfe, K, Mashner, M, and Chirikjian, G. 2011. Bayesian Fusion on Lie Groups. Journal of Algebraic Statistics, 2(1), 75–97.Google Scholar

Woodbury, MA. 1950. InvertingModifiedMatrices. Tech. rept. 42. Statistical Research Group, Princeton University.

Yan, X, Indelman, V, and Boots, B. 2014. Incremental Sparse GP Regression for Continuous- Time Trajectory Estimation and Mapping. In: Proceedings of the NIPS Workshop on Autonomously Learning Robots.

Zhang, Z. 1997. Parameter Estimation Techniques: A Tutorial with Application to Conic Fitting. Image and Vision Computing, 15(1), 59–76.Google Scholar