1
设计目标与约束
1.1 功能目标
机械臂需要完成的清洁任务:
├─ 内壁刷洗(主要任务,曲面接触)
├─ 座圈擦拭(次要任务,平面接触)
├─ 外壁擦拭(辅助任务)
├─ 消毒液喷洒(工具切换)
└─ 冲水按钮按压(精准定位)
1.2 关键设计约束
约束类型 | 约束条件 | 设计影响 |
|---|---|---|
工作半径 | 500–700mm | 覆盖内壁全部区域 |
末端负载 | ≥ 2kg | 满足清洁工具重量(含刷头+电机) |
重复定位精度 | ±1–2mm | 满足座圈擦拭精度要求 |
生活空间高度 | 0–800mm | 机械臂工作空间覆盖此范围 |
底盘尺寸 | ≤ 600mm宽 | 臂基座安装面有限 |
防护等级 | IP65以上 | 防水防清洁液腐蚀 |
算法能力 | 有限(核心约束) | 必须简化控制复杂度 |
1.3 来自清洁的特殊约束
清洁对机械臂的独特要求:
─────────────────────────────────────────────────────
要求1:末端需要沿内壁曲面运动
→ 需要柔顺跟随能力
→ 如果纯位置控制:需要精确的曲面轨迹规划(算法难)
→ 解决方案:被动柔顺机构(机械做,算法不管)
要求2:末端需要保持恒定接触力
→ 如果纯位置控制:需要实时力控反馈(算法难)
→ 解决方案:弹簧预压机构(机械保证,算法只管方向)
要求3:末端需要能伸入内壁底部(最低点以下)
→ 几何可达性要求(空间约束)
→ 解决方案:合理的连杆长度设计
要求4:清洁过程中可能碰到障碍物(座圈边缘、门框)
→ 安全碰撞处理
→ 解决方案:限力关节 + 被动退让机构
2
自由度配置方案对比
这是第一个核心设计决策 ,自由度数量直接决定控制复杂度和机械复杂度。
自由度配置:肩部俯仰×1 + 肘部俯仰×1 + 腕部俯仰×1 + 腕部旋转×1
工作空间覆盖分析:
├─ 能覆盖内壁主体区域(约80%)
├─ 座圈擦拭:可达,但姿态受限
└─ 底部清洁:有限(取决于连杆参数)
控制复杂度:极低(可实现纯位置控制)
机械复杂度:极低(结构最简单)
清洁覆盖率:70–80%
结论:不推荐,自由度不足导致清洁覆盖率低
自由度配置:肩部水平旋转×1 + 肩部俯仰×1 + 肘部俯仰×1 + 腕部俯仰×1 + 腕部旋转×1
工作空间覆盖分析:
├─ 能覆盖内壁主体区域(约90%)
├─ 座圈擦拭:可达,姿态较好
├─ 底部清洁:可达
└─ 多角度避障:有限
控制复杂度:低(接近4DOF,易实现)
机械复杂度:低(增加1个关节)
清洁覆盖率:85–90%
结论:备选方案,适合预算有限团队
自由度配置:
├─ 关节1:底座旋转(水平面,±180°)
├─ 关节2:肩部俯仰(垂直面,-90°~+90°)
├─ 关节3:肩部偏移(水平内收外展,±30°)
├─ 关节4:肘部俯仰(垂直面,-135°~+135°)
├─ 关节5:腕部俯仰(垂直面,-90°~+90°)
└─ 关节6:腕部旋转(末端工具旋转,±360°)
工作空间覆盖分析:
├─ 内壁主体区域:完全覆盖
├─ 座圈上下表面:灵活可达
├─ 底部(内壁最深处):可达
├─ 外壁多角度擦拭:全方位
└─ 避障灵活性:冗余自由度,支持奇异位形规避
控制复杂度:中(需逆运动学求解)
机械复杂度:中(标准6DOF结构)
清洁覆盖率:95–100%
结论:✅ 推荐,这是清洁任务的最佳性价比配置
自由度配置:6DOF + 1个冗余关节(通常在肩部或肘部)
优势:避障能力强,姿态灵活
劣势:
├─ 控制复杂度大幅增加(逆运动学多解)
├─ 机械成本增加15–20%
└─ 冗余自由度在清洁场景利用不充分
结论:❌ 不推荐,算法能力有限时,冗余自由度是负担而非优势
自由度方案对比汇总
维度 | 4DOF | 5DOF | 6DOF | 7DOF |
|---|---|---|---|---|
控制复杂度 | 1 | 2 | 3 | 4 |
机械复杂度 | 1 | 2 | 3 | 4 |
清洁覆盖率 | 70–80% | 85–90% | 95–100% | 98–100% |
逆运动学难度 | 简单 | 中等 | 中等(标准解法) | 困难(多解) |
推荐度 | ❌ | 🟡 | ✅ 推荐 | ❌ |
推荐:6DOF标准构型 6DOF是完成3D空间完全定位的最小自由度数,有成熟的标准逆运动学算法(如解析解或数值解),既满足清洁覆盖率,又不引入过多控制复杂度。
3
运动学设计与连杆参数
3.1 坐标系的建立
采用标准DH参数法建立机械臂运动学模型:
坐标系设置(从基座到末端):
─────────────────────────────────────────────────────
Z0:基座旋转轴(垂直,↑朝上)
Z1:肩部俯仰轴(垂直,⊥于Z0)
Z2:肩部偏移轴(水平)
Z3:肘部俯仰轴(垂直)
Z4:腕部俯仰轴(垂直)
Z5:腕部旋转轴(垂直)
末端执行器坐标系(Z6):
├─ Z轴:指向清洁工具
├─ X轴:工具的"前进"方向
└─ 原点:清洁工具的工作点
3.2 连杆长度设计(核心参数)
连杆长度决定了工作空间的大小和形状,必须精确计算。
清洁任务对工作空间的要求:
─────────────────────────────────────────────────────
内壁关键区域(需完全覆盖):
├─ A区(后壁):距离基座最远点,约 550mm
├─ B区(底部最低点):约 200mm(高度)
├─ C区(边缘):约 350–400mm(径向)
└─ D区(座圈上方):约 450–550mm(高度)
工作空间需求:
├─ 径向范围:200–650mm(从基座中心计算)
├─ 高度范围:0–600mm
└─ 角度范围:基座±180°旋转
连杆长度确定过程:
假设基座高度(安装面到肩部):h_base = 400mm(底盘高度+肩部高度)
几何推导:
├─ L1(肩部到肘部):决定最大垂直覆盖
│ → L1 ≥ 300mm,覆盖高度 0–600mm
│
├─ L2(肘部到腕部):决定最大水平伸展
│ → L2 ≥ 250mm,配合L1达到径向 550mm
│
└─ L3(腕部到末端):决定末端指向灵活性
→ L3 = 100–150mm(不宜过长,降低末端刚性)
验证(最大伸展状态):
├─ 最大水平伸出 = L1 + L2 + L3·cos(θ) ≈ 300 + 250 + 125 = 675mm
├─ 最小垂直位置 = h_base - L1·sin(θ) ≈ 400 - 300 = 100mm
└─ 最大垂直位置 = h_base + L1 + L2·sin(θ) ≈ 400 + 300 + 250 = 950mm
留有余量:
├─ 最远点约 550mm → 臂可达到 675mm → 有 125mm余量
├─ 考虑底盘定位误差 ±10mm → 仍有 115mm安全余量
└─ 结论:L1=300mm,L2=250mm,L3=130mm 是合理的设计参数
3.3 DH参数表
i | θ_i(变量) | d_i(偏距) | a_i(连杆长度) | α_i(扭转角) |
|---|---|---|---|---|
1 | θ₁(基座旋转) | 0 | 0 | 0° |
2 | θ₂(肩俯仰) | 0 | L1=300mm | 0° |
3 | θ₃(肩偏移) | 0 | L2=250mm | +90° |
4 | θ₄(肘俯仰) | 0 | L3=130mm | 0° |
5 | θ₅(腕俯仰) | 0 | 0 | 0° |
6 | θ₆(腕旋转) | 0 | 0 | 0° |
注意: DH参数中的θ₂和θ₃设置为变量,而非固定偏移,这样可以在不改变连杆长度的情况下,通过关节角度调整来适应不同的位姿,减少对底盘校准精度的要求。
3.4 工作空间验证 图示说明: ├─ 外虚线:臂最大伸展边界(675mm径向) ├─ 内实线:有效清洁区域(200–550mm径向) └─ 绿色区域:工作空间与清洁区域的重叠 → 几乎完全覆盖,仅最深底部有少量盲区(可接受)
4
关节驱动方案选型
4.1 关节电机选型对比
电机类型 | 效率 | 力矩密度 | 控制复杂度 | 成本 | 推荐度 |
|---|---|---|---|---|---|
无刷直流电机(BLDC) | 高(85–90%) | 高 | 中(需FOC) | 中 | 推荐 |
步进电机(开环) | 低(40–60%) | 中 | 极低(脉冲控制) | 低 | 精度不足 |
步进电机(闭环) | 中(60–70%) | 中 | 低(脉冲+编码器) | 中低 | 备选 |
有刷直流电机 | 低(60–70%) | 低 | 低 | 低 | 力矩不足 |
伺服电机(带驱动) | 高 | 高 | 中(位置/速度环) | 高 | 高成本 |
推荐:无刷直流电机(BLDC)+ FOC矢量控制
4.2 减速器选型对比(核心部件)
减速器是机械臂中最关键的传动部件,直接决定精度、刚度和成本。
减速器类型 | 传动精度 | 刚度 | 效率 | 寿命 | 成本 | 推荐度 |
|---|---|---|---|---|---|---|
谐波减速器 | 5(极高) | 4 | 85–90% | 长 | 高(2000–5000元/个) | 大关节推荐 |
RV减速器 | 4(高) | 5 | 80–85% | 很长 | 中高(1500–4000元/个) | 负载关节 |
行星减速器 | 3(中) | 3 | 90–95% | 中 | 低(200–800元/个) | 小关节 |
同步带传动 | 2(中低) | 2 | 90–95% | 中 | 极低(50–200元/个) | 精度差 |
滚珠丝杠 | 4(高) | 5 | 85–90% | 长 | 中(500–1500元/个) | 直线关节 |
推荐配置:谐波(关节1–4)+ 行星(关节5–6)
减速器配置方案(6个关节):
─────────────────────────────────────────────────────
关节1(底座旋转):谐波减速器 1:50
├─ 负载:最大,需承受整臂重量
├─ 精度要求:高(直接影响末端位置
└─ 推荐:CSF-17-50(额定转矩10N·m)
关节2(肩俯仰):谐波减速器 1:50
├─ 负载:高(力臂最长)
├─ 精度要求:高
└─ 推荐:CSF-14-50
关节3(肩偏移):谐波减速器 1:50
├─ 负载:中高
├─ 精度要求:中
└─ 推荐:CSF-11-50
关节4(肘俯仰):谐波减速器 1:50
├─ 负载:中
├─ 精度要求:中
└─ 推荐:CSF-11-50
关节5–6(腕部):行星减速器 1:10–1:15
├─ 负载:低(末端负载为主)
├─ 精度要求:中高
├─ 成本:低
└─ 推荐:内转子行星减速器,直径≤40mm
成本估算:
├─ 4个谐波减速器:约 8000–20000元
├─ 2个行星减速器:约 400–1200元
└─ 减速器总计:约 8500–21200元
为什么谐波减速器适合自研?
5
被动柔顺机构设计(核心创新)
这是本方案最重要的设计创新,直接解决算法能力不足的核心矛盾。
5.1 核心思想
传统方案(算法承担复杂度):
末端接触力控制 → 需要实时力传感器 + 阻抗控制算法 + 参数整定
→ 算法能力有限时难以实现
本方案(机械承担复杂度):
末端接触力控制 → 通过弹簧预压 + 机械限位 + 被动变形实现
→ 算法只需发出位置指令,机械自动处理接触力
本质:把"力控制"问题转化为"位置控制"问题,
而位置控制是算法工程师最熟悉、最容易实现的任务。
5.2 方案一:弹簧预压式被动柔顺(核心推荐)
机构原理:
─────────────────────────────────────────────────────
结构组成:
├─ 弹簧(压缩型):安装于关节输出端
│ └─ 预压量:可调(通过调节螺母设置)
│ └─ 弹簧刚度:k = 5–20 N/mm(根据清洁力需求选择)
│
├─ 限位机构:
│ └─ 机械限位块:防止过压损坏
│ └─ 限位开关:触发信号通知控制器
│
└─ 力矩传感器(可选,用于安全检测):
└─ 监测弹簧压缩量超限(间接测力)
工作原理:
├─ 正常清洁接触力(5–10N):
│ 弹簧被压缩 1–2mm → 末端自动退让,保持恒定力
│ 算法发出位置指令,机械自动维持接触力
│
├─ 遇到凸起(突然增力):
│ 弹簧快速压缩 → 末端退让 → 接触力不超过安全值
│
└─ 算法看到的:只是一个"更远"的目标位置
机械自动处理接触力变化,算法无需感知
控制算法的简化:
原来:实时力反馈 → PID力控 → 调整关节位置
现在:设定目标轨迹 → 关节位置闭环 → 机械保证接触力
弹簧参数设计计算
设计目标:末端接触力 5–10N(清洁标准)
已知条件:
├─ 清洁工具安装于关节6末端
├─ 力臂长度(关节6到刷头接触面):L_tool = 100mm
├─ 需要的末端接触力:F_contact = 5–10N
└─ 需要的接触力矩:τ = F × L = 5–10N × 0.1m = 0.5–1.0 N·m
关节力矩到末端力的传动:
├─ 谐波减速比 i = 50
├─ 关节输出力矩:τ_joint = τ / i = 0.5–1.0 / 50 = 0.01–0.02 N·m
└─ 弹簧压缩力 = τ_joint / 力臂 = 0.01–0.02 / 0.02m = 0.5–1.0 N
弹簧选型:
├─ 弹簧刚度 k = 10 N/mm(适中)
├─ 预压量 = 0.5mm(初始接触力 5N)
├─ 工作压缩量 = 0–1mm(对应接触力 5–15N)
└─ 最大压缩量 = 3mm(限位,安全)
弹簧规格(示例):
├─ 材料:不锈钢(防腐蚀)
├─ 线径:1.5mm
├─ 中径:15mm
├─ 圈数:10圈
└─ 自由长度:40mm
5.3 方案二:弹性联轴器式被动柔顺
机构原理:
├─ 关节电机与减速器之间使用弹性联轴器连接
├─ 联轴器材料:聚氨酯弹性体(硬度60A)
├─ 当末端遇到阻力时,联轴器产生弹性扭转变形
└─ 变形量与接触力成正比,自动退让
优点:
├─ 结构最简单,无需额外零件
├─ 同时吸收角度误差和力矩误差
└─ 适合中等柔顺需求
缺点:
├─ 力矩-变形关系非线性(弹性体特性)
├─ 刚度不可调(选择材料后固定)
└─ 不适合精确力控
适用场景:关节5–6(腕部),末端工具较轻时
5.4 方案三:气弹簧式被动柔顺
机构原理:
├─ 在关节6末端集成微型气弹簧
├─ 气弹簧内部充入低压氮气
├─ 压缩行程提供恒定支撑力(接近理想恒力弹簧)
└─ 末端执行器通过气弹簧与臂末端连接
优点:
├─ 力-位移特性线性(理想气体弹簧特性)
├─ 刚度可调(通过充气压力调节)
├─ 无机械摩擦,可靠性高
└─ 清洁力恒定,不随压缩量变化
缺点:
├─ 需要气源(氮气瓶或微型压缩机)
├─ 体积较大(相比弹簧)
└─ 密封要求高(防清洁液渗入)
适用场景:末端清洁力要求严格恒定的场合
5.5 三种被动柔顺方案对比
维度 | 弹簧预压式 | 弹性联轴器式 | 气弹簧式 |
|---|---|---|---|
力控精度 | ±2N(可调) | ±5N(固定) | ±1N(最佳) |
结构复杂度 | 中 | 低 | 高 |
体积重量 | 小 | 极小 | 中 |
可调性 | 好(预压量可调) | 差(选材固定) | 好(压力可调) |
可靠性 | 高 | 最高 | 中(密封挑战) |
维护性 | 好(弹簧易换) | 极好 | 差(需专业维护) |
成本 | 低(50–200元) | 极低(20–100元) | 高(500–2000元) |
推荐场景 | 大范围推荐 | 腕部小负载 | 高精度需求 |
推荐度 | 首选 | 辅助/备选 | 特定场景 |
推荐:弹簧预压式为主 + 弹性联轴器式为辅
这种组合用 最低的成本 实现了 足够的柔顺性 ,同时 对算法零要求
5.6 被动柔顺的局限性及应对
被动柔顺的固有限制:
─────────────────────────────────────────────────────
限制1:力控精度有限(±2–5N)vs 主动力控(±0.5N)
→ 应对:清洁需求为5–10N,±2N精度完全可接受
限制2:弹簧刚度固定,无法实时调整
→ 应对:不同清洁任务使用不同弹簧(软/中/硬三档)
限制3:无法感知清洁效果(不知道哪里没擦干净)
→ 应对:配合视觉验证(RGB-D相机拍照对比)
限制4:无法自适应不同的曲面曲率
→ 应对:
├─ 底盘校准保证基础位置精度(±10mm)
├─ 刷头设计为可变形材质(硅胶刷毛)
└─ 弹簧柔顺吸收残余误差
结论:被动柔顺 + 底盘校准 + 可变形刷头 = 在有限算法能力下
实现接近主动力控的清洁效果
6
机械结构与材料
6.1 整体结构布局
机械臂整体结构(从基座到末端):
─────────────────────────────────────────────────────
[腕旋转关节 J6] ← 末端工具快换接口
↑
[腕俯仰关节 J5]
↑
[肘俯仰关节 J4]
↑
[肩偏移关节 J3]
↑
[肩俯仰关节 J2] ← 前后摆动
↑
[底座旋转关节 J1] ← 水平旋转,固定于底盘
↑
[底座平台] ← 安装于麦克纳姆轮底盘
侧视图(关节标注):
─────────────────────────────────────────────────────
Z5 ← J6(腕旋转)
↑
Z4 ← J5(腕俯仰)
↑
Z3 ← J4(肘俯仰)─── L3(130mm)
↑
Z2 ← J3(肩偏移)─── L2(250mm)
↑
Z1 ← J2(肩俯仰)─── L1(300mm)
↑
Z0 ← J1(底座旋转)
↑
[底座平台]
6.2 材料选型
部位 | 推荐材料 | 理由 |
|---|---|---|
连杆(臂体) | 航空铝合金 6061-T6 | 重量轻(2.7g/cm³),强度高,阳极氧化后耐腐蚀,加工性好 |
关节外壳 | 铝合金 7075-T6 | 更高强度,适合高受力关节外壳 |
连接件/轴承座 | 铝合金 6061-T6 | 通用结构材料 |
轴承 | 不锈钢轴承(440C) | 防锈,适合潮湿环境 |
紧固件 | 不锈钢316 | 最佳耐腐蚀性(海洋级) |
表面处理 | 硬质阳极氧化 + 封闭处理 | IP防护 + 耐腐蚀 + 外观 |
密封件 | 食品级硅胶O型圈 | 耐清洁液,符合卫生要求 |
为什么不选钢或钛合金?
- 钢:重量大(7.8g/cm³),是铝的3倍 → 增加底盘负担
- 钛合金:重量适中(4.5g/cm³),但成本极高(铝的10倍)→ 不经济
- 铝:6061-T6经热处理后强度可达240MPa,完全满足关节强度需求
6.3 关节结构设计(标准化模块)
推荐:标准化关节模块设计 6个关节采用相同结构(不同减速器规格),降低加工难度,便于维护。
标准关节模块结构(每个关节相同):
─────────────────────────────────────────────────────
外观:圆柱形,直径根据关节编号递减
├─ J1:直径 140mm(底座旋转,负载最大)
├─ J2:直径 120mm(肩俯仰,高负载)
├─ J3:直径 100mm(肩偏移,中等负载)
├─ J4:直径 85mm(肘俯仰,中等负载)
├─ J5:直径 65mm(腕俯仰,低负载)
└─ J6:直径 50mm(腕旋转,低负载)
每个关节内部(相同结构):
├─ 步进电机/BLDC电机(带编码器)
├─ 减速器(谐波或行星)
├─ 双轴承支撑(深沟球+角接触)
├─ 谐波减速器外壳(铝)
├─ 输出法兰(铝)
├─ 关节角度传感器(磁编码器)
└─ O型圈密封(IP65保证)
关节接口(标准化):
├─ 电气接口:防水航空插头(同一型号)
├─ 线缆走线:内部穿线,无外部线缆
└─ 安装接口:相同规格螺钉孔位(同一型号)
6.4 末端工具快换接口
末端快换接口设计(核心结构):
─────────────────────────────────────────────────────
结构:卡扣式自动锁紧机构
接口规格:
├─ 连接方式:中心定位销 + 环形磁吸 + 弹簧锁紧
├─ 重复定位精度:±0.1mm
├─ 锁紧力:≥ 50kg(安全可靠)
├─ 工具识别:磁编码(不同工具对应不同编码)
└─ 电气接口:2个引脚(供电)+ 2个引脚(信号)
工具切换流程(自动):
1. 控制器发出切换指令
2. 机械臂将当前工具对准回收位
3. 解锁机构释放(电磁铁断电,弹簧解锁)
4. 机械臂移向下一工具位
5. 新工具对准接口,插入
6. 磁吸自动对位
7. 锁紧机构锁死
8. 电气连接建立
切换时间:≤ 3秒(自动)📌 核心原则:够用即可,不过度配置 算法能力有限,传感器数据必须易于理解和处理。
传感器 | 数量 | 类型 | 用途 | 数据处理难度 |
|---|---|---|---|---|
关节角度传感器 | 6个 | 磁编码器(17-bit) | 各关节角度反馈 | 极简单 |
关节力矩传感器 | 6个 | 电流估算(BLDC自带) | 过载保护 | 简单 |
末端力限位开关 | 3个 | 微动开关 | 被动柔顺极限检测 | 简单 |
末端RGB-D相机 | 1个 | Intel RealSense系列 | 视觉定位/污渍识别 | 中等 |
工具识别传感器 | 6个 | 磁编码(快换接口用) | 当前工具类型识别 | 极简单 |
为什么不加更多传感器?
磁编码器选型(每个关节1个):
├─ 类型:AMS AS5047P / AS5600(磁编码器)
├─ 分辨率:17-bit(±0.003°分辨率)
├─ 接口:ABI / SPI
├─ 特点:无接触,寿命长,不怕振动
└─ 成本:约 50–200元/个
数据用途:
├─ 正运动学计算(实时末端位置)
├─ 逆运动学求解(轨迹规划)
├─ 安全限位(关节角度超限报警)
└─ 速度/加速度计算(运动监控)
相机选型:Intel RealSense D435i
├─ 深度分辨率:1280×720
├─ 深度精度:±1%(2m内)
├─ RGB分辨率:1920×1080
├─ 接口:USB3.0
├─ 防护:IP65防护罩(必须)
├─ 价格:约 1500–2000元
└─ SDK支持:成熟(ROS/PCL/OpenCV均有支持)
数据用途:
├─ 3D点云采集(定位用)
├─ 污渍识别(YOLOv8,训练自己数据集)
├─ 清洁质量验证(前后对比)
└─ 辅助逆运动学初始值估计
算法依赖度:中等
├─ 点云处理:PCL库(成熟)
├─ 深度学习检测:YOLOv8(成熟)
└─ 结论:都有现成库和框架,算法工程师只需调用
清洁场景的防水需求:
─────────────────────────────────────────────────────
清洁介质:
├─ 水:日常清洁使用
├─ 酸性清洁剂(pH 3–5):去除水垢
├─ 碱性清洁剂(pH 9–11):去除有机污渍
└─ 过氧化氢消毒液(H₂O₂):消毒用
防水挑战:
├─ 清洁液飞溅:方向不可预测
├─ 地面积水:底盘周围常有积水
├─ 高湿度:卫生间相对湿度常达60–80%
└─ 冲洗过程:大量水流冲刷
防水等级要求:
├─ 机械臂关节:IP65(防尘防水射流)
├─ 末端执行器:IP67(短时浸水)
├─ 控制柜:IP65
├─ 相机防护罩:IP67
└─ 电气接口:IP67
密封方式 | 适用部位 | 防水效果 | 成本 | 推荐度 |
|---|---|---|---|---|
O型圈密封(静态) | 关节外壳法兰连接处 | IP65 | 低 | 首选 |
骨架油封(动态旋转轴) | 电机输出轴穿过壳体处 | IP65 | 中 | 必选 |
唇形密封圈 | 低速旋转轴 | IP54–65 | 低 | 备选 |
机械密封 | 高速旋转轴 | IP67 | 高 | 高要求场景 |
关节密封结构设计(剖面示意):
─────────────────────────────────────────────────────
关节外壳(上半)
╔══════════════════════╗
║ [O型圈安装槽] ║ ← 静态密封(法兰连接处)
╠══════════════════════╣
║ ║
║ 减速器外壳 ║
║ ║
╠══════════════════════╣
║ [骨架油封] ║ ← 动态密封(输出轴穿出处)
╠══════════════════════╣
║ 输出轴 ║
╚══════════════════════╝
关节外壳(下半)
O型圈选型:
├─ 材料:食品级硅胶(耐酸碱腐蚀)
├─ 硬度:70 Shore A
├─ 标准:AS568(美标)→ AS568-158(常见规格)
└─ 成本:约 5–20元/个(硅胶材质贵3–5倍)
骨架油封选型:
├─ 材料:氟橡胶(FKM/Viton)(最佳耐腐蚀)
├─ 轴径:根据输出轴直径定制
└─ 成本:约 20–50元/个
部位 | 推荐材料 | 耐腐蚀等级 | 成本系数 |
|---|---|---|---|
关节外壳 | 铝合金6061 + 硬质阳极氧化 | 4 | 1.0× |
紧固件(螺钉) | 不锈钢316 | 5 | 1.5× |
密封件 | 氟橡胶 + 硅胶 | 5 | 2.0× |
轴承 | 不锈钢440C | 4 | 1.3× |
表面涂层 | 特氟龙涂层(局部) | 5 | 1.5× |
快换接口金属件 | 不锈钢316 + 镀金 | 5 | 2.0× |
线缆接头 | 不锈钢316 + 尼龙 | 4 | 1.5× |
表面处理是防腐的关键 铝合金6061经硬质阳极氧化(HARD ANODIZE)后,表面硬度达60–70HRC,耐磨耐腐蚀,是性价比最高的防腐方案。成本仅增加15–20%,但寿命延长3–5倍。
核心原则:用硬件换软件,用结构换算法 在算法能力有限的前提下,控制系统设计应尽量简单,减少软件层面的复杂性。
三层控制架构(相比传统协作臂大幅简化):
─────────────────────────────────────────────────────
Layer 1:任务层(上位机)
├─ 功能:任务规划、轨迹生成、视觉处理
├─ 硬件:工控机 / Jetson NX
├─ 算法:
│ ├─ 逆运动学(解析解,已知构型)
│ ├─ 轨迹规划(梯形速度规划,已知算法)
│ └─ 视觉识别(YOLOv8,调用成熟框架)
└─ 代码量:约 2000–3000 行
Layer 2:关节控制层(中控板)
├─ 功能:6个关节的实时位置/速度控制
├─ 硬件:STM32F4 / STM32H7
├─ 控制周期:1ms(1kHz)
├─ 算法:
│ ├─ PID位置环(每关节独立,已知算法)
│ ├─ 梯形速度规划(每关节独立)
│ └─ 限位保护(硬件层,硬限制)
└─ 代码量:约 500–800 行(成熟库支持)
Layer 3:驱动层(每关节独立)
├─ 功能:BLDC电机FOC驱动
├─ 硬件:BLDC驱动芯片(TI DRV8313 / ST L6234)
├─ 传感器:磁编码器 + 电流采样
└─ 说明:驱动芯片内置FOC,控制器只需发转速指令
对比传统协作臂控制:
├─ 传统:位置环+速度环+力矩环三层嵌套,PVT轨迹,参数整定复杂
└─ 本方案:仅位置环,梯形规划,参数整定简单
这是降低算法难度的关键:选择有解析解的构型
自研机械臂的逆运动学优势:
─────────────────────────────────────────────────────
通用6DOF臂:需要数值解,迭代计算,复杂
自研6DOF臂:选择特定构型,获得解析解,简单!
推荐构型特点(使逆运动学可解):
├─ 关节1–3:满足Pieper准则(关节3轴平行于关节1轴)
│ → 可分离位置和姿态的逆解
│ → 位置逆解:解析解,直接公式计算
│ → 姿态逆解:解析解,三角函数求解
│
└─ 关节4–6:标准腕部构型(三个旋转轴交于一点)
→ 腕部逆解独立求解,进一步简化
解析解 vs 数值解对比:
├─ 解析解:
│ ├─ 计算时间:< 1ms(硬件级)
│ ├─ 确定性:解唯一或有限多解,无收敛问题
│ └─ 代码实现:直接数学公式,无库依赖
│
└─ 数值解:
├─ 计算时间:5–20ms(需多次迭代)
├─ 确定性:可能不收敛,需初值估计
└─ 代码实现:需调用数值库(如KDL),参数多
结论:选择使逆运动学可解的构型,是降低控制难度的核心
梯形速度规划(最简单的轨迹规划算法):
─────────────────────────────────────────────────────
原理:位置曲线为梯形(匀速段+匀加速/减速段)
参数:
├─ q_start:起始位置
├─ q_end:终止位置
├─ Vmax:最大速度
├─ Amax:最大加速度
└─ 计算:ta = Vmax/Amax, Δq = q_end-q_start
算法步骤(伪代码):
1. 计算 Δq = q_end - q_start
2. 若 Δq < Vmax²/Amax(无法达到最大速度):
→ 实际 V = sqrt(Δq × Amax)
→ 只有加速段和减速段
3. 否则:
→ 匀加速段:ta = Vmax/Amax
→ 匀速段:tb = Δq/Vmax - ta
→ 匀减速段:td = ta + tb
不需要:样条曲线、nurbs、pvt等复杂算法
算法 | 类型 | 复杂度 | 实现难度 | 推荐度 |
|---|---|---|---|---|
逆运动学(解析解) | 位置控制 | 1 | 低 | 必选 |
梯形速度规划 | 轨迹规划 | 1 | 低 | 必选 |
PID位置环 | 关节控制 | 1 | 低 | 必选 |
限位保护 | 安全 | 1 | 低 | 必选 |
速度前馈 | 控制优化 | 2 | 中 | 可选 |
重力补偿 | 力学补偿 | 2 | 中 | 推荐 |
碰撞检测(电流法) | 安全 | 2 | 中 | 推荐 |
S型曲线规划 | 轨迹优化 | 2 | 低 | 可选 |
📌 不需要(有意不实现):
末端工具电气接口(统一标准):
─────────────────────────────────────────────────────
引脚定义(10-pin防水航空插头):
├─ Pin 1–2:工具电机电源(24V,GND)
├─ Pin 3–4:工具电机控制(PWM/方向信号)
├─ Pin 5–6:工具传感器信号(数字IO)
├─ Pin 7–8:工具ID识别(编码信号)
├─ Pin 9–10:预留(未来扩展)
└─ 外壳:屏蔽层 + 接地
工具ID编码(磁编码):
├─ 不同工具对应不同ID编码(2位二进制,4种工具)
│ → 00:内壁刷(旋转刷头)
│ → 01:座圈擦拭头
│ → 10:消毒液喷洒头
│ → 11:外壁擦拭头
└─ 控制器读取ID → 自动加载对应参数和轨迹
结构设计:
├─ 刷毛:螺旋形尼龙刷毛,直径 80–100mm
├─ 刷毛硬度:中等硬度(软硬度可调)
├─ 驱动电机:无刷直流电机(BLDC),内置于刷头
├─ 转速:200–600 rpm(可调,默认400 rpm)
├─ 安装:快换接口,即插即用
├─ 重量:约 500g(含电机)
└─ 清洁液管路:内置喷嘴,刷洗同时喷液
关键设计细节:
├─ 刷毛材质:尼龙66(耐酸碱,默认颜色白色)
├─ 刷毛磨损:预计每月更换(通过快换接口5秒完成)
├─ 电机防水:IP67(刷头浸入水封也没问题)
└─ 中心轴:空心设计,清洁液从中流出
工作参数:
├─ 接触力:5–10N(由被动柔顺机构保证)
├─ 清洁液流量:10–30 mL/min(可调)
├─ 单耗液量:约 50–100 mL
└─ 单次清洁时间:约 60–90秒
结构设计:
├─ 擦拭面:双面仿形擦拭布(上下表面同时擦)
├─ 基材:超细纤维布(吸水吸污性强)
├─ 驱动:被动(由机械臂运动带动擦拭)
├─ 清洁液:预喷,擦拭布自带少量清洁液
├─ 重量:约 300g
└─ 更换:一次性擦拭布(每次清洁换一张)
关键设计细节:
├─ 擦拭布贴合座圈曲率:被动形变适应
├─ 擦拭布固定:魔术贴(更换便捷)
├─ 用量:每个1张(按需更换)
└─ 末端集成小喷嘴:擦拭前预喷消毒液
结构设计:
├─ 喷嘴:雾化喷嘴(直径 0.3mm)
├─ 喷洒角度:60°–90°扇形
├─ 流量控制:电磁阀(精确控制开闭)
├─ 容量:机器人自带清洁液箱,此处为喷洒执行器
├─ 重量:约 200g
└─ 防护:IP67
工作参数:
├─ 喷洒量:10–50 mL/次(可调)
├─ 雾化粒径:50–100μm(消毒效果最佳范围)
├─ 喷洒距离:50–150mm
└─ 单消毒液量:约 30–50 mL
结构设计:
├─ 擦拭面:平面超细纤维布
├─ 形状:圆形/方形,直径/边长 80–100mm
├─ 驱动:被动(机械臂运动带动)
├─ 清洁液:预喷
├─ 重量:约 200g
└─ 更换:每次清洁后更换擦拭布
设计决策 | 选择 | 理由 |
|---|---|---|
自由度数量 | 6DOF | 全覆盖 + 可获解析逆解 |
关节构型 | 满足Pieper准则 | 逆运动学有解析解,降低算法难度 |
连杆参数 | L1=300, L2=250, L3=130mm | 满足清洁工作空间 |
减速器 | 谐波(J1–4)+ 行星(J5–6) | 谐波零背隙,简化控制 |
柔顺方式 | 被动柔顺(弹簧预压) | 替代主动力控,降低算法依赖 |
关节电机 | BLDC + FOC | 高效高力矩,驱动芯片内置FOC |
角度传感器 | 17-bit磁编码器 | 高精度无接触,寿命长 |
控制算法 | PID + 梯形规划 + 解析逆解 | 算法工程师最熟悉的方案 |
防护等级 | IP65(关节)/ IP67(末端) | 防水防腐,满足场景 |
末端接口 | 快换接口(自动切换) | 一机多用,5秒换工具 |
机械臂总体参数:
├─ 自由度:6
├─ 额定负载:3kg(末端)
├─ 最大负载:5kg(短时)
├─ 重复定位精度:±1.0mm
├─ 绝对定位精度:±2.0mm
├─ 工作半径:650mm(最大伸展)
├─ 关节速度:最大 90°/s(各关节)
├─ 末端最大速度:500mm/s
├─ 重量:约 8–10kg(含所有关节)
├─ 防护等级:IP65(关节)/ IP67(末端工具)
└─ 供电:DC 24V
各关节参数:
┌────┬──────────────┬────────┬──────────┬─────────┬───────────┐
│关节│ 类型 │ 减速比 │ 最大扭矩 │ 重量 │ 外径 │
├────┼──────────────┼────────┼──────────┼─────────┼───────────┤
│ J1 │ 底座旋转 │ 1:50 │ 15 N·m │ 1.8kg │ φ140mm │
│ J2 │ 肩部俯仰 │ 1:50 │ 12 N·m │ 1.5kg │ φ120mm │
│ J3 │ 肩部偏移 │ 1:50 │ 10 N·m │ 1.2kg │ φ100mm │
│ J4 │ 肘部俯仰 │ 1:50 │ 8 N·m │ 0.9kg │ φ85mm │
│ J5 │ 腕部俯仰 │ 1:10 │ 3 N·m │ 0.4kg │ φ65mm │
│ J6 │ 腕部旋转 │ 1:10 │ 2 N·m │ 0.3kg │ φ50mm │
└────┴──────────────┴────────┴──────────┴─────────┴───────────┘
被动柔顺参数:
├─ 柔顺方式:弹簧预压(J1–4)+ 弹性联轴器(J5–6)
├─ 弹簧刚度:10 N/mm(可调批次)
├─ 预压接触力:5–10N(清洁标准)
├─ 允许压缩量:0–3mm(限位保护)
└─ 刚度批次:软(5N)/ 中(8N)/ 硬(12N)三档可选
末端工具参数:
┌────────────┬───────────┬──────────┬──────────┬─────────┐
│ 工具 │ 重量 │ 功率 │ 耗液量 │ 更换频率 │
├────────────┼───────────┼──────────┼──────────┼─────────┤
│ 内壁刷头 │ 500g │ 20W │ 50–100mL │ 每月 │
│ 座圈擦拭 │ 300g │ 0(被动)│ 20–30mL │ 每次 │
│ 喷洒头 │ 200g │ 5W │ 30–50mL │ 季度 │
│ 外壁擦拭 │ 200g │ 0(被动)│ 10–20mL │ 每次 │
└────────────┴───────────┴──────────┴──────────┴─────────┘
部件 | 成本估算 | 说明 |
|---|---|---|
铝合金结构件(加工) | 5000–8000元 | 6个关节壳体+连杆+基座 |
谐波减速器 ×4 | 8000–20000元 | 国产绿的/来福谐波 |
行星减速器 ×2 | 400–1200元 | 内转子行星 |
BLDC电机 ×6 | 1500–3000元 | 国产朗宇/万至 |
磁编码器 ×6 | 300–1200元 | AMS AS5047P |
关节控制板 ×6 | 600–1200元 | STM32驱动板 |
防水密封件 | 500–1000元 | O型圈+油封+密封胶 |
末端快换接口 | 300–500元 | 定制 |
末端工具 ×4 | 1000–2000元 | 刷头+擦拭头等 |
传感器及线缆 | 2000–3000元 | 相机+接插件 |
表面处理 | 800–1500元 | 硬质阳极氧化 |
装配+调试 | 3000–5000元 | 人工 |
总计 | 约 20000–45000元 | 不含上位机和底盘 |
成本对比:自研 vs 采购
算法能力需求 vs 本方案实现:
─────────────────────────────────────────────────────
原本需要的算法能力(主动力控方案):
├─ 阻抗/导纳控制理论:需深度理解
├─ 力传感器数据融合:需6通道同步处理
├─ 自适应参数整定:需经验丰富的控制工程师
└─ 整体难度:5(需要专业团队)
本方案需要的算法能力(被动柔顺+简化控制):
├─ 逆运动学:解析解,公式直接代入
├─ 梯形轨迹规划:工科基础课内容
├─ PID控制:工科基础课内容
├─ 视觉识别:调用YOLOv8,训练自己的数据集
└─ 整体难度:3(本科毕业生可完成)
结论:本方案将算法难度从"专家级"降低到"工程师级",
在有限算法能力下完全可以实现。