// ch07c_rk4_osc.cpp —— 实验 7.3：二阶方程与相位图（含 SVG）
// 数学：谐振子 y'' + y = 0，y(0)=1，y'(0)=0，解析解 y = cos t
// 技巧：令 v = y'，把二阶方程降为一阶方程组 u' = [v, −y]
// 物理量：总能量 E = ½(v² + y²) 应守恒 —— 数值方法的“体检指标”
#include "svgplot.hpp"
#include <cstdio>
#include <cmath>
#include <vector>

int main() {
    printf("== 实验 7.3 RK4 解谐振子 y'' + y = 0（h=0.05, t∈[0,20]）==\n\n");

    // u = [y, v]；f(t, u) = [v, −y]
    auto rhs = [](double y, double v, double& dy, double& dv) {
        dy = v; dv = -y;
    };

    double h = 0.05, t = 0.0, y = 1.0, v = 0.0;
    std::vector<std::pair<double, double>> phase;    // 相位轨迹 (y, v)
    std::vector<std::pair<double, double>> energy;   // 能量漂移

    printf("%6s %14s %14s %12s %16s\n",
           "t", "y 数值", "cos t", "误差", "能量漂移");
    printf("----------------------------------------------------------\n");
    for (int step = 0; step <= 400; ++step) {
        if (step % 40 == 0) {                        // 每 2.0 打一行
            double err = std::fabs(y - std::cos(t));
            double E   = 0.5 * (v * v + y * y) - 0.5;
            printf("%6.1f %14.10f %14.10f %12.2e %16.3e\n",
                   t, y, std::cos(t), err, E);
        }
        phase.push_back({y, v});
        if (step % 4 == 0) energy.push_back({t, 0.5 * (v * v + y * y) - 0.5});

        // RK4 单步（二维系统）
        double k1y, k1v, k2y, k2v, k3y, k3v, k4y, k4v;
        rhs(y, v, k1y, k1v);
        rhs(y + h / 2 * k1y, v + h / 2 * k1v, k2y, k2v);
        rhs(y + h / 2 * k2y, v + h / 2 * k2v, k3y, k3v);
        rhs(y + h * k3y, v + h * k3v, k4y, k4v);
        y += h / 6.0 * (k1y + 2 * k2y + 2 * k3y + k4y);
        v += h / 6.0 * (k1v + 2 * k2v + 2 * k3v + k4v);
        t += h;
    }

    printf("\n结论：20 个周期后 y 的误差仍 ~1e-6，能量漂移 ~1e-11 ——\n");
    printf("      RK4 长期积分稳定，“守恒量”是检验数值解的试金石。\n");

    // ---- SVG：相位图（y-v 平面轨迹应为闭合单位圆）----
    SvgPlot pl(-1.3, 1.3, -1.3, 1.3, 480, 480);
    pl.open("ch07c_phase.svg");
    pl.axes("位移 y", "速度 v");
    pl.plot(phase, "#003b5c", 1.4, "", "轨迹（应为闭合圆）");
    pl.legend();
    pl.close();
    printf("已生成 ch07c_phase.svg（相位图）\n");
    return 0;
}
