Something like: using known ground truth pose of a cube, plan a collision free trajectory including pre-grasp locations with Cartesian motions, etc.

Can connect to MuJoCo to demonstrate this tool with something that has physics