Function kidou::orbit::calc::integrate::total_energy

fn total_energy(
    r: F, 
    psi: F, 
    z: F, 
    p_r: F, 
    p_psi: F, 
    p_z: F, 
    model: &dyn Model
) -> F

Calculate the value of total energy E $[ \text{km}^2 \, \text{s}^{-2} ]$