1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
use crate::math::{Isometry, Point, Vector};
use crate::object::{ContiguousArena, ContiguousArenaIndex};
use na::{self, RealField};
use std::sync::RwLock;
pub struct Boundary<N: RealField> {
pub positions: Vec<Point<N>>,
pub velocities: Vec<Vector<N>>,
pub volumes: Vec<N>,
pub forces: Option<RwLock<Vec<Vector<N>>>>,
}
impl<N: RealField> Boundary<N> {
pub fn new(particle_positions: Vec<Point<N>>) -> Self {
let num_particles = particle_positions.len();
let velocities = std::iter::repeat(Vector::zeros())
.take(num_particles)
.collect();
let volumes = std::iter::repeat(N::zero()).take(num_particles).collect();
Self {
positions: particle_positions,
velocities,
volumes,
forces: None,
}
}
pub fn num_particles(&self) -> usize {
self.positions.len()
}
pub fn transform_by(&mut self, pose: &Isometry<N>) {
self.positions.iter_mut().for_each(|p| *p = pose * *p);
}
pub fn apply_force(&self, i: usize, f: Vector<N>) {
if let Some(forces) = &self.forces {
let mut forces = forces.write().unwrap();
forces[i] += f;
}
}
pub fn clear_forces(&mut self, resize_buffer: bool) {
if let Some(forces) = &mut self.forces {
let forces = forces.get_mut().unwrap();
if resize_buffer {
forces.resize(self.positions.len(), Vector::zeros());
}
for f in forces {
f.fill(N::zero())
}
}
}
}
#[derive(Copy, Clone, PartialEq, Eq, Hash, Debug)]
pub struct BoundaryHandle(ContiguousArenaIndex);
pub type BoundarySet<N> = ContiguousArena<BoundaryHandle, Boundary<N>>;
impl From<ContiguousArenaIndex> for BoundaryHandle {
#[inline]
fn from(i: ContiguousArenaIndex) -> Self {
BoundaryHandle(i)
}
}
impl Into<ContiguousArenaIndex> for BoundaryHandle {
#[inline]
fn into(self) -> ContiguousArenaIndex {
self.0
}
}