2.7 KiB
A7 机械臂直连 CAN SDK
通过 Linux SocketCAN 直接访问 A7 机械臂电机的 Python SDK。收集自已使用的 a7-left-can-control 项目,包含本地协议实现、读写封装、反馈保护、假 CAN 和手册协议编码器。
这是本地维护的直连 CAN 实现,不是厂家 LBot 1.0.5 TCP 在线控制器动态库。此仓库交付 SDK;上层 ServoPy/Pinocchio/Ruckig 轨迹规划和杯子抓取流程不属于 SDK 依赖。
安装
Linux、系统 Python 3.12 + venv,真机传输需要 SocketCAN 和 iproute2。SDK 运行时仅使用 Python 标准库,不依赖 ROS、python-can 或 C++ 编译。
bash scripts/setup.sh
bash scripts/check.sh
check 只使用内存假 CAN、报文编码和只读入口的计划模式,不连接真机。
示例
# 内存假电机
.venv/bin/python examples/fake_can.py
# 只显示读取计划,不连接 CAN
.venv/bin/python examples/read_angles.py
# 明确只读现场查询:核对 UID 后读取七轴位置
.venv/bin/python examples/read_angles.py --config config/left.json --samples 10 --execute
# 完整只读参数诊断;此命令会立即打开 CAN 并发送查询
.venv/bin/a7-can-inspect --config config/left.json --output out
config/left.json 是原设备的配置快照:ID61–67、host253、1 Mbps、前五轴 P80、后两轴 PA43。UID、方向、限位与 verified 字段仅适用于原设备与原现场,不代表新设备已完成校验。需由现场预先接线并配置 can0,SDK 不会自行配置 CAN 接口。
组成
| 模块 | 用途 |
|---|---|
| protocol.py | 已使用的 29 位扩展 CAN 协议、参数及反馈解码 |
| client.py | MotorBus:身份、读取、受限写入、使能与停止确认 |
| transport.py | SocketCAN、独占锁、classic/FD 与帧类型检查 |
| configuration.py | 七轴映射与配置校验 |
| runtime.py / startup.py | 上层轨迹适配、显式启动状态机 |
| manual_protocol.py / manual_client.py | P80/P50、PA43 手册标准帧编码与受限客户端 |
| fake.py / trace.py | 内存假电机与执行日志 |
接口和控制边界见 SDK 接口,两套协议的区别与现场结果见 协议说明。
MotorBus 默认 allow_control=False;导入 SDK 不打开设备。实际位置写入仍要求显式开启控制并通过原身份、模式、反馈、限位等检查。模式5位置控制是现有使用路径;未核验的力矩/阻抗接口拒绝执行。停止/关闭的行为应按具体接口理解,不能套用 TCP 控制器“退出保持使能”的策略。
打包只调整 inspect_bus 的配置和输出路径参数,核心协议、控制参数与保护逻辑保持原样。验证范围见 交付验证。