Refactored how collision ojects are published
Created new collision objects test and roslaunch file
Optimized header file
Removed loadCollisionPub() function
Fixed publishCollisionFloor
Added publishCollisionRectangle