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
94
95
use crate::math::{Isometry, Point, Real, Vector};
use crate::object::{ContiguousArena, ContiguousArenaIndex};
use std::sync::RwLock;
pub struct Boundary {
pub positions: Vec<Point<Real>>,
pub velocities: Vec<Vector<Real>>,
pub volumes: Vec<Real>,
pub forces: Option<RwLock<Vec<Vector<Real>>>>,
}
impl Boundary {
pub fn new(particle_positions: Vec<Point<Real>>) -> Self {
let num_particles = particle_positions.len();
let velocities = std::iter::repeat(Vector::zeros())
.take(num_particles)
.collect();
let volumes = std::iter::repeat(na::zero::<Real>())
.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<Real>) {
self.positions.iter_mut().for_each(|p| *p = pose * *p);
}
pub fn apply_force(&self, i: usize, f: Vector<Real>) {
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(na::zero::<Real>())
}
}
}
}
#[derive(Copy, Clone, PartialEq, Eq, Hash, Debug)]
pub struct BoundaryHandle(ContiguousArenaIndex);
pub type BoundarySet = ContiguousArena<BoundaryHandle, Boundary>;
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
}
}