forked from StrafesNET/strafe-client
combine crawl into one loop
This commit is contained in:
parent
8839b8fbb3
commit
e6c955a958
@ -111,17 +111,3 @@ pub fn crawl_fev<F:Copy,E:Copy+DirectedEdge,V:Copy>(mut fev:FEV<F,E,V>,mesh:&imp
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
pub enum CrawlResult<F,E:DirectedEdge,V>{
|
|
||||||
Closest(FEV<F,E,V>),
|
|
||||||
Hit(F,Time),
|
|
||||||
}
|
|
||||||
pub fn crawl_fev_from_negative_infinity<F:Copy,E:Copy+DirectedEdge,V:Copy>(mut fev:FEV<F,E,V>,mesh:&impl MeshQuery<F,E,V>,relative_body:&Body,time_limit:Time)->CrawlResult<F,E,V>{
|
|
||||||
let mut time=Time::MIN;
|
|
||||||
loop{
|
|
||||||
match next_transition(&fev,time,mesh,relative_body,time_limit){
|
|
||||||
Transition::Miss=>return CrawlResult::Closest(fev),
|
|
||||||
Transition::Next(next_fev,next_time)=>(fev,time)=(next_fev,next_time),
|
|
||||||
Transition::Hit(face,time)=>return CrawlResult::Hit(face,time),//algorithm breaks down inside without full fat voronoi
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
@ -356,23 +356,18 @@ impl MinkowskiMesh<'_>{
|
|||||||
pub fn predict_collision_in(&self,relative_body:&crate::physics::Body,time_limit:crate::integer::Time)->Option<(MinkowskiFace,crate::integer::Time)>{
|
pub fn predict_collision_in(&self,relative_body:&crate::physics::Body,time_limit:crate::integer::Time)->Option<(MinkowskiFace,crate::integer::Time)>{
|
||||||
(-relative_body.clone()).infinity_dir().map_or(None,|dir|{
|
(-relative_body.clone()).infinity_dir().map_or(None,|dir|{
|
||||||
let start_vert=FEV::<MinkowskiFace,MinkowskiDirectedEdge,MinkowskiVert>::Vert(self.farthest_vert(dir));
|
let start_vert=FEV::<MinkowskiFace,MinkowskiDirectedEdge,MinkowskiVert>::Vert(self.farthest_vert(dir));
|
||||||
match crate::face_crawler::crawl_fev_from_negative_infinity(start_vert,self,relative_body,relative_body.time){
|
let start_time=crate::integer::Time::MIN;//relative_body.time
|
||||||
crate::face_crawler::CrawlResult::Closest(fev)=>{
|
crate::face_crawler::crawl_fev(start_vert,self,relative_body,start_time,time_limit)
|
||||||
crate::face_crawler::crawl_fev(fev,self,relative_body,relative_body.time,time_limit)
|
|
||||||
},
|
|
||||||
crate::face_crawler::CrawlResult::Hit(_,_)=>None,//already in or passed
|
|
||||||
}
|
|
||||||
})
|
})
|
||||||
}
|
}
|
||||||
pub fn predict_collision_out(&self,relative_body:&crate::physics::Body,time_limit:crate::integer::Time)->Option<(MinkowskiFace,crate::integer::Time)>{
|
pub fn predict_collision_out(&self,relative_body:&crate::physics::Body,time_limit:crate::integer::Time)->Option<(MinkowskiFace,crate::integer::Time)>{
|
||||||
|
//This doesn't work if the out-path goes back in. it must be the final exit.
|
||||||
relative_body.infinity_dir().map_or(None,|dir|{
|
relative_body.infinity_dir().map_or(None,|dir|{
|
||||||
let start_vert=FEV::<MinkowskiFace,MinkowskiDirectedEdge,MinkowskiVert>::Vert(self.farthest_vert(dir));
|
let start_vert=FEV::<MinkowskiFace,MinkowskiDirectedEdge,MinkowskiVert>::Vert(self.farthest_vert(dir));
|
||||||
match crate::face_crawler::crawl_fev_from_negative_infinity(start_vert,self,&-relative_body.clone(),-time_limit){
|
let start_time=crate::integer::Time::MIN;//-time_limit
|
||||||
crate::face_crawler::CrawlResult::Closest(fev)=>{
|
crate::face_crawler::crawl_fev(start_vert,self,&-relative_body.clone(),start_time,-relative_body.time)
|
||||||
crate::face_crawler::crawl_fev(fev,self,&-relative_body.clone(),-time_limit,-relative_body.time).map(|t|(t.0,-t.1))
|
.filter(|t|-t.1<time_limit)
|
||||||
},
|
.map(|t|(t.0,-t.1))
|
||||||
crate::face_crawler::CrawlResult::Hit(face,time)=>Some((face,-time)),
|
|
||||||
}
|
|
||||||
})
|
})
|
||||||
}
|
}
|
||||||
pub fn predict_collision_face_out(&self,relative_body:&crate::physics::Body,time_limit:crate::integer::Time,contact_face_id:MinkowskiFace)->Option<(MinkowskiEdge,crate::integer::Time)>{
|
pub fn predict_collision_face_out(&self,relative_body:&crate::physics::Body,time_limit:crate::integer::Time,contact_face_id:MinkowskiFace)->Option<(MinkowskiEdge,crate::integer::Time)>{
|
||||||
|
Loading…
Reference in New Issue
Block a user