Sub 插补()

Dim l, K, a, B, f1, t

    x动点对起点 = 0: z动点对起点 = 0

    f1 = f × 10: t = Ts / 60000

    l = Sqr((x终点对起点 ^ 2 + z终点对起点 ^ 2))

    K = f1 × t / l

    a = Sqr((x动点对起点 - x终点对起点) ^ 2 + (z动点对起点 - z终点对起点) ^ 2)

x步长 = K × x终点对起点: z步长 = K × z终点对起点:

    B = Sqr(z步长 ^ 2 + x步长 ^ 2)

    Do Until a <= B / 2

    x动点对起点 = x动点对起点 + x步长: z动点对起点 = z动点对起点 + z步长

    a = Sqr((x动点对起点 - x终点对起点) ^ 2 + (z动点对起点 - z终点对起点) ^ 2)

    Line -Step(z步长 × 系数, x步长 × 系数), vbRed

x动点对原点 = x动点对起点 + x起点对原点: y动点对原点 = y动点对起点 + y起点对原点: z动点对原点 = z动点对起点 + z起点对原点

    Loop

End Sub