Fix Android covariance matrix setting
Don't require packages in URDFParser.
Adds missing return in Reader class.