Tim D. Barfoot Christopher M. Clark 65-78 2004 46 Robotics and Autonomous Systems 2 http://dx.doi.org/10.1016/j.robot.2003.11.004 db/journals/ras/ras46.html#BarfootC04