: to be more general, should we make the reference point a reference pose?
: FIXME map is really wrong, need to use tf here somehow
: does tinyxml have functionality for this?
: should gazebo take care of the declaration?