2023-10-26 23:18:32 +00:00
|
|
|
use crate::integer::{Planar64,Planar64Vec3};
|
2023-10-27 22:10:38 +00:00
|
|
|
use std::borrow::Cow;
|
2023-10-26 23:18:32 +00:00
|
|
|
|
2023-10-27 02:38:34 +00:00
|
|
|
#[derive(Clone,Copy)]
|
2023-10-26 23:18:32 +00:00
|
|
|
pub struct VertId(usize);
|
2023-10-27 02:38:34 +00:00
|
|
|
#[derive(Clone,Copy)]
|
2023-10-26 23:18:32 +00:00
|
|
|
pub struct EdgeId(usize);
|
2023-10-27 02:38:34 +00:00
|
|
|
#[derive(Clone,Copy)]
|
2023-10-26 23:18:32 +00:00
|
|
|
pub struct FaceId(usize);
|
|
|
|
|
|
|
|
//Vertex <-> Edge <-> Face -> Collide
|
2023-10-27 21:18:50 +00:00
|
|
|
pub enum FEV<F,E,V>{
|
|
|
|
Face(F),
|
|
|
|
Edge(E),
|
|
|
|
Vert(V),
|
2023-10-26 23:18:32 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
//use Unit32 #[repr(C)] for map files
|
|
|
|
struct Face{
|
|
|
|
normal:Planar64Vec3,
|
|
|
|
dot:Planar64,
|
|
|
|
}
|
2023-10-27 21:18:50 +00:00
|
|
|
struct Vert(Planar64Vec3);
|
2023-10-26 23:18:32 +00:00
|
|
|
struct FaceRefs{
|
2023-10-27 02:38:34 +00:00
|
|
|
edges:Vec<(EdgeId,FaceId)>,
|
2023-10-26 23:18:32 +00:00
|
|
|
verts:Vec<VertId>,
|
|
|
|
}
|
|
|
|
struct EdgeRefs{
|
2023-10-26 23:28:07 +00:00
|
|
|
faces:[FaceId;2],//left, right
|
2023-10-27 02:38:34 +00:00
|
|
|
verts:[(VertId,FaceId);2],//bottom, top
|
2023-10-26 23:18:32 +00:00
|
|
|
}
|
|
|
|
struct VertRefs{
|
2023-10-27 02:38:34 +00:00
|
|
|
edges:Vec<(EdgeId,FaceId)>,
|
2023-10-26 23:18:32 +00:00
|
|
|
}
|
|
|
|
pub struct PhysicsMesh{
|
|
|
|
faces:Vec<Face>,
|
2023-10-27 21:18:50 +00:00
|
|
|
verts:Vec<Vert>,
|
2023-10-26 23:18:32 +00:00
|
|
|
face_topology:Vec<FaceRefs>,
|
|
|
|
edge_topology:Vec<EdgeRefs>,
|
|
|
|
vert_topology:Vec<VertRefs>,
|
|
|
|
}
|
2023-10-27 21:18:50 +00:00
|
|
|
|
2023-10-27 22:10:38 +00:00
|
|
|
pub trait MeshQuery<FACE:Clone,EDGE:Clone,VERT:Clone>{
|
2023-10-27 21:18:50 +00:00
|
|
|
fn closest_fev(&self,point:Planar64Vec3)->FEV<FACE,EDGE,VERT>;
|
|
|
|
fn face_nd(&self,face_id:FACE)->(Planar64Vec3,Planar64);
|
|
|
|
fn vert(&self,vert_id:VERT)->Planar64Vec3;
|
2023-10-27 22:10:38 +00:00
|
|
|
fn face_edges(&self,face_id:FACE)->Cow<Vec<(EDGE,FACE)>>;
|
|
|
|
fn edge_side_faces(&self,edge_id:EDGE)->Cow<[FACE;2]>;
|
|
|
|
fn edge_ends(&self,edge_id:EDGE)->Cow<[(VERT,FACE);2]>;
|
|
|
|
fn vert_edges(&self,vert_id:VERT)->Cow<Vec<(EDGE,FACE)>>;
|
2023-10-27 21:18:50 +00:00
|
|
|
}
|
|
|
|
impl MeshQuery<FaceId,EdgeId,VertId> for PhysicsMesh{
|
|
|
|
fn closest_fev(&self,point:Planar64Vec3)->FEV<FaceId,EdgeId,VertId>{
|
|
|
|
//put some genius code right here
|
|
|
|
todo!()
|
|
|
|
}
|
|
|
|
fn face_nd(&self,face_id:FaceId)->(Planar64Vec3,Planar64){
|
2023-10-27 02:38:34 +00:00
|
|
|
(self.faces[face_id.0].normal,self.faces[face_id.0].dot)
|
2023-10-26 23:43:58 +00:00
|
|
|
}
|
|
|
|
//ideally I never calculate the vertex position, but I have to for the graphical meshes...
|
2023-10-27 21:18:50 +00:00
|
|
|
fn vert(&self,vert_id:VertId)->Planar64Vec3{
|
|
|
|
todo!()
|
|
|
|
}
|
2023-10-27 22:10:38 +00:00
|
|
|
fn face_edges(&self,face_id:FaceId)->Cow<Vec<(EdgeId,FaceId)>>{
|
|
|
|
Cow::Borrowed(&self.face_topology[face_id.0].edges)
|
2023-10-26 23:18:32 +00:00
|
|
|
}
|
2023-10-27 22:10:38 +00:00
|
|
|
fn edge_side_faces(&self,edge_id:EdgeId)->Cow<[FaceId;2]>{
|
|
|
|
Cow::Borrowed(&self.edge_topology[edge_id.0].faces)
|
2023-10-26 23:18:32 +00:00
|
|
|
}
|
2023-10-27 22:10:38 +00:00
|
|
|
fn edge_ends(&self,edge_id:EdgeId)->Cow<[(VertId,FaceId);2]>{
|
|
|
|
Cow::Borrowed(&self.edge_topology[edge_id.0].verts)
|
2023-10-26 23:18:32 +00:00
|
|
|
}
|
2023-10-27 22:10:38 +00:00
|
|
|
fn vert_edges(&self,vert_id:VertId)->Cow<Vec<(EdgeId,FaceId)>>{
|
|
|
|
Cow::Borrowed(&self.vert_topology[vert_id.0].edges)
|
2023-10-26 23:18:32 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
//Note that a face on a minkowski mesh refers to a pair of fevs on the meshes it's summed from
|
|
|
|
//(face,vertex)
|
|
|
|
//(edge,edge)
|
|
|
|
//(vertex,face)
|
2023-10-27 21:18:50 +00:00
|
|
|
#[derive(Clone,Copy)]
|
|
|
|
enum MinkowskiVert{
|
|
|
|
VertVert(VertId,VertId),
|
|
|
|
}
|
|
|
|
#[derive(Clone,Copy)]
|
|
|
|
enum MinkowskiEdge{
|
|
|
|
VertEdge(VertId,EdgeId),
|
|
|
|
EdgeVert(EdgeId,VertId),
|
|
|
|
}
|
|
|
|
#[derive(Clone,Copy)]
|
|
|
|
enum MinkowskiFace{
|
|
|
|
FaceVert(FaceId,VertId),
|
|
|
|
EdgeEdge(EdgeId,EdgeId),
|
|
|
|
VertFace(VertId,FaceId),
|
|
|
|
}
|
2023-10-26 23:18:32 +00:00
|
|
|
|
2023-10-27 21:18:50 +00:00
|
|
|
pub struct MinkowskiMesh<'a>{
|
2023-10-26 23:18:32 +00:00
|
|
|
mesh0:&'a PhysicsMesh,
|
|
|
|
mesh1:&'a PhysicsMesh,
|
|
|
|
}
|
|
|
|
|
2023-10-27 21:18:50 +00:00
|
|
|
impl MinkowskiMesh<'_>{
|
|
|
|
pub fn minkowski_sum<'a>(mesh0:&'a PhysicsMesh,mesh1:&'a PhysicsMesh)->MinkowskiMesh<'a>{
|
|
|
|
MinkowskiMesh{
|
2023-10-26 23:18:32 +00:00
|
|
|
mesh0,
|
|
|
|
mesh1,
|
|
|
|
}
|
|
|
|
}
|
2023-10-27 21:18:50 +00:00
|
|
|
}
|
|
|
|
impl MeshQuery<MinkowskiFace,MinkowskiEdge,MinkowskiVert> for MinkowskiMesh<'_>{
|
|
|
|
fn closest_fev(&self,point:Planar64Vec3)->FEV<MinkowskiFace,MinkowskiEdge,MinkowskiVert>{
|
2023-10-26 23:18:32 +00:00
|
|
|
//put some genius code right here
|
|
|
|
todo!()
|
|
|
|
}
|
2023-10-27 21:18:50 +00:00
|
|
|
fn face_nd(&self,face_id:MinkowskiFace)->(Planar64Vec3,Planar64){
|
2023-10-27 21:19:17 +00:00
|
|
|
match face_id{
|
|
|
|
MinkowskiFace::FaceVert(f0,v1)=>{
|
|
|
|
let (n,d)=self.mesh0.face_nd(f0);
|
|
|
|
(n,d+n.dot(self.mesh1.vert(v1)))
|
|
|
|
},
|
|
|
|
MinkowskiFace::EdgeEdge(e0,e1)=>{
|
|
|
|
let [e0f0,e0f1]=self.mesh0.edge_faces(e0).into_owned();
|
|
|
|
let [e1f0,e1f1]=self.mesh1.edge_faces(e1).into_owned();
|
|
|
|
//cross edge faces
|
|
|
|
//cross crosses
|
|
|
|
todo!()
|
|
|
|
},
|
|
|
|
MinkowskiFace::VertFace(v0,f1)=>{
|
|
|
|
let (n,d)=self.mesh1.face_nd(f1);
|
|
|
|
(-n,d-n.dot(self.mesh0.vert(v0)))
|
|
|
|
},
|
|
|
|
}
|
2023-10-27 03:52:28 +00:00
|
|
|
}
|
2023-10-27 21:18:50 +00:00
|
|
|
fn vert(&self,vert_id:MinkowskiVert)->Planar64Vec3{
|
|
|
|
todo!()
|
|
|
|
}
|
2023-10-27 22:10:38 +00:00
|
|
|
fn face_edges(&self,face_id:MinkowskiFace)->Cow<Vec<(MinkowskiEdge,MinkowskiFace)>>{
|
2023-10-27 03:52:28 +00:00
|
|
|
todo!()
|
|
|
|
}
|
2023-10-27 22:10:38 +00:00
|
|
|
fn edge_side_faces(&self,edge_id:MinkowskiEdge)->Cow<[MinkowskiFace;2]>{
|
2023-10-27 03:52:28 +00:00
|
|
|
todo!()
|
|
|
|
}
|
2023-10-27 22:10:38 +00:00
|
|
|
fn edge_ends(&self,edge_id:MinkowskiEdge)->Cow<[(MinkowskiVert,MinkowskiFace);2]>{
|
2023-10-27 03:52:28 +00:00
|
|
|
todo!()
|
|
|
|
}
|
2023-10-27 22:10:38 +00:00
|
|
|
fn vert_edges(&self,vert_id:MinkowskiVert)->Cow<Vec<(MinkowskiEdge,MinkowskiFace)>>{
|
2023-10-27 03:52:28 +00:00
|
|
|
todo!()
|
|
|
|
}
|
2023-10-26 23:18:32 +00:00
|
|
|
}
|