Solved a problem in the compensation of the ego-motion.