From 535ae1a5f04bf55ece9aeb0637b6a1ccb6e6bd87 Mon Sep 17 00:00:00 2001
From: Quaternions <krakow20@gmail.com>
Date: Mon, 6 Nov 2023 16:35:42 -0800
Subject: [PATCH] fix constrain

---
 src/physics.rs | 8 ++++++--
 1 file changed, 6 insertions(+), 2 deletions(-)

diff --git a/src/physics.rs b/src/physics.rs
index 51084e5..3c88061 100644
--- a/src/physics.rs
+++ b/src/physics.rs
@@ -748,7 +748,9 @@ impl TouchingState{
 		for contact in &self.contacts{
 			let (n,_)=models.mesh(contact.model_id).face_nd(contact.face_id);
 			let d=n.dot(*velocity);
-			*velocity-=n*(d/n.dot(n));
+			if d<Planar64::ZERO{
+				*velocity-=n*(d/n.dot(n));
+			}
 		}
 	}
 	fn constrain_acceleration(&self,models:&PhysicsModels,acceleration:&mut Planar64Vec3){
@@ -756,7 +758,9 @@ impl TouchingState{
 		for contact in &self.contacts{
 			let n=models.mesh(contact.model_id).face_nd(contact.face_id).0;
 			let d=n.dot(*acceleration);
-			*acceleration-=n*(d/n.dot(n));
+			if d<Planar64::ZERO{
+				*acceleration-=n*(d/n.dot(n));
+			}
 		}
 	}
 	fn get_move_state(&self,mut a:Planar64Vec3)->(MoveState,Planar64Vec3){