object stacking benchmark

Hi @scpeters , thanks for sharing this benchmarks.
  I was wondering if somewhere you had the code for the object stacking benchmark, mentioned at slide 16 of http://www.osrfoundation.org/wordpress2/wp-content/uploads/2015/04/roscon2014_scpeters.pdf . 

 Thanks a lot!