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.