Working version with new CRAM#3

lizyazpin wants to merge 4 commits intocram-code:mastercram-code/cram_gazebo:masterfrom

lizyazpin:masterlizyazpin/cram_gazebo:masterCopy head branch name to clipboard