restructured rviz interface, fixed memory leaks
experimental test file for humanoids paper