added collision checking code for the interactive marker so that you know when things are in collision as you are moving them around
added a boost program option for the planning scene topics so that the collision checks can be done