#ifndef ODE_RKSSP22_BRIDGE_H_
#define ODE_RKSSP22_BRIDGE_H_
#include "ode/ode_rkssp22.h"
class RxRkssp22 : public ode::OdeRkssp22 {
    t_dydt dydt_; int *full_neq_; rx_solving_options_ind *ind_; double t_stage_;
public:
    RxRkssp22(t_dydt dydt, int *full_neq, int neqOde, rx_solving_options_ind *ind, double *yp)
        : ode::OdeRkssp22((unsigned long)neqOde), dydt_(dydt), full_neq_(full_neq), ind_(ind), t_stage_(0.0)
    { set_sol_external(yp); }
protected:
    void ode_fun(double * __restrict__ solin, double * __restrict__ fout) override {
        if (ind_->err != 0) { for (unsigned long i=0;i<neq_;i++) fout[i]=0.0; return; }
        dydt_(full_neq_, t_stage_, solin, fout);
        for (unsigned long i=0;i<neq_;i++) { if (!std::isfinite(fout[i])) { ind_->err=1; for (unsigned long j=0;j<neq_;j++) fout[j]=0.0; return; } }
    }
    void step_(double dt) override {
        t_stage_ = t_; ode_fun_(sol_, k_[0]);
        for (unsigned long i=0;i<neq_;i++) soltemp_[i]=sol_[i]+dt*k_[0][i];
        t_stage_ = t_+dt; ode_fun_(soltemp_, k_[0]);
        for (unsigned long i=0;i<neq_;i++) sol_[i]=(sol_[i]+soltemp_[i]+dt*k_[0][i])/2.0;
    }
};
#endif
