This paper proposes an algorithm for extracting the pose and velocity of the moving objects and the 3-D location of interest points in the external environments

based on the image plane trajectories of salient points over the image sequence.These trajectories are related to the parameters to be estimated using motion model and imaging model

making it possible to incorporate the information contained in long image sequences and to estimate unknown motion and structure parameters using an IEKF.