Added a more elaborate function set for collision environment settings

The collision environment objects now have to be only registered once (name + shape messages) and can from the on be referred to by their name.