Compare commits

..

No commits in common. "main" and "torii" have entirely different histories.
main ... torii

4 changed files with 83 additions and 133 deletions

View File

@ -10,6 +10,3 @@ bevy-inspector-egui = "0.25.1"
[features]
no-mesh = []
[profile.dev.package."*"]
opt-level = 3

View File

@ -8,21 +8,6 @@ use crate::physics::CatControllerState;
#[derive(Component)]
pub struct CyberBikeBody;
#[derive(Component)]
pub struct CyberWheel;
// marker for front suspension joint
#[derive(Component)]
pub struct Steering;
#[derive(Component)]
pub struct FrontHub;
// marker for rear suspension joint
#[derive(Component)]
pub struct Rearing;
#[derive(Component)]
pub struct RearHub;
fn spawn_bike(
mut commands: Commands,
mut meshes: ResMut<Assets<Mesh>>,
@ -37,14 +22,13 @@ fn spawn_bike(
let bike = commands
.spawn(SpatialBundle::from_transform(xform))
.insert((
Name::new("body"),
RigidBody::Dynamic,
body_collider,
CollisionLayers::from_bits(1, 1),
SleepingDisabled,
CyberBikeBody,
CatControllerState::default(),
ColliderDensity(20.0),
ColliderDensity(0.12),
LinearDamping(0.1),
AngularDamping(2.0),
LinearVelocity::ZERO,
@ -69,56 +53,28 @@ fn spawn_bike(
spawn_wheels(commands, meshes, materials, xform, bike);
}
fn spawn_wheels(
mut commands: Commands,
mut meshes: ResMut<Assets<Mesh>>,
mut materials: ResMut<Assets<StandardMaterial>>,
xform: Transform,
body: Entity,
) {
let front_rake = Vec3::new(0.0, -1.0, -0.57).normalize(); // about 30 degrees
let front_pos = xform.translation + front_rake;
#[derive(Component)]
pub struct CyberWheel;
let (mesh, collider) = gen_tire();
// marker for front suspension joint
#[derive(Component)]
pub struct Steering;
#[derive(Component)]
pub struct FrontHub;
let front_hub = wheels_helper(
&mut commands,
&mut meshes,
&mut materials,
front_pos,
mesh.clone(),
collider.clone(),
);
commands.entity(front_hub).insert(FrontHub);
commands.spawn((
Steering,
FixedJoint::new(front_hub, body).with_local_anchor_2(*xform.forward() + front_rake),
));
// marker for rear suspension joint
#[derive(Component)]
pub struct Rearing;
#[derive(Component)]
pub struct RearHub;
let rear_rake = Vec3::new(0.0, -1.0, 0.57).normalize();
let rear_pos = xform.translation + rear_rake;
let rear_hub = wheels_helper(
&mut commands,
&mut meshes,
&mut materials,
rear_pos,
mesh,
collider,
);
commands.entity(rear_hub).insert(RearHub);
commands.spawn((
Rearing,
FixedJoint::new(rear_hub, body).with_local_anchor_2(*xform.back() + rear_rake),
));
}
//-************************************************************************
// helper fns for the wheels
//-************************************************************************
fn gen_tire() -> (Mesh, Collider) {
let mut tire_mesh: Mesh = Torus::new(0.25, 0.40).into();
fn helper(
commands: &mut Commands,
meshes: &mut ResMut<Assets<Mesh>>,
materials: &mut ResMut<Assets<StandardMaterial>>,
position: Vec3,
) -> Entity {
let mut tire_mesh: Mesh = Torus::new(0.30, 0.40).into();
let tire_verts = tire_mesh
.attribute(Mesh::ATTRIBUTE_POSITION)
.unwrap()
@ -135,71 +91,76 @@ fn gen_tire() -> (Mesh, Collider) {
.collect::<Vec<[f32; 3]>>();
tire_mesh.remove_attribute(Mesh::ATTRIBUTE_POSITION);
tire_mesh.insert_attribute(Mesh::ATTRIBUTE_POSITION, tire_verts);
let collider = Collider::convex_hull_from_mesh(&tire_mesh).unwrap();
(tire_mesh, collider)
}
fn wheels_helper(
commands: &mut Commands,
meshes: &mut ResMut<Assets<Mesh>>,
materials: &mut ResMut<Assets<StandardMaterial>>,
position: Vec3,
tire_mesh: Mesh,
collider: Collider,
) -> Entity {
let wheel_material = &StandardMaterial {
let wheel_material = StandardMaterial {
base_color: Color::srgb(0.01, 0.01, 0.01),
alpha_mode: AlphaMode::Opaque,
perceptual_roughness: 0.5,
..Default::default()
};
let collider = Collider::convex_decomposition_from_mesh(&tire_mesh).unwrap();
let mut tire = None;
let tref = &mut tire;
let xform = Transform::from_translation(position);
let hub_mesh: Mesh = Sphere::new(0.1).into();
let hub = commands
.spawn((
Name::new("hub"),
SpatialBundle::from_transform(xform),
RigidBody::Dynamic,
MassPropertiesBundle::new_computed(&Collider::sphere(0.1), 200.0),
PbrBundle {
mesh: meshes.add(hub_mesh),
material: materials.add(wheel_material.clone()),
transform: xform,
..Default::default()
},
MassPropertiesBundle::new_computed(&Collider::sphere(0.1), 0.01),
))
.id();
let tire = commands
.spawn((
Name::new("tire"),
PbrBundle {
mesh: meshes.add(tire_mesh),
.with_children(move |parent| {
let mesh: Mesh = Sphere::new(0.1).into();
parent.spawn(PbrBundle {
mesh: meshes.add(mesh),
material: materials.add(wheel_material.clone()),
transform: xform,
..Default::default()
},
CyberWheel,
RigidBody::Dynamic,
collider,
Friction::new(0.9).with_dynamic_coefficient(0.6),
Restitution::new(0.1),
ColliderDensity(30.0),
CollisionLayers::from_bits(2, 2),
ExternalTorque::ZERO.with_persistence(false),
CollisionMargin(0.05),
SweptCcd::NON_LINEAR,
))
});
let tire_id = parent
.spawn((
CyberWheel,
RigidBody::Dynamic,
collider.clone(),
ColliderDensity(0.05),
CollisionLayers::from_bits(2, 2),
ExternalTorque::ZERO.with_persistence(false),
))
.id();
let _ = tref.insert(tire_id);
})
.id();
// connect hubs and tires to make wheels
commands.spawn(RevoluteJoint::new(hub, tire).with_aligned_axis(Vec3::X));
commands.spawn(RevoluteJoint::new(hub, tire.unwrap()).with_aligned_axis(Vec3::X));
hub
}
fn spawn_wheels(
mut commands: Commands,
mut meshes: ResMut<Assets<Mesh>>,
mut materials: ResMut<Assets<StandardMaterial>>,
xform: Transform,
body: Entity,
) {
let rake_vec = Vec3::new(0.0, -1.0, -0.57).normalize(); // about 30 degrees
let front_pos = xform.translation + rake_vec;
let front_hub = helper(&mut commands, &mut meshes, &mut materials, front_pos);
commands.entity(front_hub).insert(FrontHub);
commands.spawn((
Steering,
FixedJoint::new(front_hub, body).with_local_anchor_2(*xform.forward() + rake_vec),
));
let rear_pos = xform.translation + Vec3::new(0.0, -1.0, 0.57).normalize();
let rear_hub = helper(&mut commands, &mut meshes, &mut materials, rear_pos);
commands.entity(rear_hub).insert(RearHub);
commands.spawn((
Rearing,
FixedJoint::new(rear_hub, body).with_local_anchor_2(*xform.back() + rake_vec.y),
));
}
pub struct CyberBikePlugin;
impl Plugin for CyberBikePlugin {

View File

@ -41,23 +41,16 @@ fn ground_and_light(
mut meshes: ResMut<Assets<Mesh>>,
mut materials: ResMut<Assets<StandardMaterial>>,
) {
commands
.spawn((
SpatialBundle::default(),
RigidBody::Static,
Collider::cuboid(50.0, 0.5, 50.0),
CollisionMargin(0.1),
ColliderDensity(1000.0),
Friction::new(0.9),
))
.with_children(|p| {
p.spawn(PbrBundle {
mesh: meshes.add(Plane3d::default().mesh().size(50.0, 50.0)),
material: materials.add(Color::from(SILVER)),
transform: Transform::from_xyz(0.0, 0.4, 0.0),
..default()
});
});
commands.spawn((
RigidBody::Static,
Collider::cuboid(50.0, 0.5, 50.0),
PbrBundle {
mesh: meshes.add(Plane3d::default().mesh().size(50.0, 50.0)),
material: materials.add(Color::from(SILVER)),
transform: Transform::from_xyz(0.0, -3., 0.0),
..default()
},
));
commands.spawn(PointLightBundle {
point_light: PointLight {

View File

@ -18,9 +18,9 @@ pub struct CatControllerSettings {
impl Default for CatControllerSettings {
fn default() -> Self {
Self {
kp: 1200.0,
kd: 10.0,
ki: 50.0,
kp: 10.0,
kd: 1.2,
ki: 0.2,
}
}
}
@ -174,7 +174,6 @@ impl Plugin for CyberPhysicsPlugin {
.init_resource::<CyberLean>()
.register_type::<CyberLean>()
.add_plugins((PhysicsPlugins::default(), PhysicsDebugPlugin::default()))
.insert_resource(SubstepCount(12))
.add_systems(Update, (apply_lean, calculate_lean));
}
}