performance alignment

Author: WCJ-BERT

projects/SimEngine/worldengine/render/mtgs/mtgs.py

@@ -425,7 +425,7 @@ def get_agent_pose(self, name, agent_state, return_matrix=False):
             agent2global = torch.zeros(4, 4, device=self.device, dtype=torch.float64)
             agent2global[:3, :3] = new_rot_matrix
             agent2global[:3, 3] = new_trans
-            agent2global[3, 3] = 1.0
+            # agent2global[3, 3] = 1.0   Should be set,but we keep this bug to reproduce the same performance. # May cause history traj calculation wrong.
             return agent2global
         else:
             quat = matrix_to_quaternion(new_rot_matrix)