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
|
use rapier2d::prelude::*;
use rapier_testbed2d::Testbed;
pub fn init_world(testbed: &mut Testbed) {
/*
* World
*/
let mut bodies = RigidBodySet::new();
let mut colliders = ColliderSet::new();
let impulse_joints = ImpulseJointSet::new();
let multibody_joints = MultibodyJointSet::new();
#[allow(clippy::excessive_precision)]
let mut ps1 = [
Point::new(16.0, 0.0),
Point::new(14.93803712795643, 5.133601056842984),
Point::new(13.79871746027416, 10.24928069555078),
Point::new(12.56252963284711, 15.34107019122473),
Point::new(11.20040987372525, 20.39856541571217),
Point::new(9.66521217819836, 25.40369899225096),
Point::new(7.87179930638133, 30.3179337000085),
Point::new(5.635199558196225, 35.03820717801641),
Point::new(2.405937953536585, 39.09554102558315),
];
#[allow(clippy::excessive_precision)]
let mut ps2 = [
Point::new(24.0, 0.0),
Point::new(22.33619528222415, 6.02299846205841),
Point::new(20.54936888969905, 12.00964361211476),
Point::new(18.60854610798073, 17.9470321677465),
Point::new(16.46769273811807, 23.81367936585418),
Point::new(14.05325025774858, 29.57079353071012),
Point::new(11.23551045834022, 35.13775818285372),
Point::new(7.752568160730571, 40.30450679009583),
Point::new(3.016931552701656, 44.28891593799322),
];
let scale = 0.25;
let friction = 0.6;
for i in 0..9 {
ps1[i] *= scale;
ps2[i] *= scale;
}
/*
* Ground
*/
let collider = ColliderBuilder::segment(point![-100.0, 0.0], point![100.0, 0.0]).friction(0.6);
colliders.insert(collider);
/*
* Create the arch
*/
for i in 0..8 {
let ps = [ps1[i], ps2[i], ps2[i + 1], ps1[i + 1]];
let rigid_body = RigidBodyBuilder::dynamic();
let ground_handle = bodies.insert(rigid_body);
let collider = ColliderBuilder::convex_hull(&ps)
.unwrap()
.friction(friction);
colliders.insert_with_parent(collider, ground_handle, &mut bodies);
}
for i in 0..8 {
let ps = [
point![-ps2[i].x, ps2[i].y],
point![-ps1[i].x, ps1[i].y],
point![-ps1[i + 1].x, ps1[i + 1].y],
point![-ps2[i + 1].x, ps2[i + 1].y],
];
let rigid_body = RigidBodyBuilder::dynamic();
let ground_handle = bodies.insert(rigid_body);
let collider = ColliderBuilder::convex_hull(&ps)
.unwrap()
.friction(friction);
colliders.insert_with_parent(collider, ground_handle, &mut bodies);
}
{
let ps = [
ps1[8],
ps2[8],
point![-ps1[8].x, ps1[8].y],
point![-ps2[8].x, ps2[8].y],
];
let rigid_body = RigidBodyBuilder::dynamic();
let ground_handle = bodies.insert(rigid_body);
let collider = ColliderBuilder::convex_hull(&ps)
.unwrap()
.friction(friction);
colliders.insert_with_parent(collider, ground_handle, &mut bodies);
}
for i in 0..4 {
let rigid_body =
RigidBodyBuilder::dynamic().translation(vector![0.0, 0.5 + ps2[8].y + 1.0 * i as f32]);
let ground_handle = bodies.insert(rigid_body);
let collider = ColliderBuilder::cuboid(2.0, 0.5).friction(friction);
colliders.insert_with_parent(collider, ground_handle, &mut bodies);
}
/*
* Set up the testbed.
*/
testbed.set_world(bodies, colliders, impulse_joints, multibody_joints);
testbed.look_at(point![0.0, 2.5], 20.0);
}
|
