stopgap measure for handling use of 'package:/' in URDFs for #271

Merged with the current master, and only contains urdf-parsing related changes.
Please group the header inclusions of the same library by removing empty lines between them