@@ -268,44 +268,6 @@ private void updateOpeningMechanismPoses()
268268 }
269269 }
270270
271- /**
272- * These child nodes are used in behaviors
273- */
274- // private void updateStaticRelativeChildren(SceneGraph sceneGraph, DoorOpeningMechanism openingMechanism)
275- // {
276- // // Recalculate name each time in case the parent name changes
277- // String graspStaticRelativeSceneNodeName = getName() + "_" + openingMechanism.getColloquialName() + "Grasp";
278- //
279- // StaticRelativeSceneNode graspStaticRelativeSceneNode = null;
280- //
281- // for (SceneNode child : getChildren())
282- // {
283- // if (child instanceof StaticRelativeSceneNode staticRelativeSceneNode)
284- // {
285- // // TODO: Delete any old static relative children that aren't the correct name?
286- // if (child.getName().equals(graspStaticRelativeSceneNodeName))
287- // {
288- // graspStaticRelativeSceneNode = staticRelativeSceneNode;
289- // }
290- // }
291- // }
292- //
293- // if (graspStaticRelativeSceneNode == null)
294- // {
295- // graspStaticRelativeSceneNode = new StaticRelativeSceneNode(sceneGraph.getNextID().getAndIncrement(),
296- // graspStaticRelativeSceneNodeName,
297- // sceneGraph.getIDToNodeMap(),
298- // getID(),
299- // new RigidBodyTransform(),
300- // openingMechanism.getVisualModelPath(),
301- // openingMechanism.getVisualModelTransform(),
302- // // TODO: DOORNODES
303- // DOOR_YOLO_STATIC_MAXIMUM_DISTANCE_TO_LOCK_IN,
304- // getCRDTInfo());
305- // StaticRelativeSceneNode finalGraspStaticRelativeSceneNode = graspStaticRelativeSceneNode;
306- // sceneGraph.modifyTree(modificationQueue -> modificationQueue.accept(new SceneGraphNodeAddition(finalGraspStaticRelativeSceneNode, this)));
307- // }
308- // }
309271 public void setDoorFramePoseLock (boolean lockPose )
310272 {
311273 lockDoorFramePose = lockPose ;
@@ -367,6 +329,7 @@ public DoorSide getDoorSideRelativeTo(Point3D position)
367329 {
368330 // TODO: DOORNODES
369331
332+
370333 return null ;
371334 }
372335
0 commit comments