Ego-Motion Estimation and Collision Detection for Omnidirectional Robots

We propose an algorithm to estimate the ego-motion of an omnidirectional robot based on a sequence of position estimates. Thereto, we derive a motion model for omnidirectional robots and an estimation procedure to fit the model to observed positions. Additionally, we show how we can benefit from the velocity estimates deriving an algorithm that recognizes situations in which a robot is blocked by an obstacle.