General cleanup and fix of orientation on interaction markers

Moved standard action callbacks to own section for ease of readability
Updated collision marker publishing call to add orientation (to debug in RVIZ)
Confirmed function of x,y,z move and rotation of added shape in RVIZ for collisions