Revised Icra 2013 demo for latest brics_3d version.