fallensigh/craic
2
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
29 Commits 1 Branch 0 Tags
cf92d21946931e3ad5ab50da01ced5f31c86685d
Commit Graph

29 Commits

This Branch
This Branch
All Branches
Author SHA1 Message Date
FallenSigh
cf92d21946 feat(jxbeye)：当STA模式连接失败后，自动切换到AP模式 2026-06-19 01:08:56 +08:00
FallenSigh
181be30d93 chore(vision_grasp): 调整相机 Z 偏移参数 cam_tz 至 30mm 
Ultraworked with [Sisyphus](https://github.com/code-yeongyu/oh-my-openagent)

Co-authored-by: Sisyphus <clio-agent@sisyphuslabs.ai>
 2026-06-16 22:13:03 +08:00
FallenSigh
67cf20b1c4 feat(arm_control): 添加启动自动复位功能并修复 UDP 命令调用 
Ultraworked with [Sisyphus](https://github.com/code-yeongyu/oh-my-openagent)

Co-authored-by: Sisyphus <clio-agent@sisyphuslabs.ai>
 2026-06-16 22:12:55 +08:00
FallenSigh
85824e9a93 docs: 添加 CLAUDE.md 项目指南 
为 Claude Code 提供项目概览和常用命令指南
 2026-06-16 21:34:38 +08:00
FallenSigh
a832dfaeb1 feat: 添加方框检测与自动抓取节点 
功能：
- 基于 YOLO 实时检测方框
- 自动模式：启动后自动检测并抓取
- 手动模式：通过服务触发检测
- 检测成功后自动停止并发布抓取目标
- 3D 坐标估计（基于方框尺寸和相机 FOV）

节点：box_detection_grasp
- 话题：/vision_grasp/grasp_target (发布)
- 服务：/box_detection/start (启动检测)
- 服务：/box_detection/stop (停止检测)

配置：
- auto_grasp: 自动/手动模式切换
- box_size_m: 方框尺寸（用于深度估计）
- show_debug_window: 调试窗口

使用：
ros2 run udp_teleop box_detection_grasp \
    --ros-args --params-file config/box_detection_grasp.yaml \
    -p auto_grasp:=true

详细文档：docs/box_detection_grasp.md
 2026-06-16 21:28:09 +08:00
FallenSigh
aa1bc2bf75 fix(vision_grasp): 修正 tcp_to_base 旋转矩阵 Y 坐标符号 
问题：
- 相机坐标 (10, -5, 100) → 基坐标 (299.6, 10, 15)
- 期望：(299.6, -10, 15)
- Y 坐标符号相反

根因：
- 旋转矩阵第二行：TCP X → 基坐标 Y
- 应该是：TCP X → 基坐标 -Y

修复：
- 第二行从 [cos(phi), 0, sin(phi)]
- 改为 [-cos(phi), 0, -sin(phi)]

验证（phi=0）：
- TCP (10, -5, 100) + TCP位置(199.6, 0, 10)
- = 基坐标 (299.6, -10, 15) ✓
 2026-06-16 20:15:56 +08:00
FallenSigh
3f4dfe02a7 chore: 移除调试日志 
相机旋转问题已修复，移除临时 DEBUG 输出
 2026-06-16 20:12:42 +08:00
FallenSigh
197de7908a fix: 修正 UP/DOWN 与 J5 角度的对应关系 
问题：
- 之前错误地将 J5=81 (张开) 标记为 UP
- 实际上 J5=-100 (闭合) 才是 UP（夹爪朝上）

正确对应关系：
- UP: J5=-100 (闭合), z4=-100, 工作范围 z ∈ [-190, 110]mm
- DOWN: J5=81 (张开), z4=55, 工作范围 z ∈ [-345, -55]mm

修复内容：
- 重命名常量：Z4_OPEN/Z4_CLOSED → Z4_UP/Z4_DOWN
- 更新 resolve_z4_from_j5(): J5 < 0 → UP
- 更新 vision_grasp 相机旋转逻辑：J5 < 0 → 正向
- 更新文档说明

现在 UP/DOWN 语义正确且一致！
 2026-06-16 20:01:24 +08:00
FallenSigh
aa7cd87151 fix: 修复类型错误并添加 up/down 显式控制 
问题 1：发布状态失败 - 类型错误
- 修复：在发布 TCP 位姿时显式转换为 float
- 修复：在 GetPose 响应中显式转换类型

问题 2：缺少显式 z4 控制
- 添加 up/down 参数到 MovePose 服务
- up: 强制使用 z4=-100（夹爪朝上）
- down: 强制使用 z4=55（夹爪朝下）
- 默认：根据目标 z 坐标自动选择

控制逻辑：
- z4 选择优先级：up/down > 自动选择
- up/down 与 grip/release 完全独立
- up/down 控制夹爪高度（z4）
- grip/release 控制夹爪开合（J6）

与 udp_control.py 行为完全一致！
 2026-06-16 19:44:12 +08:00
FallenSigh
33f1a31c59 feat(arm_control): 实现动态 z4 自动适配机制 
问题根源：
- udp_control.py 使用动态 z4（根据目标 z 自动选择）
- arm_control.py 使用固定 z4=80
- 导致相同目标位姿在两个工具中行为不一致

解决方案：
- 添加 resolve_j5_from_z(): 根据目标 z 自动选择 J5
- 添加 resolve_z4_from_j5(): 根据 J5 确定 z4 值
- 更新正/逆运动学接受动态 z4 参数
- 自动适配规则：
  * z > -55mm: J5=-100, z4=-100 (闭合, 工作范围 [-190, 110])
  * z ≤ -55mm: J5=81, z4=55 (张开, 工作范围 [-345, -55])

现在 arm_control 与 udp_control.py 行为一致！
 2026-06-16 19:37:42 +08:00
FallenSigh
df436a9a31 fix(vision_grasp): 根据 J5 状态处理相机旋转 180° 
问题：
- 相机水平安装，但随 J5 状态旋转 180°
- J5 张开（UP）：相机正向，图像正常
- J5 闭合（DOWN）：相机旋转 180°，图像上下颠倒

解决方案：
- 从 GetPose 获取 J5 状态
- J5 > 0 (UP): (xc, yc, zc) = (x_img, -y_img, z)
- J5 < 0 (DOWN): (xc, yc, zc) = (-x_img, y_img, z)
- 自动处理相机旋转，无需手动调整

更新文档说明相机旋转机制
 2026-06-16 19:25:13 +08:00
FallenSigh
308f3938c3 chore: 更新 .gitignore 忽略运行时文件 
- 忽略状态缓存文件（udp_control_state.json）
- 忽略临时压缩包（dataset.zip, ros2.zip）
- 添加项目特定文件分类
 2026-06-16 19:09:00 +08:00
FallenSigh
0db694db85 feat(tools): 添加相机坐标变换工具和完善文档 
- 新增 camera_to_base.py: 相机坐标系到基坐标系的完整变换
  - 支持相机到 TCP 的变换（平移+旋转）
  - 支持 TCP 到基坐标系的变换
  - 水平安装相机的特化实现

- 更新 tools/README.md: 完整的工具使用指南
  - 所有工具的详细说明
  - 坐标系定义和图示
  - 完整工作流示例
  - 故障排查指南

- 删除 .udp_control_state.json: 不应提交到版本控制
  （运行时生成的状态缓存文件）

- 更新 udp_control.py: 代码优化和注释改进
 2026-06-16 19:08:33 +08:00
FallenSigh
d716ed5e67 docs: 重写机械臂运动学文档 
- 清晰的章节结构：几何参数、正运动学、逆运动学
- 完整的数学推导（带 LaTeX 公式）
- Python 代码实现示例
- 工作空间分析和奇异点说明
- 运动插值算法
- 实用示例和测试命令

替换了原有的混乱结构，现在更易理解和参考
 2026-06-16 19:05:09 +08:00
FallenSigh
f00537ebb9 docs: 整理和精简文档结构 
- 删除冗余文档（6个重复的说明文档）
- 更新 README.md：简洁清晰的项目总览
- 更新 ros2/README.md：完整的 ROS 2 使用指南
- 保留核心技术文档：docs/arm.md（运动学推导）

文档现在更加简洁，避免重复内容
 2026-06-16 19:01:42 +08:00
FallenSigh
83b32542ef feat: 添加机械臂 ROS 2 控制节点和视觉抓取系统 
- 创建 arm_control_msgs 包：定义机械臂控制的消息和服务接口
  - 消息：JointState, TCPPose
  - 服务：MoveJoints, MovePose, GetPose, SetGripper

- 实现 arm_control 节点：独立的机械臂控制 ROS 节点
  - 完整的逆运动学和正运动学
  - 关节空间和笛卡尔空间运动控制
  - UDP 通信与 ESP32
  - 状态发布（10Hz）

- 实现 vision_grasp 节点：自动化视觉抓取
  - 相机坐标系到基坐标系的完整变换
  - 自动抓取流程：释放→移动→抓取→回收
  - 自动释放流程：移动→释放→回收
  - 多线程执行器支持

- 添加完整文档
  - ARM_CONTROL_README.md: 机械臂控制节点使用指南
  - VISION_GRASP_README.md: 视觉抓取节点使用指南
  - QUICKSTART.md: 快速开始指南
  - 文档重命名：docs/craic.md → docs/arm.md
 2026-06-16 18:45:01 +08:00
FallenSigh
7144005be2 feat: 将机械臂坐标系改为 z 轴朝上 
主要修改:
- 坐标系统: z=0 为顶部改为底部，z 轴朝上
- 高度范围: d1 ∈ [-290, 0] mm (-290=底部, 0=顶部)
- Z4 偏移: 80.0 (原 -80.0), Z4_OPEN=55, Z4_CLOSED=-100
- 运动学: 更新 tcp_to_joint4_center 和 forward_kinematics 的 z 坐标变换
- 夹爪逻辑: 更新 resolve_gripper_from_z 的高度判断范围
- 插值优化: 先完成末端运动，再处理 grip/release
- 移除所有坐标转换中的负号，统一为正向 z 轴朝上系统
 2026-06-16 15:45:53 +08:00
FallenSigh
87c8b909e9 Add per-joint limits, joint-space interpolation, grip/release, --up/--down 
- Add per-joint angle limits (J2=-110..115, J3=-120..145, J4=-90..130)
  with CLI overrides and validation
- Replace Cartesian interpolation with joint-space interpolation in
  pose mode to guarantee intermediate steps stay within joint limits
- Add --up/--down mutually exclusive groups to both joints and pose
  modes; pose mode auto-detects from z when neither is specified
- Add --grip/--release for J6 control (GRIP/RELEASE_ANGLE placeholders)
- Update cached state to match latest run
 2026-06-15 22:18:02 +08:00
FallenSigh
9c4f48a225 Auto-select gripper state from z coordinate in pose mode 
- Add resolve_gripper_from_z(): z>=55 → down (open), z<55 → up (closed),
  overlap range prefers down
- Remove --up flag from pose subparser (fully auto-detected from --z)
- joints mode retains manual --up flag
- Update cached state to match latest run
 2026-06-15 21:51:10 +08:00
FallenSigh
7accfc617e Refactor arm UDP controller with user-space height coordinates and gripper toggle 
- Switch height to user coordinates (0=top, 290=bottom mm), invert sign
  internally for UDP protocol
- Replace raw --j5 arg with --up flag (gripper up/down toggle)
- Add default geometry constants (L1, L2, X4, Z4) and gripper
  open/closed angles
- Update --show-fk and pose mode to derive Z4 from gripper state
- Add mm unit annotations to all CLI help text and output
- Update cached joint state to match new coordinate convention
- Add camera_capture.py: single-shot JPEG grabber from ESP32 MJPEG stream
- Fix missing newline at EOF in craic.md
 2026-06-15 21:33:47 +08:00
FallenSigh
f343a01372 Add arm UDP controller with IK and interpolation 2026-06-12 19:01:48 +08:00
FallenSigh
bdec5d4827 docs: add CRAIC competition info to README 2026-05-27 02:31:01 +08:00
FallenSigh
6469e77633 docs: add ros2 workspace README with multi-method installation 2026-05-27 02:29:06 +08:00
FallenSigh
9532264534 docs: add tools README 2026-05-27 02:20:09 +08:00
FallenSigh
7f4189bb7a docs: add project README 2026-05-27 02:18:53 +08:00
FallenSigh
6f6577d983 chore: add ros2 udp_teleop package and tools 2026-05-27 02:17:35 +08:00
FallenSigh
13fdba5fff chore: add root .gitignore 2026-05-27 02:16:54 +08:00
FallenSigh
ec41ed8a48 WIP: snapshot before repo migration 2026-05-27 02:15:09 +08:00
FallenSigh
aa7ed7cf51 feat: ESP32-S3 双核并行摄像头系统 (AsyncUDP + ESP-NOW) 
- 主程序: src/main.cpp - AP模式摄像头推流 + AsyncUDP中断通讯
- 通信模块: UDPPeer类 (UDP + ESP-NOW双通道, Flash配置持久化)
- 参考实现: ESPNOW通讯 / bkespnow版本 / 普通连接版本
- clangd配置: --target=arm-none-eabi + __XTENSA__宏 + 工具链sys-include
- 硬件: ESP32-S3-WROOM-1-N16R8 + OV2640, 16MB Flash, Octal PSRAM
 2026-05-14 16:39:01 +08:00