luckyrobots/open_phantom
13
0
Fork 0
mirror of https://github.com/luckyrobots/open_phantom.git synced 2025-04-03 10:32:19 +00:00
Code Issues 4 Packages Projects Releases Wiki Activity

add case handling with urdf

Browse Source
This commit is contained in:
Ethan Clark 2025-03-25 16:10:11 -07:00
parent 55317d3ac2
commit 685854ecbd
1 changed files with 14 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

19
open_phantom/utils/handle_urdf.py
View File

@ -83,16 +83,25 @@ def handle_urdf(urdf_path: str) -> str:
try:
urdf_dir = os.path.dirname(urdf_path)
robot_base_dir = os.path.dirname(urdf_dir)
root, fixed_path = fix_mesh_paths(urdf_path, robot_base_dir)
format_xml(root, fixed_path)
print(f"Successfully processed URDF: {fixed_path}")
return fixed_path
if urdf_path.endswith("_fixed.urdf"):
print("URDF is already fixed. Skipping processing.")
fixed_path = urdf_path
elif os.path.exists(urdf_path.replace(".urdf", "_fixed.urdf")):
print("Fixed URDF already exists. Skipping processing.")
fixed_path = urdf_path.replace(".urdf", "_fixed.urdf")
else:
print("Processing URDF...")
robot_base_dir = os.path.dirname(urdf_dir)
root, fixed_path = fix_mesh_paths(urdf_path, robot_base_dir)
format_xml(root, fixed_path)
print(f"Successfully processed URDF: {fixed_path}")
except Exception as e:
print(f"Failed to process URDF: {e}")
raise e
return fixed_path
if __name__ == "__main__":
# Example usage