Bugfix to ATLAS bug; URDFReader now works properly