Set initial robot state before calling IK to create more initial states from goal poses (this is necessary because of the torso height affecting what points are reachable).
Update queries with a second initial state and fridge queries.
Stick modified bookshelves in /data too.