StrafesNET/strafe-client
5
Fork 3
Code Issues 2 Pull Requests 1 Packages Projects Releases 1 Wiki Activity

write mesh closest_fev

Browse Source
This commit is contained in:
Quaternions 2023-11-01 15:52:19 -07:00
parent cee6835af6
commit d9966a4eb0
1 changed files with 26 additions and 28 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

54
src/model_physics.rs
View File

@ -169,12 +169,13 @@ pub trait MeshQuery<FACE:Clone,EDGE:Clone,VERT:Clone>{
} }
impl MeshQuery<FaceId,EdgeId,VertId> for PhysicsMesh{ impl MeshQuery<FaceId,EdgeId,VertId> for PhysicsMesh{
fn closest_fev(&self,point:Planar64Vec3)->FEV<FaceId,EdgeId,VertId>{ fn closest_fev(&self,point:Planar64Vec3)->FEV<FaceId,EdgeId,VertId>{
//put some genius code right here //TODO: put some genius code right here
//TODO write genius code //brute force for now
//brute force
let mut best_distance_squared=Planar64::MAX; let mut best_distance_squared=Planar64::MAX;
let mut best_fev:FEV<FaceId,EdgeId,VertId>; //make something up as default ret
//hopefully empty meshes don't make their way through here
let mut best_fev=FEV::<FaceId,EdgeId,VertId>::Vert(VertId(0));
//check each vert //check each vert
for (i,v) in self.verts.iter().enumerate(){ for (i,v) in self.verts.iter().enumerate(){
let d=(v.0-point).dot(v.0-point); let d=(v.0-point).dot(v.0-point);
@ -183,34 +184,31 @@ impl MeshQuery<FaceId,EdgeId,VertId> for PhysicsMesh{
best_fev=FEV::<FaceId,EdgeId,VertId>::Vert(VertId(i)); best_fev=FEV::<FaceId,EdgeId,VertId>::Vert(VertId(i));
} }
} }
let face_dots=self.faces.iter().map(|f|f.normal.dot(point));
//check each edge //check each edge
for (i,v) in self.edge_topology.iter().enumerate(){ for (i,e) in self.edge_topology.iter().enumerate(){
let verts=self.edge_verts(EdgeId(i)); let v0=self.vert(e.verts[0]);
if verts.iter().all(|&(vert_id,face_id)|{ let v1=self.vert(e.verts[1]);
let (n,d)=self.face_nd(face_id); let n=v1-v0;
n.dot(point)<d //n.cross(point-v0)=sin(t)*n*dis
}){ let d=n.dot(point-v0);
//this is also wrong if d<n.dot(v1)&&n.dot(v0)<d{
} let c=n.cross(point-v0);
let faces=self.edge_faces(EdgeId(i)); let edge_distance_squared=c.dot(c)/n.dot(n);
//try not to do this if edge_distance_squared<best_distance_squared{
//let edge_dir=self.faces[faces[0].0].normal.cross(self.faces[faces[1].0].normal); best_distance_squared=edge_distance_squared;
let face_dot=self.faces[faces[0].0].normal.dot(self.faces[faces[1].0].normal); best_fev=FEV::<FaceId,EdgeId,VertId>::Edge(EdgeId(i));
let edge_face_dots=faces.map(|face_id|{ }
let (n,d)=self.face_nd(face_id);
n.dot(point)-d
});
//wrong! face normals are not normalized! 1+d will not work!
let edge_distance=(edge_face_dots[0]+edge_face_dots[1])/(Planar64::ONE+face_dot);
//use the face d values and 1+d
if edge_distance*edge_distance<best_distance_squared{
best_distance_squared=edge_distance*edge_distance;
best_fev=FEV::<FaceId,EdgeId,VertId>::Edge(EdgeId(i));
} }
} }
let face_dots:Vec<Planar64>=self.faces.iter().map(|f|f.normal.dot(point)).collect();
//check each face //check each face
todo!() for (i,f) in self.face_topology.iter().enumerate(){
if face_dots[i]<best_distance_squared&&f.edges.iter().all(|&(_,face_id)|face_dots[face_id.0]<=Planar64::ZERO){
best_distance_squared=face_dots[i];
best_fev=FEV::<FaceId,EdgeId,VertId>::Face(FaceId(i));
}
}
best_fev
} }
fn face_nd(&self,face_id:FaceId)->(Planar64Vec3,Planar64){ fn face_nd(&self,face_id:FaceId)->(Planar64Vec3,Planar64){
(self.faces[face_id.0].normal,self.faces[face_id.0].dot) (self.faces[face_id.0].normal,self.faces[face_id.0].dot)