center: [0.5, 0.0, 0.25]
q:  [0.0, -1.39, 0.0, -2.36, 0.0, 1.57, 0.79]
objects:
- object_id: ycb/006_mustard_bottle
  xyz: [-0.1, 0.13, 0.1]
  rpy: [0, 0, 100]
  scale: 0.8
- object_id: active_perception/box2
  xyz: [0.05, 0.15, 0.3]
  rpy: [90, 0, -10]
  scale: 1.0