conspire/math/integrate/dae/explicit/variable_step/verner_8/
mod.rs1use crate::math::{
2 Scalar, Tensor, TensorVec,
3 integrate::{ExplicitDaeVariableStepExplicit, ode::explicit::variable_step::verner_8::*},
4};
5use std::ops::{Mul, Sub};
6
7impl<Y, Z, U, V> ExplicitDaeVariableStepExplicit<Y, Z, U, V> for Verner8
8where
9 Y: Tensor,
10 Z: Tensor,
11 U: TensorVec<Item = Y>,
12 V: TensorVec<Item = Z>,
13 for<'a> &'a Y: Mul<Scalar, Output = Y> + Sub<&'a Y, Output = Y>,
14{
15 fn slopes_solve(
16 mut evolution: impl FnMut(Scalar, &Y, &Z) -> Result<Y, String>,
17 mut solution: impl FnMut(Scalar, &Y, &Z) -> Result<Z, String>,
18 y: &Y,
19 z: &Z,
20 t: Scalar,
21 dt: Scalar,
22 k: &mut [Y],
23 y_trial: &mut Y,
24 z_trial: &mut Z,
25 ) -> Result<(), String> {
26 k[0] = evolution(t, y, z)?;
27 *y_trial = &k[0] * (A_2_1 * dt) + y;
28 *z_trial = solution(t + C_2 * dt, y_trial, z)?;
29 k[1] = evolution(t + C_2 * dt, y_trial, z_trial)?;
30 *y_trial = &k[0] * (A_3_1 * dt) + &k[1] * (A_3_2 * dt) + y;
31 *z_trial = solution(t + C_3 * dt, y_trial, z_trial)?;
32 k[2] = evolution(t + C_3 * dt, y_trial, z_trial)?;
33 *y_trial = &k[0] * (A_4_1 * dt) + &k[2] * (A_4_3 * dt) + y;
34 *z_trial = solution(t + C_4 * dt, y_trial, z_trial)?;
35 k[3] = evolution(t + C_4 * dt, y_trial, z_trial)?;
36 *y_trial = &k[0] * (A_5_1 * dt) + &k[2] * (A_5_3 * dt) + &k[3] * (A_5_4 * dt) + y;
37 *z_trial = solution(t + C_5 * dt, y_trial, z_trial)?;
38 k[4] = evolution(t + C_5 * dt, y_trial, z_trial)?;
39 *y_trial = &k[0] * (A_6_1 * dt) + &k[3] * (A_6_4 * dt) + &k[4] * (A_6_5 * dt) + y;
40 *z_trial = solution(t + C_6 * dt, y_trial, z_trial)?;
41 k[5] = evolution(t + C_6 * dt, y_trial, z_trial)?;
42 *y_trial = &k[0] * (A_7_1 * dt)
43 + &k[3] * (A_7_4 * dt)
44 + &k[4] * (A_7_5 * dt)
45 + &k[5] * (A_7_6 * dt)
46 + y;
47 *z_trial = solution(t + C_7 * dt, y_trial, z_trial)?;
48 k[6] = evolution(t + C_7 * dt, y_trial, z_trial)?;
49 *y_trial = &k[0] * (A_8_1 * dt)
50 + &k[3] * (A_8_4 * dt)
51 + &k[4] * (A_8_5 * dt)
52 + &k[5] * (A_8_6 * dt)
53 + &k[6] * (A_8_7 * dt)
54 + y;
55 *z_trial = solution(t + C_8 * dt, y_trial, z_trial)?;
56 k[7] = evolution(t + C_8 * dt, y_trial, z_trial)?;
57 *y_trial = &k[0] * (A_9_1 * dt)
58 + &k[3] * (A_9_4 * dt)
59 + &k[4] * (A_9_5 * dt)
60 + &k[5] * (A_9_6 * dt)
61 + &k[6] * (A_9_7 * dt)
62 + &k[7] * (A_9_8 * dt)
63 + y;
64 *z_trial = solution(t + C_9 * dt, y_trial, z_trial)?;
65 k[8] = evolution(t + C_9 * dt, y_trial, z_trial)?;
66 *y_trial = &k[0] * (A_10_1 * dt)
67 + &k[3] * (A_10_4 * dt)
68 + &k[4] * (A_10_5 * dt)
69 + &k[5] * (A_10_6 * dt)
70 + &k[6] * (A_10_7 * dt)
71 + &k[7] * (A_10_8 * dt)
72 + &k[8] * (A_10_9 * dt)
73 + y;
74 *z_trial = solution(t + C_10 * dt, y_trial, z_trial)?;
75 k[9] = evolution(t + C_10 * dt, y_trial, z_trial)?;
76 *y_trial = &k[0] * (A_11_1 * dt)
77 + &k[3] * (A_11_4 * dt)
78 + &k[4] * (A_11_5 * dt)
79 + &k[5] * (A_11_6 * dt)
80 + &k[6] * (A_11_7 * dt)
81 + &k[7] * (A_11_8 * dt)
82 + &k[8] * (A_11_9 * dt)
83 + &k[9] * (A_11_10 * dt)
84 + y;
85 *z_trial = solution(t + C_11 * dt, y_trial, z_trial)?;
86 k[10] = evolution(t + C_11 * dt, y_trial, z_trial)?;
87 *y_trial = &k[0] * (A_12_1 * dt)
88 + &k[3] * (A_12_4 * dt)
89 + &k[4] * (A_12_5 * dt)
90 + &k[5] * (A_12_6 * dt)
91 + &k[6] * (A_12_7 * dt)
92 + &k[7] * (A_12_8 * dt)
93 + &k[8] * (A_12_9 * dt)
94 + &k[9] * (A_12_10 * dt)
95 + &k[10] * (A_12_11 * dt)
96 + y;
97 *z_trial = solution(t + dt, y_trial, z_trial)?;
98 k[11] = evolution(t + dt, y_trial, z_trial)?;
99 *y_trial = &k[0] * (A_13_1 * dt)
100 + &k[3] * (A_13_4 * dt)
101 + &k[4] * (A_13_5 * dt)
102 + &k[5] * (A_13_6 * dt)
103 + &k[6] * (A_13_7 * dt)
104 + &k[7] * (A_13_8 * dt)
105 + &k[8] * (A_13_9 * dt)
106 + &k[9] * (A_13_10 * dt)
107 + y;
108 *z_trial = solution(t + dt, y_trial, z_trial)?;
109 k[12] = evolution(t + dt, y_trial, z_trial)?;
110 *y_trial = (&k[0] * B_1
111 + &k[5] * B_6
112 + &k[6] * B_7
113 + &k[7] * B_8
114 + &k[8] * B_9
115 + &k[9] * B_10
116 + &k[10] * B_11
117 + &k[11] * B_12)
118 * dt
119 + y;
120 *z_trial = solution(t + dt, y_trial, z_trial)?;
121 Ok(())
122 }
123}