New publishCollisionObjectMsg() function
New getSharedRobotState() accessor function
Consolidated publish marker functions
Fixed loadEEMarker() to be called more than once