Make sure non static models use generated meshes

Signed-off-by: Luca Della Vedova <lucadv@intrinsic.ai>
open-rmf · May 31, 2024 · adc1752 · adc1752
1 parent abb7544
commit adc1752
Showing 1 changed file with 23 additions and 4 deletions.
diff --git a/rmf_site_format/src/sdf.rs b/rmf_site_format/src/sdf.rs
@@ -522,11 +522,30 @@ impl Site {
                 // TODO(luca) this will duplicate multiple instances of the model since it uses
                 // NameInSite instead of AssetSource for the URI, fix
                 else if !model.is_static.0 {
-                    world.include.push(SdfWorldInclude {
-                        uri: format!("model://{}", model.name.0.clone()),
-                        name: Some(model.name.0.clone()),
-                        pose: Some(model.pose.to_sdf()),
+                    world.model.push(SdfModel {
+                        name: model.name.0.clone(),
                         r#static: Some(model.is_static.0),
+                        pose: Some(model.pose.to_sdf()),
+                        link: vec![SdfLink {
+                            name: "link".into(),
+                            collision: vec![SdfCollision {
+                                name: "collision".into(),
+                                geometry: SdfGeometry::Mesh(SdfMeshShape {
+                                    uri: format!("meshes/{}_collision.glb", model.name.0),
+                                    ..Default::default()
+                                }),
+                                ..Default::default()
+                            }],
+                            visual: vec![SdfVisual {
+                                name: "visual".into(),
+                                geometry: SdfGeometry::Mesh(SdfMeshShape {
+                                    uri: format!("meshes/{}_visual.glb", model.name.0),
+                                    ..Default::default()
+                                }),
+                                ..Default::default()
+                            }],
+                            ..Default::default()
+                        }],
                         ..Default::default()
                     });
                     added = true;