Increment index when populating PhysicsShapeQueryParameters exclude array.

servers/physics_server_2d.cpp

@@ -197,7 +197,7 @@ Vector<RID> PhysicsShapeQueryParameters2D::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;
 }

servers/physics_server_3d.cpp

@@ -193,7 +193,7 @@ Vector<RID> PhysicsShapeQueryParameters3D::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;
 }