fix(experement): harden scene sync, cap grasp yaw and startup sequencing

This commit is contained in:
Даниил Грабарь
2026-11-08 17:45:10 +10:00
parent ec977c10ba
commit 7aa62f789c
@@ -333,6 +333,15 @@ class ReferenceOperations:
self.bridge.assert_synchronized(*self.bridge.expected_sets()) self.bridge.assert_synchronized(*self.bridge.expected_sets())
except Exception as error: except Exception as error:
raise OperationError(f'planning scene is not synchronized: {error}') from error raise OperationError(f'planning scene is not synchronized: {error}') from error
# The relay to /planning_scene is asynchronous for the MoveItPy
# monitor. Give it a short, bounded window before planning.
if self.node is None:
return
import time
end = time.monotonic() + 0.5
while time.monotonic() < end:
rclpy.spin_once(self.node, timeout_sec=0.05)
def _expect_latest(self, timeout: float = 2.0) -> dict[str, Any]: def _expect_latest(self, timeout: float = 2.0) -> dict[str, Any]:
import time import time