Abstract: The innovation of this paper is that a mathematical model of 3-D trajectory prediction is proposed and studied, based on 2-D trajectory prediction algorithm.And 3-D trajectory prediction algorithm is applied to object tracking system, in order to fast and efficient tracking.A large number of experiments are done by MALTAB.By comparing the test results, prediction trajectory is consistent with actual trajectory.