strafe-client-jed/src/model_physics.rs

150 lines
3.8 KiB
Rust
Raw Normal View History

2023-10-26 23:18:32 +00:00
use crate::integer::{Planar64,Planar64Vec3};
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
pub trait MeshQuery<FACE,EDGE,VERT>{
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;
fn face_edges(&self,face_id:FACE)->&Vec<(EDGE,FACE)>;
fn edge_side_faces(&self,edge_id:EDGE)->&[FACE;2];
fn edge_ends(&self,edge_id:EDGE)->&[(VERT,FACE);2];
fn vert_edges(&self,vert_id:VERT)->&Vec<(EDGE,FACE)>;
}
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!()
}
fn face_edges(&self,face_id:FaceId)->&Vec<(EdgeId,FaceId)>{
2023-10-26 23:28:07 +00:00
&self.face_topology[face_id.0].edges
2023-10-26 23:18:32 +00:00
}
2023-10-27 21:18:50 +00:00
fn edge_side_faces(&self,edge_id:EdgeId)->&[FaceId;2]{
2023-10-26 23:28:07 +00:00
&self.edge_topology[edge_id.0].faces
2023-10-26 23:18:32 +00:00
}
2023-10-27 21:18:50 +00:00
fn edge_ends(&self,edge_id:EdgeId)->&[(VertId,FaceId);2]{
2023-10-26 23:28:07 +00:00
&self.edge_topology[edge_id.0].verts
2023-10-26 23:18:32 +00:00
}
2023-10-27 21:18:50 +00:00
fn vert_edges(&self,vert_id:VertId)->&Vec<(EdgeId,FaceId)>{
2023-10-26 23:28:07 +00:00
&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!()
}
fn face_edges(&self,face_id:MinkowskiFace)->&Vec<(MinkowskiEdge,MinkowskiFace)>{
2023-10-27 03:52:28 +00:00
todo!()
}
2023-10-27 21:18:50 +00:00
fn edge_side_faces(&self,edge_id:MinkowskiEdge)->&[MinkowskiFace;2]{
2023-10-27 03:52:28 +00:00
todo!()
}
2023-10-27 21:18:50 +00:00
fn edge_ends(&self,edge_id:MinkowskiEdge)->&[(MinkowskiVert,MinkowskiFace);2]{
2023-10-27 03:52:28 +00:00
todo!()
}
2023-10-27 21:18:50 +00:00
fn vert_edges(&self,vert_id:MinkowskiVert)->&Vec<(MinkowskiEdge,MinkowskiFace)>{
2023-10-27 03:52:28 +00:00
todo!()
}
2023-10-26 23:18:32 +00:00
}