加入Z轴运行控制,加快五轴运行速度

This commit is contained in:
2026-10-10 17:16:19 +08:00
parent cf86bd0702
commit 51accb9196
8 changed files with 58 additions and 49 deletions
+9 -6
View File
@@ -539,13 +539,16 @@ def main() -> int:
if solve is not None:
targets, held = solve
checker.that(
"z" in held and "z" not in targets,
f"execute does not hold the press axis back: "
"z" in targets and not held,
f"execute does not command the press axis: "
f"{sorted(targets)} held={held}",
)
plan = plan_pose_move(window.poller.service, targets, hold=held)
plan = plan_pose_move(
window.poller.service, targets, hold=held, together=True
)
checker.that(
[step.role for step in plan.steps] == ["yaw", "pitch", "x", "y"],
[step.role for step in plan.steps]
== ["yaw", "pitch", "x", "y", "z"],
f"the move order is {[step.role for step in plan.steps]}",
)
checker.that(
@@ -581,11 +584,11 @@ def main() -> int:
+ " reached"
)
# Returning to the initial state, press axis first.
# All five axes back to zero together, including the press axis.
back = plan_return_to_initial(window.poller.service)
checker.that(
[step.role for step in back.steps]
== ["z", "pitch", "yaw", "x", "y"],
== ["yaw", "pitch", "x", "y", "z"],
f"the return order is {[step.role for step in back.steps]}",
)
result = window.mover.start(back)