An interpolation algorithm, which is applicable to the trace of field lines or particle orbit traces in three dimensional magnetic field, etc., are presented, and a compact computer program based on the algorithm is shown. The present method is proved to be highly accurate and highly efficient through the calculation of an example function.