I need to get the vertices of a cuboid on a conveyor belt and, since I couldn’t find an off-the-shelve function for this, I wrote my own. The problem I’m seeing with it, however, is that the vertices I get are delayed by one or more physics steps.

My approach to getting the vertices is to read the cuboid’s pose and its size (i.e. translation, rotation, and scale) at each physics step using the below functions.

```
# Get the orientation
o = prim.GetAttribute("xformOp:orient").Get()
real = o.GetReal()
imaginary = o.GetImaginary()
# convert to numpy array in the order [w, x, y, z]
rotation_wxyz = np.array([real, imaginary[0], imaginary[1], imaginary[2]])
# Get the translation
t = prim.GetAttribute("xformOp:translate").Get()
# convert to numpy array
translation_xyz = np.array([t[0], t[1], t[2]])
# Get the scale
s = prim.GetAttribute("xformOp:scale").Get()
# convert to numpy array
scale_xyz = np.array([s[0], s[1], s[2]])
```

This is sufficient information to compute the vertices with some trigonometry.

```
from scipy.spatial.transform import Rotation
# Vertices of the cuboid in the local frame
original_vertices = np.array([
[-scale_xyz[0] / 2, -scale_xyz[1] / 2, -scale_xyz[2] / 2],
[scale_xyz[0] / 2, -scale_xyz[1] / 2, -scale_xyz[2] / 2],
[scale_xyz[0] / 2, scale_xyz[1] / 2, -scale_xyz[2] / 2],
[-scale_xyz[0] / 2, scale_xyz[1] / 2, -scale_xyz[2] / 2],
[-scale_xyz[0] / 2, -scale_xyz[1] / 2, scale_xyz[2] / 2],
[scale_xyz[0] / 2, -scale_xyz[1] / 2, scale_xyz[2] / 2],
[scale_xyz[0] / 2, scale_xyz[1] / 2, scale_xyz[2] / 2],
[-scale_xyz[0] / 2, scale_xyz[1] / 2, scale_xyz[2] / 2]
])
# Convert the orientation to a rotation matrix with SciPy
r = Rotation.from_quat([rotation_wxyz[1], rotation_wxyz[2], rotation_wxyz[3], rotation_wxyz[0]])
# Rotate the original vertices in the local frame
rotated_vertices = r.apply(original_vertices)
# Translate the rotated vertices
translated_rotated_vertices = rotated_vertices + translation_xyz
```

However, when I visualize the vertices by translating spheres to the computed vertex locations (of the moving cuboid), I see that they lag behind wrt the actual vertices.

Is a bug? It seems that when requesting the translation, rotation, and scale of the cuboid, it communicates the values of the previous physics step.

Below is an example of this where the spheres represent the computed vertices of the cuboid.