Fix one-way collision for already colliding bodies

Author: DinkeyKing

modules/godot_physics_2d/godot_body_pair_2d.cpp

@@ -316,41 +316,39 @@ bool GodotBodyPair2D::setup(real_t p_step) {
 		return false;
 	}
 
-	if (!prev_collided) {
-		if (shape_B_ptr->allows_one_way_collision() && A->is_shape_set_as_one_way_collision(shape_A)) {
-			Vector2 direction = xform_A.columns[1].normalized();
-			bool valid = false;
-			for (int i = 0; i < contact_count; i++) {
-				Contact &c = contacts[i];
-				if (c.normal.dot(direction) > -CMP_EPSILON) { // Greater (normal inverted).
-					continue;
-				}
-				valid = true;
-				break;
-			}
-			if (!valid) {
-				collided = false;
-				oneway_disabled = true;
-				return false;
+	if (shape_B_ptr->allows_one_way_collision() && A->is_shape_set_as_one_way_collision(shape_A)) {
+		Vector2 direction = xform_A.columns[1].normalized();
+		bool valid = false;
+		for (int i = 0; i < contact_count; i++) {
+			Contact &c = contacts[i];
+			if (c.normal.dot(direction) > -CMP_EPSILON) { // Greater (normal inverted).
+				continue;
 			}
+			valid = true;
+			break;
 		}
+		if (!valid) {
+			collided = false;
+			oneway_disabled = true;
+			return false;
+		}
+	}
 
-		if (shape_A_ptr->allows_one_way_collision() && B->is_shape_set_as_one_way_collision(shape_B)) {
-			Vector2 direction = xform_B.columns[1].normalized();
-			bool valid = false;
-			for (int i = 0; i < contact_count; i++) {
-				Contact &c = contacts[i];
-				if (c.normal.dot(direction) < CMP_EPSILON) { // Less (normal ok).
-					continue;
-				}
-				valid = true;
-				break;
-			}
-			if (!valid) {
-				collided = false;
-				oneway_disabled = true;
-				return false;
+	if (shape_A_ptr->allows_one_way_collision() && B->is_shape_set_as_one_way_collision(shape_B)) {
+		Vector2 direction = xform_B.columns[1].normalized();
+		bool valid = false;
+		for (int i = 0; i < contact_count; i++) {
+			Contact &c = contacts[i];
+			if (c.normal.dot(direction) < CMP_EPSILON) { // Less (normal ok).
+				continue;
 			}
+			valid = true;
+			break;
+		}
+		if (!valid) {
+			collided = false;
+			oneway_disabled = true;
+			return false;
 		}
 	}