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

introduce dot128

Browse Source
This commit is contained in:
Quaternions 2023-11-08 20:23:22 -08:00
parent 6049aba716
commit 27a46093ae
2 changed files with 12 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
src/integer.rs
View File

@ -645,6 +645,12 @@ impl Planar64Vec3{
)>>32) as i64) )>>32) as i64)
} }
#[inline] #[inline]
pub fn dot128(&self,rhs:Self)->i128{
(self.0.x as i128)*(rhs.0.x as i128)+
(self.0.y as i128)*(rhs.0.y as i128)+
(self.0.z as i128)*(rhs.0.z as i128)
}
#[inline]
pub fn cross(&self,rhs:Self)->Planar64Vec3{ pub fn cross(&self,rhs:Self)->Planar64Vec3{
Planar64Vec3(glam::i64vec3( Planar64Vec3(glam::i64vec3(
(((self.0.y as i128)*(rhs.0.z as i128)-(self.0.z as i128)*(rhs.0.y as i128))>>32) as i64, (((self.0.y as i128)*(rhs.0.z as i128)-(self.0.z as i128)*(rhs.0.y as i128))>>32) as i64,

12
src/physics.rs
View File

@ -794,9 +794,9 @@ impl TouchingState{
//TODO: trey push solve //TODO: trey push solve
for contact in &self.contacts{ for contact in &self.contacts{
let n=models.mesh(contact.model_id).face_nd(contact.face_id).0; let n=models.mesh(contact.model_id).face_nd(contact.face_id).0;
let d=n.dot(*velocity); let d=n.dot128(*velocity);
if d<Planar64::ZERO{ if d<0{
*velocity-=n*(d/n.dot(n)); *velocity-=n*Planar64::raw(((d<<32)/n.dot128(n)) as i64);
} }
} }
} }
@ -804,9 +804,9 @@ impl TouchingState{
//TODO: trey push solve //TODO: trey push solve
for contact in &self.contacts{ for contact in &self.contacts{
let n=models.mesh(contact.model_id).face_nd(contact.face_id).0; let n=models.mesh(contact.model_id).face_nd(contact.face_id).0;
let d=n.dot(*acceleration); let d=n.dot128(*acceleration);
if d<Planar64::ZERO{ if d<0{
*acceleration-=n*(d/n.dot(n)); *acceleration-=n*Planar64::raw(((d<<32)/n.dot128(n)) as i64);
} }
} }
} }