Make parser more general

  - do not assume that base link is called "base_link".