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.0, 0.0, 1.6]
  rpy: [0, 0, 0]
  scale: 0.8
- object_id: active_perception/box2
  xyz: [0.0, 0.0, 1.3]
  rpy: [0, 0, 0]
  scale: 0.85