oxiphysics_gpu/kernels/rigid/
semiimpliciteulerkernel_traits.rs1use crate::compute::ComputeKernel;
11
12use super::types::SemiImplicitEulerKernel;
13
14impl ComputeKernel for SemiImplicitEulerKernel {
15 fn name(&self) -> &str {
16 "SemiImplicitEulerKernel"
17 }
18 fn execute(&self, inputs: &[&[f64]], outputs: &mut [Vec<f64>], work_size: usize) {
19 if inputs.len() < 5 || outputs.len() < 2 {
20 return;
21 }
22 let pos = inputs[0];
23 let vel = inputs[1];
24 let force = inputs[2];
25 let inv_mass = inputs[3];
26 let dt = inputs[4][0];
27 let n = work_size;
28 let mut new_vel = vec![0.0; n * 3];
29 let mut new_pos = vec![0.0; n * 3];
30 for i in 0..n {
31 let im = inv_mass[i];
32 new_vel[i * 3] = vel[i * 3] + force[i * 3] * im * dt;
33 new_vel[i * 3 + 1] = vel[i * 3 + 1] + force[i * 3 + 1] * im * dt;
34 new_vel[i * 3 + 2] = vel[i * 3 + 2] + force[i * 3 + 2] * im * dt;
35 new_pos[i * 3] = pos[i * 3] + new_vel[i * 3] * dt;
36 new_pos[i * 3 + 1] = pos[i * 3 + 1] + new_vel[i * 3 + 1] * dt;
37 new_pos[i * 3 + 2] = pos[i * 3 + 2] + new_vel[i * 3 + 2] * dt;
38 }
39 outputs[0] = new_vel;
40 outputs[1] = new_pos;
41 }
42}