orisys/ros_contorl
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

首轮顺时针进孔改回 10°/s，空回固定做 4 轮。

Browse Source 
首轮咬合的顺时针进孔又走了接口上限，螺纹还没咬住就转完了。这一段改回读
extreme_speed_deg_s（现场 10°/s）。首轮逆时针出孔，以及空回每一轮的正反转，
仍走 0.90 rad/s 上限。

空回原先只做一轮。首轮咬合结束后，张开、微抬、逆时针、按本轮实测上抬降回、
合爪、顺时针这一整段固定重复 UNWIND_ROUNDS=4。抬和降留在轮内，下降量用这一轮
记住的上抬，不用上一轮的数。日志打空回第 i/4 轮；某一轮没走完就停，后面不再做。

10:40 合爪命令已经发到话题，节点被 Serial.flush/tcdrain 堵住 120s 才执行，
流水线 8s 时手指还停在 pos=400，第 2–4 轮没开始。发送改成等发送缓冲排空，
0.25s 排不空就失败返回，不再调用 tcdrain。同一次开合状态没跟上再发一次。

Co-authored-by: Cursor <cursoragent@cursor.com>
This commit is contained in:
arm_dev
2026-10-20 11:40:57 +08:00
parent 04137fb6e5
commit 561d7da21f
9 changed files with 278 additions and 81 deletions
Download Patch File Download Diff File Expand all files Collapse all files
docs/HANDBOOK.md
+1 -1
View File
@@ -93,7 +93,7 @@ ROS 相对 XY，`keep_z`。硬件在 MoveL 期间不灌关节指令。D435 这
`tool10120938` 的 TCP 长度（0.226587 m，2026-10-16 下午 RDK 重读）加上 `final_gap_mm` 之上，不按旧 tool1 的 0.223 m。
贴面之后就停在这个法兰高度，不抬回 `hole_hover_z_m`。没有接触传感器。
`stage2.hole_entry_mm`（现为 1）> 0 时，插孔目标改成规尖在工件上表面以下这么深（孔口凹槽），再转 A7；为 0 时仍停在 `final_gap_mm`。进孔超过 8 mm（板厚 12 mm）直接拒绝。2026-10-19 12:20 写成 4 mm 时，臂在面下 1.6 mm 被挡住。
然后只转左臂 A7（厂家 `SendJointPosition` 的第 7 轴，模式 `NRT_JOINT_POSITION`）：先逆时针转到软件限位内侧 `extreme_margin_deg`，再顺时针转到另一侧。顺时针到位记为「首轮咬合结束」。接着 `run_gripper.sh --arm <臂号> --cli pos` 加上 `unwind_open_permille`（现为 400，不全开），再用一条厂家 `MoveL` 只抬 TCP 的 Z `unwind_lift_mm`（现为 3，即 0.3 cm；XY 和姿态不动，不拆成关节小跳）。这条和随后的下降都带 `zoneRadius=ZFine`、`targetTolerLevel=1`：厂家默认 `Z50` 和等级 3 会在还差约 0.5 mm 时就报到位，下降和记住的上抬对不上，合爪就不会发。A7 再逆时针回到限位。然后下降刚才实测的那一段（不另写一个下降量），`--cli close`。合爪目标是位置 0；固件在位置先到时写 grip=1（到位），力先到才写 grip=2（夹住）。手指已经在合拢端就继续，还停在张开位则不转。再顺时针转到限位。这四段 A7 都请求接口上限 0.90 rad/s；两端速度为 0 的样条峰速约是平均的 1.5 倍，所以整段按平均约 34 °/s 排程，避免时间到了还差几十度。`extreme_speed_deg_s` 只留给规装配预绕。前六轴不动。顺时针是进孔，逆时针是出孔。夹爪或这一段 Z 对不上，就停在当前关节。
然后只转左臂 A7（厂家 `SendJointPosition` 的第 7 轴，模式 `NRT_JOINT_POSITION`）：先逆时针转到软件限位内侧 `extreme_margin_deg`（接口最快），再顺时针转到另一侧，这一段用 `extreme_speed_deg_s`（现为 10 °/s）。顺时针到位记为「首轮咬合结束」。接着下面这一整段固定重复 4 轮（常量 `UNWIND_ROUNDS`，不进 `site.yaml`）：`run_gripper.sh --arm <臂号> --cli pos` 加上 `unwind_open_permille`（现为 400，不全开），再用一条厂家 `MoveL` 只抬 TCP 的 Z `unwind_lift_mm`（现为 3，即 0.3 cm；XY 和姿态不动，不拆成关节小跳）。这条和随后的下降都带 `zoneRadius=ZFine`、`targetTolerLevel=1`：厂家默认 `Z50` 和等级 3 会在还差约 0.5 mm 时就报到位，下降和记住的上抬对不上，合爪就不会发。A7 再逆时针回到限位。然后下降刚才这一轮实测的那一段（不另写一个下降量，也不用上一轮的数），`--cli close`。合爪目标是位置 0；固件在位置先到时写 grip=1（到位），力先到才写 grip=2（夹住）。手指已经在合拢端就继续，还停在张开位则不转。再顺时针转到限位。日志打 `空回第i/4轮 开始` 和 `完成`，带本轮上抬、下降的毫米数。某一轮没走完就停在当前关节，后面的轮次不再做。首轮逆时针出孔，以及空回每一轮的逆时针、顺时针，请求接口上限 0.90 rad/s；两端速度为 0 的样条峰速约是平均的 1.5 倍，所以这几段按平均约 34 °/s 排程，避免时间到了还差几十度。首轮顺时针进孔不在这几段里，速度是上面的 10 °/s。前六轴不动。顺时针是进孔，逆时针是出孔。夹爪或这一段 Z 对不上，就停在当前关节。
只测 D435 这一段位移时加 `--d435-only`：不交 D405、不进二阶段，并且要求先停 `run_real.sh`。
```bash