From 1372e1230163a5cdf8b355208096f41c0be23046 Mon Sep 17 00:00:00 2001
From: Quaternions <krakow20@gmail.com>
Date: Thu, 22 Aug 2024 19:38:46 -0700
Subject: [PATCH] match the exact ordering of the source code

---
 src/push_solve.rs | 12 ++++++++----
 1 file changed, 8 insertions(+), 4 deletions(-)

diff --git a/src/push_solve.rs b/src/push_solve.rs
index 824dea1..aa61ba9 100644
--- a/src/push_solve.rs
+++ b/src/push_solve.rs
@@ -301,11 +301,15 @@ pub fn push_solve(contacts:&Vec<Contact>,point:Planar64Vec3)->Option<Planar64Vec
 			return Some(ray.origin);
 		}
 
-		//edit the indices
-		if conts.len()==4{
-			conts.pop();
+		//push_front
+		if conts.len()==conts.capacity(){
+			//this is a dead case, new_conts never has more than 3 elements
+			conts.rotate_right(1);
+			conts[0]=next_cont;
+		}else{
+			conts.push(next_cont);
+			conts.rotate_right(1);
 		}
-		conts.push(next_cont);
 
 		let meet_point=ray.extrapolate(next_t);
 		match get_best_push_ray_and_conts(meet_point,conts){