Insert and erase transformable marker dynamically

- add service `insert_marker` and `erase_marker`
- add service `get_type` to get shape type of focused marker.
- use Eigen for transformation in addPose()
- apply tf transformation before setPose() (this is bug fix. thank you @garaemon.)