Add center marker to urdf control marker

Add center marker to urdf control marker.
Refactor interactive_marker_utils.cpp

![screenshot_from_2014-10-24 11 47 00](https://cloud.githubusercontent.com/assets/4415085/4764574/0a7e7eee-5b28-11e4-812b-e3570d012aca.png)