use crate::{instruction::{InstructionEmitter, InstructionConsumer, TimedInstruction}, zeroes::zeroes2}; #[derive(Debug)] pub enum PhysicsInstruction { CollisionStart(RelativeCollision), CollisionEnd(RelativeCollision), StrafeTick, ReachWalkTargetVelocity, // Water, // Spawn( // Option, // bool,//true = Trigger; false = teleport // bool,//true = Force // ) //InputInstructions conditionally activate RefreshWalkTarget (by doing what SetWalkTargetVelocity used to do and then flagging it) Input(PhysicsInputInstruction), } #[derive(Debug)] pub enum PhysicsInputInstruction { ReplaceMouse(MouseState,MouseState), SetNextMouse(MouseState), SetMoveRight(bool), SetMoveUp(bool), SetMoveBack(bool), SetMoveLeft(bool), SetMoveDown(bool), SetMoveForward(bool), SetJump(bool), SetZoom(bool), Reset, Idle, } #[derive(Debug)] pub enum InputInstruction { MoveMouse(glam::IVec2), MoveRight(bool), MoveUp(bool), MoveBack(bool), MoveLeft(bool), MoveDown(bool), MoveForward(bool), Jump(bool), Zoom(bool), Reset, Idle, //Idle: there were no input events, but the simulation is safe to advance to this timestep //for interpolation / networking / playback reasons, most playback heads will always want //to be 1 instruction ahead to generate the next state for interpolation. } #[derive(Clone)] pub struct Body { position: glam::Vec3,//I64 where 2^32 = 1 u velocity: glam::Vec3,//I64 where 2^32 = 1 u/s acceleration: glam::Vec3,//I64 where 2^32 = 1 u/s/s time: TIME,//nanoseconds x xxxxD! } trait MyHash{ fn hash(&self) -> u64; } impl MyHash for Body { fn hash(&self) -> u64 { let mut hasher=std::collections::hash_map::DefaultHasher::new(); for &el in self.position.as_ref().iter() { std::hash::Hasher::write(&mut hasher, el.to_ne_bytes().as_slice()); } for &el in self.velocity.as_ref().iter() { std::hash::Hasher::write(&mut hasher, el.to_ne_bytes().as_slice()); } for &el in self.acceleration.as_ref().iter() { std::hash::Hasher::write(&mut hasher, el.to_ne_bytes().as_slice()); } std::hash::Hasher::write(&mut hasher, self.time.to_ne_bytes().as_slice()); return std::hash::Hasher::finish(&hasher);//hash check to see if walk target is valid } } pub enum MoveRestriction { Air, Water, Ground, Ladder,//multiple ladders how } /* enum InputInstruction { } struct InputState { } impl InputState { pub fn get_control(&self,control:u32) -> bool { self.controls&control!=0 } } impl crate::instruction::InstructionEmitter for InputState{ fn next_instruction(&self, time_limit:crate::body::TIME) -> Option> { //this is polled by PhysicsState for actions like Jump //no, it has to be the other way around. physics is run up until the jump instruction, and then the jump instruction is pushed. self.queue.get(0) } } impl crate::instruction::InstructionConsumer for InputState{ fn process_instruction(&mut self,ins:TimedInstruction){ //add to queue self.queue.push(ins); } } */ //hey dumbass just use a delta #[derive(Clone,Debug)] pub struct MouseState { pub pos: glam::IVec2, pub time: TIME, } impl Default for MouseState{ fn default() -> Self { Self { time:0, pos:glam::IVec2::ZERO, } } } impl MouseState { pub fn lerp(&self,target:&MouseState,time:TIME)->glam::IVec2 { let m0=self.pos.as_i64vec2(); let m1=target.pos.as_i64vec2(); //these are deltas let t1t=(target.time-time) as i64; let tt0=(time-self.time) as i64; let dt=(target.time-self.time) as i64; ((m0*t1t+m1*tt0)/dt).as_ivec2() } } pub enum WalkEnum{ Reached, Transient, } pub struct WalkState { pub target_velocity: glam::Vec3, pub target_time: TIME, pub state: WalkEnum, } impl WalkState { pub fn new() -> Self { Self{ target_velocity:glam::Vec3::ZERO, target_time:0, state:WalkEnum::Reached, } } } #[derive(Clone)] pub struct PhysicsCamera { offset: glam::Vec3, angles: glam::DVec2,//YAW AND THEN PITCH //punch: glam::Vec3, //punch_velocity: glam::Vec3, sensitivity: glam::DVec2, mouse:MouseState, } #[inline] fn mat3_from_rotation_y_f64(angle: f64) -> glam::Mat3 { let (sina, cosa) = angle.sin_cos(); glam::Mat3::from_cols( glam::Vec3::new(cosa as f32, 0.0, -sina as f32), glam::Vec3::Y, glam::Vec3::new(sina as f32, 0.0, cosa as f32), ) } impl PhysicsCamera { pub fn from_offset(offset:glam::Vec3) -> Self { Self{ offset, angles: glam::DVec2::ZERO, sensitivity: glam::dvec2(1.0/1024.0,1.0/1024.0), mouse:MouseState{pos:glam::IVec2::ZERO,time:-1},//escape initialization hell divide by zero } } pub fn simulate_move_angles(&self, mouse_pos: glam::IVec2) -> glam::DVec2 { let mut a=self.angles-self.sensitivity*(mouse_pos-self.mouse.pos).as_dvec2(); a.y=a.y.clamp(-std::f64::consts::FRAC_PI_2, std::f64::consts::FRAC_PI_2); return a } fn simulate_move_rotation_y(&self, mouse_pos_x: i32) -> glam::Mat3 { mat3_from_rotation_y_f64(self.angles.x-self.sensitivity.x*((mouse_pos_x-self.mouse.pos.x) as f64)) } } pub struct GameMechanicsState{ pub stage_id:u32, //jump_counts:HashMap, } impl std::default::Default for GameMechanicsState{ fn default() -> Self { Self{ stage_id:0, } } } pub struct WorldState{} pub struct StyleModifiers{ pub controls_mask:u32,//controls which are unable to be activated pub controls_held:u32,//controls which must be active to be able to strafe pub mv:f32, pub walkspeed:f32, pub friction:f32, pub walk_accel:f32, pub gravity:glam::Vec3, pub strafe_tick_num:TIME, pub strafe_tick_den:TIME, pub hitbox_halfsize:glam::Vec3, } impl std::default::Default for StyleModifiers{ fn default() -> Self { Self{ controls_mask: !0,//&!(Self::CONTROL_MOVEUP|Self::CONTROL_MOVEDOWN), controls_held: 0, strafe_tick_num: 100,//100t strafe_tick_den: 1_000_000_000, gravity: glam::vec3(0.0,-100.0,0.0), friction: 1.2, walk_accel: 90.0, mv: 2.7, walkspeed: 18.0, hitbox_halfsize: glam::vec3(1.0,2.5,1.0), } } } impl StyleModifiers{ const CONTROL_MOVEFORWARD:u32 = 0b00000001; const CONTROL_MOVEBACK:u32 = 0b00000010; const CONTROL_MOVERIGHT:u32 = 0b00000100; const CONTROL_MOVELEFT:u32 = 0b00001000; const CONTROL_MOVEUP:u32 = 0b00010000; const CONTROL_MOVEDOWN:u32 = 0b00100000; const CONTROL_JUMP:u32 = 0b01000000; const CONTROL_ZOOM:u32 = 0b10000000; const FORWARD_DIR:glam::Vec3 = glam::Vec3::NEG_Z; const RIGHT_DIR:glam::Vec3 = glam::Vec3::X; const UP_DIR:glam::Vec3 = glam::Vec3::Y; fn get_control(&self,control:u32,controls:u32)->bool{ controls&self.controls_mask&control==control } fn get_control_dir(&self,controls:u32)->glam::Vec3{ //don't get fancy just do it let mut control_dir:glam::Vec3 = glam::Vec3::ZERO; //Disallow strafing if held controls are not held if controls&self.controls_held!=self.controls_held{ return control_dir; } //Apply mask after held check so you can require non-allowed keys to be held for some reason let controls=controls&self.controls_mask; if controls & Self::CONTROL_MOVEFORWARD == Self::CONTROL_MOVEFORWARD { control_dir+=Self::FORWARD_DIR; } if controls & Self::CONTROL_MOVEBACK == Self::CONTROL_MOVEBACK { control_dir+=-Self::FORWARD_DIR; } if controls & Self::CONTROL_MOVELEFT == Self::CONTROL_MOVELEFT { control_dir+=-Self::RIGHT_DIR; } if controls & Self::CONTROL_MOVERIGHT == Self::CONTROL_MOVERIGHT { control_dir+=Self::RIGHT_DIR; } if controls & Self::CONTROL_MOVEUP == Self::CONTROL_MOVEUP { control_dir+=Self::UP_DIR; } if controls & Self::CONTROL_MOVEDOWN == Self::CONTROL_MOVEDOWN { control_dir+=-Self::UP_DIR; } return control_dir } } pub struct PhysicsState{ pub time:TIME, pub body:Body, pub world:WorldState,//currently there is only one state the world can be in pub game:GameMechanicsState, pub style:StyleModifiers, pub contacts:std::collections::HashMap::, pub intersects:std::collections::HashMap::, //pub intersections: Vec, //camera must exist in state because wormholes modify the camera, also camera punch pub camera:PhysicsCamera, pub next_mouse:MouseState,//Where is the mouse headed next pub controls:u32, pub walk:WalkState, pub grounded:bool, //all models pub models:Vec, pub bvh:crate::bvh::BvhNode, pub modes:Vec, pub mode_from_mode_id:std::collections::HashMap::, //the spawn point is where you spawn when you load into the map. //This is not the same as Reset which teleports you to Spawn0 pub spawn_point:glam::Vec3, } #[derive(Clone)] pub struct PhysicsOutputState{ camera:PhysicsCamera, body:Body, } impl PhysicsOutputState{ pub fn adjust_mouse(&self,mouse:&MouseState)->(glam::Vec3,glam::Vec2){ (self.body.extrapolated_position(mouse.time)+self.camera.offset,self.camera.simulate_move_angles(mouse.pos).as_vec2()) } } //pretend to be using what we want to eventually do type TreyMeshFace = crate::aabb::AabbFace; type TreyMesh = crate::aabb::Aabb; enum PhysicsCollisionAttributes{ Contact{//track whether you are contacting the object contacting:crate::model::ContactingAttributes, general:crate::model::GameMechanicAttributes, }, Intersect{//track whether you are intersecting the object intersecting:crate::model::IntersectingAttributes, general:crate::model::GameMechanicAttributes, }, } pub struct ModelPhysics { //A model is a thing that has a hitbox. can be represented by a list of TreyMesh-es //in this iteration, all it needs is extents. mesh: TreyMesh, transform:glam::Affine3A, attributes:PhysicsCollisionAttributes, } impl ModelPhysics { fn from_model_transform_attributes(model:&crate::model::IndexedModel,transform:&glam::Affine3A,attributes:PhysicsCollisionAttributes)->Self{ let mut aabb=TreyMesh::new(); for indexed_vertex in &model.unique_vertices { aabb.grow(transform.transform_point3(glam::Vec3::from_array(model.unique_pos[indexed_vertex.pos as usize]))); } Self{ mesh:aabb, attributes, transform:transform.clone(), } } pub fn from_model(model:&crate::model::IndexedModel,instance:&crate::model::ModelInstance) -> Option { match &instance.attributes{ crate::model::CollisionAttributes::Contact{contacting,general}=>Some(ModelPhysics::from_model_transform_attributes(model,&instance.transform,PhysicsCollisionAttributes::Contact{contacting:contacting.clone(),general:general.clone()})), crate::model::CollisionAttributes::Intersect{intersecting,general}=>Some(ModelPhysics::from_model_transform_attributes(model,&instance.transform,PhysicsCollisionAttributes::Intersect{intersecting:intersecting.clone(),general:general.clone()})), crate::model::CollisionAttributes::Decoration=>None, } } pub fn unit_vertices(&self) -> [glam::Vec3;8] { TreyMesh::unit_vertices() } pub fn mesh(&self) -> &TreyMesh { return &self.mesh; } pub fn face_mesh(&self,face:TreyMeshFace)->TreyMesh{ self.mesh.face(face) } pub fn face_normal(&self,face:TreyMeshFace) -> glam::Vec3 { TreyMesh::normal(face)//this is wrong for scale } } //need non-face (full model) variant for CanCollide false objects //OR have a separate list from contacts for model intersection #[derive(Debug,Clone,Eq,Hash,PartialEq)] pub struct RelativeCollision { face: TreyMeshFace,//just an id model: u32,//using id to avoid lifetimes } impl RelativeCollision { pub fn model<'a>(&self,models:&'a Vec)->Option<&'a ModelPhysics>{ models.get(self.model as usize) } pub fn mesh(&self,models:&Vec) -> TreyMesh { return self.model(models).unwrap().face_mesh(self.face).clone() } pub fn normal(&self,models:&Vec) -> glam::Vec3 { return self.model(models).unwrap().face_normal(self.face) } } pub type TIME = i64; impl Body { pub fn with_pva(position:glam::Vec3,velocity:glam::Vec3,acceleration:glam::Vec3) -> Self { Self{ position, velocity, acceleration, time: 0, } } pub fn extrapolated_position(&self,time: TIME)->glam::Vec3{ let dt=(time-self.time) as f64/1_000_000_000f64; self.position+self.velocity*(dt as f32)+self.acceleration*((0.5*dt*dt) as f32) } pub fn extrapolated_velocity(&self,time: TIME)->glam::Vec3{ let dt=(time-self.time) as f64/1_000_000_000f64; self.velocity+self.acceleration*(dt as f32) } pub fn advance_time(&mut self, time: TIME){ self.position=self.extrapolated_position(time); self.velocity=self.extrapolated_velocity(time); self.time=time; } } impl Default for PhysicsState{ fn default() -> Self { Self{ spawn_point:glam::vec3(0.0,50.0,0.0), body: Body::with_pva(glam::vec3(0.0,50.0,0.0),glam::vec3(0.0,0.0,0.0),glam::vec3(0.0,-100.0,0.0)), time: 0, style:StyleModifiers::default(), grounded: false, contacts: std::collections::HashMap::new(), intersects: std::collections::HashMap::new(), models: Vec::new(), bvh:crate::bvh::BvhNode::default(), walk: WalkState::new(), camera: PhysicsCamera::from_offset(glam::vec3(0.0,4.5-2.5,0.0)), next_mouse: MouseState::default(), controls: 0, world:WorldState{}, game:GameMechanicsState::default(), modes:Vec::new(), mode_from_mode_id:std::collections::HashMap::new(), } } } impl PhysicsState { pub fn clear(&mut self){ self.models.clear(); self.modes.clear(); self.contacts.clear(); self.intersects.clear(); } pub fn into_worker(mut self)->crate::worker::CompatWorker,PhysicsOutputState,Box)->PhysicsOutputState>>{ let mut mouse_blocking=true; let mut last_mouse_time=self.next_mouse.time; let mut timeline=std::collections::VecDeque::new(); crate::worker::CompatWorker::new(self.output(),Box::new(move |ins:TimedInstruction|{ if if let Some(phys_input)=match ins.instruction{ InputInstruction::MoveMouse(m)=>{ if mouse_blocking{ //tell the game state which is living in the past about its future timeline.push_front(TimedInstruction{ time:last_mouse_time, instruction:PhysicsInputInstruction::SetNextMouse(MouseState{time:ins.time,pos:m}), }); }else{ //mouse has just started moving again after being still for longer than 10ms. //replace the entire mouse interpolation state to avoid an intermediate state with identical m0.t m1.t timestamps which will divide by zero timeline.push_front(TimedInstruction{ time:last_mouse_time, instruction:PhysicsInputInstruction::ReplaceMouse( MouseState{time:last_mouse_time,pos:self.next_mouse.pos}, MouseState{time:ins.time,pos:m} ), }); //delay physics execution until we have an interpolation target mouse_blocking=true; } last_mouse_time=ins.time; None }, InputInstruction::MoveForward(s)=>Some(PhysicsInputInstruction::SetMoveForward(s)), InputInstruction::MoveLeft(s)=>Some(PhysicsInputInstruction::SetMoveLeft(s)), InputInstruction::MoveBack(s)=>Some(PhysicsInputInstruction::SetMoveBack(s)), InputInstruction::MoveRight(s)=>Some(PhysicsInputInstruction::SetMoveRight(s)), InputInstruction::MoveUp(s)=>Some(PhysicsInputInstruction::SetMoveUp(s)), InputInstruction::MoveDown(s)=>Some(PhysicsInputInstruction::SetMoveDown(s)), InputInstruction::Jump(s)=>Some(PhysicsInputInstruction::SetJump(s)), InputInstruction::Zoom(s)=>Some(PhysicsInputInstruction::SetZoom(s)), InputInstruction::Reset=>Some(PhysicsInputInstruction::Reset), InputInstruction::Idle=>Some(PhysicsInputInstruction::Idle), }{ //non-mouse event timeline.push_back(TimedInstruction{ time:ins.time, instruction:phys_input, }); if mouse_blocking{ //assume the mouse has stopped moving after 10ms. //shitty mice are 125Hz which is 8ms so this should cover that. //setting this to 100us still doesn't print even though it's 10x lower than the polling rate, //so mouse events are probably not handled separately from drawing and fire right before it :( if 10_000_000PhysicsOutputState{ PhysicsOutputState{ body:self.body.clone(), camera:self.camera.clone(), } } pub fn generate_models(&mut self,indexed_models:&crate::model::IndexedModelInstances){ let mut starts=Vec::new(); let mut spawns=Vec::new(); let mut ordered_checkpoints=Vec::new(); let mut unordered_checkpoints=Vec::new(); for model in &indexed_models.models{ //make aabb and run vertices to get realistic bounds for model_instance in &model.instances{ if let Some(model_physics)=ModelPhysics::from_model(model,model_instance){ let model_id=self.models.len() as u32; self.models.push(model_physics); for attr in &model_instance.temp_indexing{ match attr{ crate::model::TempIndexedAttributes::Start{mode_id}=>starts.push((*mode_id,model_id)), crate::model::TempIndexedAttributes::Spawn{mode_id,stage_id}=>spawns.push((*mode_id,model_id,*stage_id)), crate::model::TempIndexedAttributes::OrderedCheckpoint{mode_id,checkpoint_id}=>ordered_checkpoints.push((*mode_id,model_id,*checkpoint_id)), crate::model::TempIndexedAttributes::UnorderedCheckpoint{mode_id}=>unordered_checkpoints.push((*mode_id,model_id)), } } } } } self.bvh=crate::bvh::generate_bvh(self.models.iter().map(|m|m.mesh().clone()).collect()); //I don't wanna write structs for temporary structures //this code builds ModeDescriptions from the unsorted lists at the top of the function starts.sort_by_key(|tup|tup.0); let mut eshmep=std::collections::HashMap::new(); let mut modedatas:Vec<(u32,Vec<(u32,u32)>,Vec<(u32,u32)>,Vec)>=starts.into_iter().enumerate().map(|(i,tup)|{ eshmep.insert(tup.0,i); (tup.1,Vec::new(),Vec::new(),Vec::new()) }).collect(); for tup in spawns{ if let Some(mode_id)=eshmep.get(&tup.0){ if let Some(modedata)=modedatas.get_mut(*mode_id){ modedata.1.push((tup.2,tup.1)); } } } for tup in ordered_checkpoints{ if let Some(mode_id)=eshmep.get(&tup.0){ if let Some(modedata)=modedatas.get_mut(*mode_id){ modedata.2.push((tup.2,tup.1)); } } } for tup in unordered_checkpoints{ if let Some(mode_id)=eshmep.get(&tup.0){ if let Some(modedata)=modedatas.get_mut(*mode_id){ modedata.3.push(tup.1); } } } let num_modes=self.modes.len(); for (mode_id,mode) in eshmep{ self.mode_from_mode_id.insert(mode_id,num_modes+mode); } self.modes.append(&mut modedatas.into_iter().map(|mut tup|{ tup.1.sort_by_key(|tup|tup.0); tup.2.sort_by_key(|tup|tup.0); let mut eshmep1=std::collections::HashMap::new(); let mut eshmep2=std::collections::HashMap::new(); crate::model::ModeDescription{ start:tup.0, spawns:tup.1.into_iter().enumerate().map(|(i,tup)|{eshmep1.insert(tup.0,i);tup.1}).collect(), ordered_checkpoints:tup.2.into_iter().enumerate().map(|(i,tup)|{eshmep2.insert(tup.0,i);tup.1}).collect(), unordered_checkpoints:tup.3, spawn_from_stage_id:eshmep1, ordered_checkpoint_from_checkpoint_id:eshmep2, } }).collect()); println!("Physics Objects: {}",self.models.len()); } pub fn load_user_settings(&mut self,user_settings:&crate::settings::UserSettings){ self.camera.sensitivity=user_settings.calculate_sensitivity(); } pub fn get_mode(&self,mode_id:u32)->Option<&crate::model::ModeDescription>{ if let Some(&mode)=self.mode_from_mode_id.get(&mode_id){ self.modes.get(mode) }else{ None } } //tickless gaming pub fn run(&mut self, time_limit:TIME){ //prepare is ommitted - everything is done via instructions. while let Some(instruction) = self.next_instruction(time_limit) {//collect //process self.process_instruction(instruction); //write hash lol } } pub fn advance_time(&mut self, time: TIME){ self.body.advance_time(time); self.time=time; } fn set_control(&mut self,control:u32,state:bool){ self.controls=if state{self.controls|control}else{self.controls&!control}; } fn jump(&mut self){ self.grounded=false;//do I need this? let mut v=self.body.velocity+glam::Vec3::new(0.0,0.715588/2.0*100.0,0.0); self.contact_constrain_velocity(&mut v); self.body.velocity=v; } fn contact_constrain_velocity(&self,velocity:&mut glam::Vec3){ for (_,contact) in &self.contacts { let n=contact.normal(&self.models); let d=velocity.dot(n); if d<0f32{ (*velocity)-=d/n.length_squared()*n; } } } fn contact_constrain_acceleration(&self,acceleration:&mut glam::Vec3){ for (_,contact) in &self.contacts { let n=contact.normal(&self.models); let d=acceleration.dot(n); if d<0f32{ (*acceleration)-=d/n.length_squared()*n; } } } fn next_strafe_instruction(&self) -> Option> { return Some(TimedInstruction{ time:(self.time*self.style.strafe_tick_num/self.style.strafe_tick_den+1)*self.style.strafe_tick_den/self.style.strafe_tick_num, //only poll the physics if there is a before and after mouse event instruction:PhysicsInstruction::StrafeTick }); } //state mutated on collision: //Accelerator //stair step-up //state mutated on instruction //change fly acceleration (fly_sustain) //change fly velocity //generic event emmiters //PlatformStandTime //walk/swim/air/ladder sounds //VState? //falling under the map // fn next_respawn_instruction(&self) -> Option> { // if self.body.position Option> { // return Some(TimedInstruction{ // time:(self.time*self.strafe_tick_num/self.strafe_tick_den+1)*self.strafe_tick_den/self.strafe_tick_num, // //only poll the physics if there is a before and after mouse event // instruction:PhysicsInstruction::Water // }); // } fn refresh_walk_target(&mut self){ //calculate acceleration yada yada if self.grounded{ let mut v=self.walk.target_velocity; self.contact_constrain_velocity(&mut v); let mut target_diff=v-self.body.velocity; target_diff.y=0f32; if target_diff==glam::Vec3::ZERO{ let mut a=glam::Vec3::ZERO; self.contact_constrain_acceleration(&mut a); self.body.acceleration=a; self.walk.state=WalkEnum::Reached; }else{ let accel=self.style.walk_accel.min(self.style.gravity.length()*self.style.friction); let time_delta=target_diff.length()/accel; let mut a=target_diff/time_delta; self.contact_constrain_acceleration(&mut a); self.body.acceleration=a; self.walk.target_time=self.body.time+((time_delta as f64)*1_000_000_000f64) as TIME; self.walk.state=WalkEnum::Transient; } }else{ self.walk.state=WalkEnum::Reached;//there is no walk target while not grounded } } fn next_walk_instruction(&self) -> Option> { //check if you have a valid walk state and create an instruction if self.grounded{ match self.walk.state{ WalkEnum::Transient=>Some(TimedInstruction{ time:self.walk.target_time, instruction:PhysicsInstruction::ReachWalkTargetVelocity }), WalkEnum::Reached=>None, } }else{ return None; } } fn mesh(&self) -> TreyMesh { let mut aabb=TreyMesh::new(); for vertex in TreyMesh::unit_vertices(){ aabb.grow(self.body.position+self.style.hitbox_halfsize*vertex); } aabb } fn predict_collision_end(&self,time:TIME,time_limit:TIME,collision_data:&RelativeCollision) -> Option> { //must treat cancollide false objects differently: you may not exit through the same face you entered. //RelativeCollsion must reference the full model instead of a particular face //this is Ctrl+C Ctrl+V of predict_collision_start but with v=-v before the calc and t=-t after the calc //find best t let mut best_time=time_limit; let mut exit_face:Option=None; let mesh0=self.mesh(); let mesh1=self.models.get(collision_data.model as usize).unwrap().mesh(); let (v,a)=(-self.body.velocity,self.body.acceleration); //collect x match collision_data.face { TreyMeshFace::Top|TreyMeshFace::Back|TreyMeshFace::Bottom|TreyMeshFace::Front=>{ for t in zeroes2(mesh0.max.x-mesh1.min.x,v.x,0.5*a.x) { //negative t = back in time //must be moving towards surface to collide //must beat the current soonest collision time //must be moving towards surface let t_time=self.body.time+((-t as f64)*1_000_000_000f64) as TIME; if time<=t_time&&t_time{ //generate event if v.x<0||a.x<0 if -v.x<0f32{ best_time=time; exit_face=Some(TreyMeshFace::Left); } }, TreyMeshFace::Right=>{ //generate event if 0{ for t in zeroes2(mesh0.max.y-mesh1.min.y,v.y,0.5*a.y) { //negative t = back in time //must be moving towards surface to collide //must beat the current soonest collision time //must be moving towards surface let t_time=self.body.time+((-t as f64)*1_000_000_000f64) as TIME; if time<=t_time&&t_time{ //generate event if v.y<0||a.y<0 if -v.y<0f32{ best_time=time; exit_face=Some(TreyMeshFace::Bottom); } }, TreyMeshFace::Top=>{ //generate event if 0{ for t in zeroes2(mesh0.max.z-mesh1.min.z,v.z,0.5*a.z) { //negative t = back in time //must be moving towards surface to collide //must beat the current soonest collision time //must be moving towards surface let t_time=self.body.time+((-t as f64)*1_000_000_000f64) as TIME; if time<=t_time&&t_time{ //generate event if v.z<0||a.z<0 if -v.z<0f32{ best_time=time; exit_face=Some(TreyMeshFace::Front); } }, TreyMeshFace::Back=>{ //generate event if 0 Option> { let mesh0=self.mesh(); let mesh1=self.models.get(model_id as usize).unwrap().mesh(); let (p,v,a,time)=(self.body.position,self.body.velocity,self.body.acceleration,self.body.time); //find best t let mut best_time=time_limit; let mut best_face:Option=None; //collect x for t in zeroes2(mesh0.max.x-mesh1.min.x,v.x,0.5*a.x) { //must collide now or in the future //must beat the current soonest collision time //must be moving towards surface let t_time=time+((t as f64)*1_000_000_000f64) as TIME; if time<=t_time&&t_time for PhysicsState { //this little next instruction function can cache its return value and invalidate the cached value by watching the State. fn next_instruction(&self,time_limit:TIME) -> Option> { //JUST POLLING!!! NO MUTATION let mut collector = crate::instruction::InstructionCollector::new(time_limit); //check for collision stop instructions with curent contacts for (_,collision_data) in &self.contacts { collector.collect(self.predict_collision_end(self.time,time_limit,collision_data)); } // for collision_data in &self.intersects{ // collector.collect(self.predict_collision_end2(self.time,time_limit,collision_data)); // } //check for collision start instructions (against every part in the game with no optimization!!) let mut aabb=crate::aabb::Aabb::new(); aabb.grow(self.body.extrapolated_position(self.time)); aabb.grow(self.body.extrapolated_position(time_limit)); aabb.inflate(self.style.hitbox_halfsize); self.bvh.the_tester(&aabb,&mut |id|{ if !(self.contacts.contains_key(&id)||self.intersects.contains_key(&id)){ collector.collect(self.predict_collision_start(self.time,time_limit,id)); } }); if self.grounded { //walk maintenance collector.collect(self.next_walk_instruction()); }else{ //check to see when the next strafe tick is collector.collect(self.next_strafe_instruction()); } collector.instruction() } } impl crate::instruction::InstructionConsumer for PhysicsState { fn process_instruction(&mut self, ins:TimedInstruction) { match &ins.instruction { PhysicsInstruction::Input(PhysicsInputInstruction::Idle) |PhysicsInstruction::Input(PhysicsInputInstruction::SetNextMouse(_)) |PhysicsInstruction::Input(PhysicsInputInstruction::ReplaceMouse(_,_)) |PhysicsInstruction::StrafeTick => (), _=>println!("{}|{:?}",ins.time,ins.instruction), } //selectively update body match &ins.instruction { //PhysicsInstruction::Input(InputInstruction::MoveMouse(_)) => (),//dodge time for mouse movement PhysicsInstruction::Input(_) |PhysicsInstruction::ReachWalkTargetVelocity |PhysicsInstruction::CollisionStart(_) |PhysicsInstruction::CollisionEnd(_) |PhysicsInstruction::StrafeTick => self.advance_time(ins.time), } match ins.instruction { PhysicsInstruction::CollisionStart(c) => { let model=c.model(&self.models).unwrap(); match &model.attributes{ PhysicsCollisionAttributes::Contact{contacting,general}=>{ match &contacting.surf{ Some(surf)=>println!("I'm surfing!"), None=>match &c.face { TreyMeshFace::Top => { //ground self.grounded=true; }, _ => (), }, } //check ground self.contacts.insert(c.model,c); match &general.stage_element{ Some(stage_element)=>{ if stage_element.force||self.game.stage_id(), crate::model::StageElementBehaviour::Trigger |crate::model::StageElementBehaviour::Teleport=>{ //TODO make good if let Some(mode)=self.get_mode(stage_element.mode_id){ if let Some(&spawn)=mode.get_spawn_model_id(self.game.stage_id){ if let Some(model)=self.models.get(spawn as usize){ self.body.position=model.transform.transform_point3(glam::Vec3::Y)+glam::Vec3::Y*(self.style.hitbox_halfsize.y+0.1); //manual clear //for c in self.contacts{process_instruction(CollisionEnd(c))} self.contacts.clear(); self.intersects.clear(); self.body.acceleration=self.style.gravity; self.walk.state=WalkEnum::Reached; self.grounded=false; }else{println!("bad1");} }else{println!("bad2");} }else{println!("bad3");} }, crate::model::StageElementBehaviour::Platform=>(), } }, None=>(), } //flatten v let mut v=self.body.velocity; self.contact_constrain_velocity(&mut v); match &general.booster{ Some(booster)=>{ v+=booster.velocity; self.contact_constrain_velocity(&mut v); }, None=>(), } self.body.velocity=v; if self.grounded&&self.style.get_control(StyleModifiers::CONTROL_JUMP,self.controls){ self.jump(); } self.refresh_walk_target(); }, PhysicsCollisionAttributes::Intersect{intersecting,general}=>{ //I think that setting the velocity to 0 was preventing surface contacts from entering an infinite loop self.intersects.insert(c.model,c); match &general.stage_element{ Some(stage_element)=>{ if stage_element.force||self.game.stage_id(), crate::model::StageElementBehaviour::Trigger |crate::model::StageElementBehaviour::Teleport=>{ //TODO make good if let Some(mode)=self.get_mode(stage_element.mode_id){ if let Some(&spawn)=mode.get_spawn_model_id(self.game.stage_id){ if let Some(model)=self.models.get(spawn as usize){ self.body.position=model.transform.transform_point3(glam::Vec3::Y)+glam::Vec3::Y*(self.style.hitbox_halfsize.y+0.1); //manual clear //for c in self.contacts{process_instruction(CollisionEnd(c))} self.contacts.clear(); self.intersects.clear(); self.body.acceleration=self.style.gravity; self.walk.state=WalkEnum::Reached; self.grounded=false; }else{println!("bad1");} }else{println!("bad2");} }else{println!("bad3");} }, crate::model::StageElementBehaviour::Platform=>(), } }, None=>(), } }, } }, PhysicsInstruction::CollisionEnd(c) => { let model=c.model(&self.models).unwrap(); match &model.attributes{ PhysicsCollisionAttributes::Contact{contacting,general}=>{ self.contacts.remove(&c.model);//remove contact before calling contact_constrain_acceleration let mut a=self.style.gravity; self.contact_constrain_acceleration(&mut a); self.body.acceleration=a; //check ground match &c.face { TreyMeshFace::Top => { self.grounded=false; }, _ => (), } self.refresh_walk_target(); }, PhysicsCollisionAttributes::Intersect{intersecting,general}=>{ self.intersects.remove(&c.model); }, } }, PhysicsInstruction::StrafeTick => { let camera_mat=self.camera.simulate_move_rotation_y(self.camera.mouse.lerp(&self.next_mouse,self.time).x); let control_dir=camera_mat*self.style.get_control_dir(self.controls); let d=self.body.velocity.dot(control_dir); if d { //precisely set velocity let mut a=glam::Vec3::ZERO; self.contact_constrain_acceleration(&mut a); self.body.acceleration=a; let mut v=self.walk.target_velocity; self.contact_constrain_velocity(&mut v); self.body.velocity=v; self.walk.state=WalkEnum::Reached; }, PhysicsInstruction::Input(input_instruction) => { let mut refresh_walk_target=true; let mut refresh_walk_target_velocity=true; match input_instruction{ PhysicsInputInstruction::SetNextMouse(m) => { self.camera.angles=self.camera.simulate_move_angles(self.next_mouse.pos); (self.camera.mouse,self.next_mouse)=(self.next_mouse.clone(),m); }, PhysicsInputInstruction::ReplaceMouse(m0,m1) => { self.camera.angles=self.camera.simulate_move_angles(m0.pos); (self.camera.mouse,self.next_mouse)=(m0,m1); }, PhysicsInputInstruction::SetMoveForward(s) => self.set_control(StyleModifiers::CONTROL_MOVEFORWARD,s), PhysicsInputInstruction::SetMoveLeft(s) => self.set_control(StyleModifiers::CONTROL_MOVELEFT,s), PhysicsInputInstruction::SetMoveBack(s) => self.set_control(StyleModifiers::CONTROL_MOVEBACK,s), PhysicsInputInstruction::SetMoveRight(s) => self.set_control(StyleModifiers::CONTROL_MOVERIGHT,s), PhysicsInputInstruction::SetMoveUp(s) => self.set_control(StyleModifiers::CONTROL_MOVEUP,s), PhysicsInputInstruction::SetMoveDown(s) => self.set_control(StyleModifiers::CONTROL_MOVEDOWN,s), PhysicsInputInstruction::SetJump(s) => { self.set_control(StyleModifiers::CONTROL_JUMP,s); if self.grounded{ self.jump(); } refresh_walk_target_velocity=false; }, PhysicsInputInstruction::SetZoom(s) => { self.set_control(StyleModifiers::CONTROL_ZOOM,s); refresh_walk_target=false; }, PhysicsInputInstruction::Reset => { //temp self.body.position=self.spawn_point; self.body.velocity=glam::Vec3::ZERO; //manual clear //for c in self.contacts{process_instruction(CollisionEnd(c))} self.contacts.clear(); self.body.acceleration=self.style.gravity; self.walk.state=WalkEnum::Reached; self.grounded=false; refresh_walk_target=false; }, PhysicsInputInstruction::Idle => {refresh_walk_target=false;},//literally idle! } if refresh_walk_target{ //calculate walk target velocity if refresh_walk_target_velocity{ let camera_mat=self.camera.simulate_move_rotation_y(self.camera.mouse.lerp(&self.next_mouse,self.time).x); let control_dir=camera_mat*self.style.get_control_dir(self.controls); self.walk.target_velocity=self.style.walkspeed*control_dir; } self.refresh_walk_target(); } }, } } }