Python 如何在已知点的方向上插值新点

我试图从三维空间中的已知点插值一个新点。我试着加一个任意数，然后乘以单位向量。但我的新观点太远了，方向也不正确

p = frame[7]  
d = math.sqrt( (p[0])**2 + (p[1])**2 + (p[2])**2)
unit = p/d
new_px = p[0] + 0.04
new_py = p[1] + 0.04
new_pz = p[2] + 0.04
new = np.array([new_px, new_py, new_pz], dtype = np.float32)
new = new * (unit)
s[i_s,i_f,21,:] = new