diff --git a/servers/physics_2d_server.cpp b/servers/physics_2d_server.cpp
index b8c6d0c9bac..f1a4d346a21 100644
--- a/servers/physics_2d_server.cpp
+++ b/servers/physics_2d_server.cpp
@@ -188,7 +188,7 @@ Vector<RID> Physics2DShapeQueryParameters::get_exclude() const {
 	ret.resize(exclude.size());
 	int idx = 0;
 	for (Set<RID>::Element *E = exclude.front(); E; E = E->next()) {
-		ret.write[idx] = E->get();
+		ret.write[idx++] = E->get();
 	}
 	return ret;
 }
diff --git a/servers/physics_server.cpp b/servers/physics_server.cpp
index 89f9f81d3d9..15e94d45be6 100644
--- a/servers/physics_server.cpp
+++ b/servers/physics_server.cpp
@@ -186,7 +186,7 @@ Vector<RID> PhysicsShapeQueryParameters::get_exclude() const {
 	ret.resize(exclude.size());
 	int idx = 0;
 	for (Set<RID>::Element *E = exclude.front(); E; E = E->next()) {
-		ret.write[idx] = E->get();
+		ret.write[idx++] = E->get();
 	}
 	return ret;
 }