用Python求解二阶常微分方程组的RungeKutta四阶解

Question

本文试图用龙格库塔四阶法数值求解两个常微分方程组。 初始系统： 要解决的系统：

我有非常奇怪的解图。。。 我有：

正确的图形：

我在我的龙格库塔找不到麻烦。请帮帮我。在

我的代码在这里：

dt = 0.04

#initial conditions
t.append(0)
zdot.append(0)
z.append(A)
thetadot.append(0)
theta.append(B)

#derrive functions
def zdotdot(z_cur, theta_cur):
   return -omega_z * z_cur - epsilon / 2 / m * theta_cur
def thetadotdot(z_cur, theta_cur):
   return -omega_theta * theta_cur - epsilon / 2 / I * z_cur 
i = 0
while True:
    # runge_kutta
    k1_zdot = zdotdot(z[i], theta[i])
    k1_thetadot = thetadotdot(z[i], theta[i])

    k2_zdot = zdotdot(z[i] + dt/2 * k1_zdot, theta[i])
    k2_thetadot = thetadotdot(z[i], theta[i]  + dt/2 * k1_thetadot)

    k3_zdot = zdotdot(z[i] + dt/2 * k2_zdot, theta[i])
    k3_thetadot = thetadotdot(z[i], theta[i]  + dt/2 * k2_thetadot)

    k4_zdot = zdotdot(z[i] + dt * k3_zdot, theta[i])
    k4_thetadot = thetadotdot(z[i], theta[i]  + dt * k3_thetadot)

    zdot.append (zdot[i] + (k1_zdot + 2*k2_zdot + 2*k3_zdot + k4_zdot) * dt / 6)
    thetadot.append (thetadot[i] + (k1_thetadot + 2*k2_thetadot + 2*k3_thetadot + k4_thetadot) * dt / 6)

    z.append (z[i] + zdot[i + 1] * dt)
    theta.append (theta[i] + thetadot[i + 1] * dt)
    i += 1

Answer 1

您的状态有4个组件，因此每个阶段需要4个斜坡。应该很明显，z的斜率/更新不能来自k1_zdot，它必须是{}，这是之前要计算的

k1_z = zdot

在下一阶段

^{pr2}$

等等

---

但最好是使用矢量化接口

def derivs(t,u):
    z, theta, dz, dtheta = u
    ddz = -omega_z * z - epsilon / 2 / m * theta
    ddtheta = -omega_theta * theta - epsilon / 2 / I * z 
    return np.array([dz, dtheta, ddz, ddtheta]);

然后使用RK4的标准公式

i = 0
while True:
    # runge_kutta
    k1 = derivs(t[i], u[i])
    k2 = derivs(t[i] + dt/2, u[i] + dt/2 * k1)
    k3 = derivs(t[i] + dt/2, u[i] + dt/2 * k2)
    k4 = derivs(t[i] + dt, u[i] + dt * k3)

    u.append (u[i] + (k1 + 2*k2 + 2*k3 + k4) * dt / 6)
    i += 1

然后将其解包为

z, theta, dz, dtheta = np.asarray(u).T