Add yourdfpy loader

Author: stephane-caron

CHANGELOG.md

@@ -2,6 +2,12 @@
 
 All notable changes to this project will be documented in this file.
 
+## Unreleased
+
+### Added
+
+- Loader: yourdfpy
+
 ## [0.5.0] - 2022/09/19
 
 ### Added

robot_descriptions/loaders/yourdfpy.py

@@ -0,0 +1,41 @@
+#!/usr/bin/env python3
+# -*- coding: utf-8 -*-
+#
+# Copyright 2022 Stéphane Caron
+#
+# Licensed under the Apache License, Version 2.0 (the "License");
+# you may not use this file except in compliance with the License.
+# You may obtain a copy of the License at
+#
+#     http://www.apache.org/licenses/LICENSE-2.0
+#
+# Unless required by applicable law or agreed to in writing, software
+# distributed under the License is distributed on an "AS IS" BASIS,
+# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+# See the License for the specific language governing permissions and
+# limitations under the License.
+
+"""
+Load a robot description in yourdfpy.
+"""
+
+from importlib import import_module  # type: ignore
+
+import yourdfpy
+
+
+def load_robot_description(description_name: str) -> yourdfpy.URDF:
+    """
+    Load a robot description in yourdfpy.
+
+    Args:
+        description_name: Name of the robot description.
+
+    Returns:
+        Robot model for yourdfpy.
+    """
+    module = import_module(f"robot_descriptions.{description_name}")
+    if not hasattr(module, "URDF_PATH"):
+        raise ValueError(f"{description_name} is not a URDF description")
+
+    return yourdfpy.URDF.load(module.URDF_PATH)