-
-
Notifications
You must be signed in to change notification settings - Fork 121
/
plasticity2.rs
129 lines (112 loc) · 4.38 KB
/
plasticity2.rs
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
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
extern crate nalgebra as na;
use na::{Isometry2, Point2, Point3, RealField, Vector2};
use ncollide2d::shape::{Cuboid, ShapeHandle};
use nphysics2d::algebra::Velocity2;
use nphysics2d::force_generator::DefaultForceGeneratorSet;
use nphysics2d::joint::DefaultJointConstraintSet;
use nphysics2d::object::{
BodyPartHandle, BodyStatus, ColliderDesc, DefaultBodySet, DefaultColliderSet, FEMSurfaceDesc,
RigidBodyDesc,
};
use nphysics2d::world::{DefaultGeometricalWorld, DefaultMechanicalWorld};
use nphysics_testbed2d::Testbed;
/*
* NOTE: The `r` macro is only here to convert from f64 to the `N` scalar type.
* This simplifies experimentation with various scalar types (f32, fixed-point numbers, etc.)
*/
pub fn init_world<N: RealField>(testbed: &mut Testbed<N>) {
/*
* World
*/
let mechanical_world = DefaultMechanicalWorld::new(Vector2::zeros());
let geometrical_world = DefaultGeometricalWorld::new();
let mut bodies = DefaultBodySet::new();
let mut colliders = DefaultColliderSet::new();
let joint_constraints = DefaultJointConstraintSet::new();
let force_generators = DefaultForceGeneratorSet::new();
/*
* Ground.
*/
let platform_height = r!(0.4);
let platform_shape = ShapeHandle::new(Cuboid::new(Vector2::new(r!(0.03), r!(0.03))));
let positions = [
Isometry2::new(Vector2::new(r!(0.4), platform_height), na::zero()),
Isometry2::new(Vector2::new(r!(0.2), -platform_height), na::zero()),
Isometry2::new(Vector2::new(r!(0.0), platform_height), na::zero()),
Isometry2::new(Vector2::new(r!(-0.2), -platform_height), na::zero()),
Isometry2::new(Vector2::new(r!(-0.4), platform_height), na::zero()),
];
let mut platforms = Vec::new();
let platform_vel_magnitude = r!(0.1);
for (i, pos) in positions.iter().enumerate() {
let velocity = if i % 2 == 0 {
Velocity2::linear(r!(0.0), -platform_vel_magnitude)
} else {
Velocity2::linear(r!(0.0), platform_vel_magnitude)
};
let platform = RigidBodyDesc::new()
.position(*pos)
.velocity(velocity)
.status(BodyStatus::Kinematic)
.build();
platforms.push(bodies.insert(platform));
let co = ColliderDesc::new(platform_shape.clone()).build(BodyPartHandle(platforms[i], 0));
colliders.insert(co);
}
/*
* Create the deformable body and a collider for its contour.
*/
let mut deformable = FEMSurfaceDesc::quad(20, 1)
.scale(Vector2::new(r!(1.1), r!(0.1)))
.density(r!(1.0))
.young_modulus(r!(1.0e2))
.mass_damping(r!(0.2))
.plasticity(r!(0.1), r!(5.0), r!(10.0))
.build();
let collider_desc = deformable.boundary_collider_desc();
let deformable_surface_handle = bodies.insert(deformable);
let co = collider_desc.build(deformable_surface_handle);
colliders.insert(co);
/*
* Set up the testbed.
*/
testbed.set_world(
mechanical_world,
geometrical_world,
bodies,
colliders,
joint_constraints,
force_generators,
);
testbed.set_body_color(deformable_surface_handle, Point3::new(0.0, 0.0, 1.0));
for platform in &platforms {
testbed.set_body_color(*platform, Point3::new(0.5, 0.5, 0.5));
}
testbed.add_callback(move |_, _, bodies, _, _, _| {
for (i, handle) in platforms.iter().enumerate() {
let platform = bodies.rigid_body_mut(*handle).unwrap();
let platform_y = platform.position().translation.vector.y;
let mut vel = *platform.velocity();
let max_traversal = r!(0.005);
if i % 2 == 0 {
if platform_y <= -max_traversal {
vel.linear.y = platform_vel_magnitude;
} else if platform_y >= platform_height {
vel.linear.y = -platform_vel_magnitude;
}
} else {
if platform_y >= max_traversal {
vel.linear.y = -platform_vel_magnitude;
} else if platform_y <= -platform_height {
vel.linear.y = platform_vel_magnitude;
}
}
platform.set_velocity(vel);
}
});
testbed.look_at(Point2::origin(), 1000.0);
}
fn main() {
let testbed = Testbed::<f32>::from_builders(0, vec![("Plasticity", init_world)]);
testbed.run()
}