首页
学习
活动
专区
圈层
工具
发布
社区首页 >专栏 >复合清洁机器人的协作机械臂方案

复合清洁机器人的协作机械臂方案

作者头像
索旭东
发布2026-05-09 10:46:27
发布2026-05-09 10:46:27
220
举报
文章被收录于专栏:具身小站具身小站

1

设计目标与约束

1.1 功能目标

代码语言:javascript
复制
机械臂需要完成的清洁任务:
├─ 内壁刷洗(主要任务,曲面接触)
├─ 座圈擦拭(次要任务,平面接触)
├─ 外壁擦拭(辅助任务)
├─ 消毒液喷洒(工具切换)
└─ 冲水按钮按压(精准定位)

1.2 关键设计约束

约束类型

约束条件

设计影响

工作半径

500–700mm

覆盖内壁全部区域

末端负载

≥ 2kg

满足清洁工具重量(含刷头+电机)

重复定位精度

±1–2mm

满足座圈擦拭精度要求

生活空间高度

0–800mm

机械臂工作空间覆盖此范围

底盘尺寸

≤ 600mm宽

臂基座安装面有限

防护等级

IP65以上

防水防清洁液腐蚀

算法能力

有限(核心约束)

必须简化控制复杂度

1.3 来自清洁的特殊约束

代码语言:javascript
复制
清洁对机械臂的独特要求:
─────────────────────────────────────────────────────
要求1:末端需要沿内壁曲面运动
 → 需要柔顺跟随能力
 → 如果纯位置控制:需要精确的曲面轨迹规划(算法难)
 → 解决方案:被动柔顺机构(机械做,算法不管)

要求2:末端需要保持恒定接触力
 → 如果纯位置控制:需要实时力控反馈(算法难)
 → 解决方案:弹簧预压机构(机械保证,算法只管方向)

要求3:末端需要能伸入内壁底部(最低点以下)
 → 几何可达性要求(空间约束)
 → 解决方案:合理的连杆长度设计

要求4:清洁过程中可能碰到障碍物(座圈边缘、门框)
 → 安全碰撞处理
 → 解决方案:限力关节 + 被动退让机构

2

自由度配置方案对比

这是第一个核心设计决策 ,自由度数量直接决定控制复杂度和机械复杂度。

  • 方案A:4DOF(最小配置)
代码语言:javascript
复制
自由度配置:肩部俯仰×1 + 肘部俯仰×1 + 腕部俯仰×1 + 腕部旋转×1

工作空间覆盖分析:
├─ 能覆盖内壁主体区域(约80%)
├─ 座圈擦拭:可达,但姿态受限
└─ 底部清洁:有限(取决于连杆参数)

控制复杂度:极低(可实现纯位置控制)
机械复杂度:极低(结构最简单)
清洁覆盖率:70–80%

结论:不推荐,自由度不足导致清洁覆盖率低
  • 方案B:5DOF(中等配置)
代码语言:javascript
复制
自由度配置:肩部水平旋转×1 + 肩部俯仰×1 + 肘部俯仰×1 + 腕部俯仰×1 + 腕部旋转×1

工作空间覆盖分析:
├─ 能覆盖内壁主体区域(约90%)
├─ 座圈擦拭:可达,姿态较好
├─ 底部清洁:可达
└─ 多角度避障:有限

控制复杂度:低(接近4DOF,易实现)
机械复杂度:低(增加1个关节)
清洁覆盖率:85–90%

结论:备选方案,适合预算有限团队
  • 方案C:6DOF(标准配置)推荐
代码语言:javascript
复制
自由度配置:
├─ 关节1:底座旋转(水平面,±180°)
├─ 关节2:肩部俯仰(垂直面,-90°~+90°)
├─ 关节3:肩部偏移(水平内收外展,±30°)
├─ 关节4:肘部俯仰(垂直面,-135°~+135°)
├─ 关节5:腕部俯仰(垂直面,-90°~+90°)
└─ 关节6:腕部旋转(末端工具旋转,±360°)

工作空间覆盖分析:
├─ 内壁主体区域:完全覆盖
├─ 座圈上下表面:灵活可达
├─ 底部(内壁最深处):可达
├─ 外壁多角度擦拭:全方位
└─ 避障灵活性:冗余自由度,支持奇异位形规避

控制复杂度:中(需逆运动学求解)
机械复杂度:中(标准6DOF结构)
清洁覆盖率:95–100%

结论:✅ 推荐,这是清洁任务的最佳性价比配置
  • 方案D:7DOF(冗余配置)
代码语言:javascript
复制
自由度配置: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参数法建立机械臂运动学模型:

代码语言:javascript
复制
坐标系设置(从基座到末端):
─────────────────────────────────────────────────────
Z0:基座旋转轴(垂直,↑朝上)
Z1:肩部俯仰轴(垂直,⊥于Z0)
Z2:肩部偏移轴(水平)
Z3:肘部俯仰轴(垂直)
Z4:腕部俯仰轴(垂直)
Z5:腕部旋转轴(垂直)

末端执行器坐标系(Z6):
├─ Z轴:指向清洁工具
├─ X轴:工具的"前进"方向
└─ 原点:清洁工具的工作点

3.2 连杆长度设计(核心参数)

连杆长度决定了工作空间的大小和形状,必须精确计算。

  • 设计约束分析
代码语言:javascript
复制
清洁任务对工作空间的要求:
─────────────────────────────────────────────────────
内壁关键区域(需完全覆盖):
├─ A区(后壁):距离基座最远点,约 550mm
├─ B区(底部最低点):约 200mm(高度)
├─ C区(边缘):约 350–400mm(径向)
└─ D区(座圈上方):约 450–550mm(高度)

工作空间需求:
├─ 径向范围:200–650mm(从基座中心计算)
├─ 高度范围:0–600mm
└─ 角度范围:基座±180°旋转
  • 连杆参数计算
代码语言:javascript
复制
连杆长度确定过程:

假设基座高度(安装面到肩部):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

2

θ₂(肩俯仰)

0

L1=300mm

3

θ₃(肩偏移)

0

L2=250mm

+90°

4

θ₄(肘俯仰)

0

L3=130mm

5

θ₅(腕俯仰)

0

0

6

θ₆(腕旋转)

0

0

注意: DH参数中的θ₂和θ₃设置为变量,而非固定偏移,这样可以在不改变连杆长度的情况下,通过关节角度调整来适应不同的位姿,减少对底盘校准精度的要求。

3.4 工作空间验证 图示说明: ├─ 外虚线:臂最大伸展边界(675mm径向) ├─ 内实线:有效清洁区域(200–550mm径向) └─ 绿色区域:工作空间与清洁区域的重叠 → 几乎完全覆盖,仅最深底部有少量盲区(可接受)

4

关节驱动方案选型

4.1 关节电机选型对比

电机类型

效率

力矩密度

控制复杂度

成本

推荐度

无刷直流电机(BLDC)

高(85–90%)

中(需FOC)

推荐

步进电机(开环)

低(40–60%)

极低(脉冲控制)

精度不足

步进电机(闭环)

中(60–70%)

低(脉冲+编码器)

中低

备选

有刷直流电机

低(60–70%)

力矩不足

伺服电机(带驱动)

中(位置/速度环)

高成本

推荐:无刷直流电机(BLDC)+ FOC矢量控制

  • BLDC效率高(85–90%),发热少,适合电池供电
  • 力矩密度高,相同体积下比步进电机输出更大力矩
  • FOC控制成熟,ST、TI均有成熟芯片方案(降低开发难度)
  • 市面上有大量成熟的BLDC关节模组可选,降低自研风险

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)

代码语言:javascript
复制
减速器配置方案(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元

为什么谐波减速器适合自研?

  • 零背隙 :谐波减速器天然零背隙(柔轮弹性啮合),这意味着 不需要复杂的控制算法来补偿回差 ,大幅降低控制难度
  • 高精度 :重复定位精度 ±10–15弧秒,减少末端累积误差
  • 体积小重量轻 :相同力矩下比RV轻30–40%,适合移动机器人
  • 缺点 :不能承受过大冲击载荷(清洁接触力在5–10N范围内,安全)

5

被动柔顺机构设计(核心创新)

这是本方案最重要的设计创新,直接解决算法能力不足的核心矛盾。

5.1 核心思想

代码语言:javascript
复制
传统方案(算法承担复杂度):
末端接触力控制 → 需要实时力传感器 + 阻抗控制算法 + 参数整定
→ 算法能力有限时难以实现

本方案(机械承担复杂度):
末端接触力控制 → 通过弹簧预压 + 机械限位 + 被动变形实现
→ 算法只需发出位置指令,机械自动处理接触力

本质:把"力控制"问题转化为"位置控制"问题,
 而位置控制是算法工程师最熟悉、最容易实现的任务。

5.2 方案一:弹簧预压式被动柔顺(核心推荐)

代码语言:javascript
复制
机构原理:
─────────────────────────────────────────────────────
结构组成:
├─ 弹簧(压缩型):安装于关节输出端
│ └─ 预压量:可调(通过调节螺母设置)
│ └─ 弹簧刚度:k = 5–20 N/mm(根据清洁力需求选择)
│
├─ 限位机构:
│ └─ 机械限位块:防止过压损坏
│ └─ 限位开关:触发信号通知控制器
│
└─ 力矩传感器(可选,用于安全检测):
 └─ 监测弹簧压缩量超限(间接测力)

工作原理:
├─ 正常清洁接触力(5–10N):
│ 弹簧被压缩 1–2mm → 末端自动退让,保持恒定力
│ 算法发出位置指令,机械自动维持接触力
│
├─ 遇到凸起(突然增力):
│ 弹簧快速压缩 → 末端退让 → 接触力不超过安全值
│
└─ 算法看到的:只是一个"更远"的目标位置
 机械自动处理接触力变化,算法无需感知

控制算法的简化:
原来:实时力反馈 → PID力控 → 调整关节位置
现在:设定目标轨迹 → 关节位置闭环 → 机械保证接触力

弹簧参数设计计算

代码语言:javascript
复制
设计目标:末端接触力 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 方案二:弹性联轴器式被动柔顺

代码语言:javascript
复制
机构原理:
├─ 关节电机与减速器之间使用弹性联轴器连接
├─ 联轴器材料:聚氨酯弹性体(硬度60A)
├─ 当末端遇到阻力时,联轴器产生弹性扭转变形
└─ 变形量与接触力成正比,自动退让

优点:
├─ 结构最简单,无需额外零件
├─ 同时吸收角度误差和力矩误差
└─ 适合中等柔顺需求

缺点:
├─ 力矩-变形关系非线性(弹性体特性)
├─ 刚度不可调(选择材料后固定)
└─ 不适合精确力控

适用场景:关节5–6(腕部),末端工具较轻时

5.4 方案三:气弹簧式被动柔顺

代码语言:javascript
复制
机构原理:
├─ 在关节6末端集成微型气弹簧
├─ 气弹簧内部充入低压氮气
├─ 压缩行程提供恒定支撑力(接近理想恒力弹簧)
└─ 末端执行器通过气弹簧与臂末端连接

优点:
├─ 力-位移特性线性(理想气体弹簧特性)
├─ 刚度可调(通过充气压力调节)
├─ 无机械摩擦,可靠性高
└─ 清洁力恒定,不随压缩量变化

缺点:
├─ 需要气源(氮气瓶或微型压缩机)
├─ 体积较大(相比弹簧)
└─ 密封要求高(防清洁液渗入)

适用场景:末端清洁力要求严格恒定的场合

5.5 三种被动柔顺方案对比

维度

弹簧预压式

弹性联轴器式

气弹簧式

力控精度

±2N(可调)

±5N(固定)

±1N(最佳)

结构复杂度

体积重量

极小

可调性

好(预压量可调)

差(选材固定)

好(压力可调)

可靠性

最高

中(密封挑战)

维护性

好(弹簧易换)

极好

差(需专业维护)

成本

低(50–200元)

极低(20–100元)

高(500–2000元)

推荐场景

大范围推荐

腕部小负载

高精度需求

推荐度

首选

辅助/备选

特定场景

推荐:弹簧预压式为主 + 弹性联轴器式为辅

  • 关节1–4(大关节):弹簧预压式,提供主要柔顺补偿
  • 关节5–6(腕部):弹性联轴器式,结构最简单可靠

这种组合用 最低的成本 实现了 足够的柔顺性 ,同时 对算法零要求

5.6 被动柔顺的局限性及应对

代码语言:javascript
复制
被动柔顺的固有限制:
─────────────────────────────────────────────────────
限制1:力控精度有限(±2–5N)vs 主动力控(±0.5N)
 → 应对:清洁需求为5–10N,±2N精度完全可接受

限制2:弹簧刚度固定,无法实时调整
 → 应对:不同清洁任务使用不同弹簧(软/中/硬三档)

限制3:无法感知清洁效果(不知道哪里没擦干净)
 → 应对:配合视觉验证(RGB-D相机拍照对比)

限制4:无法自适应不同的曲面曲率
 → 应对:
 ├─ 底盘校准保证基础位置精度(±10mm)
 ├─ 刷头设计为可变形材质(硅胶刷毛)
 └─ 弹簧柔顺吸收残余误差

结论:被动柔顺 + 底盘校准 + 可变形刷头 = 在有限算法能力下
 实现接近主动力控的清洁效果

6

机械结构与材料

6.1 整体结构布局

代码语言:javascript
复制
机械臂整体结构(从基座到末端):
─────────────────────────────────────────────────────

 [腕旋转关节 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个关节采用相同结构(不同减速器规格),降低加工难度,便于维护。

代码语言:javascript
复制
标准关节模块结构(每个关节相同):
─────────────────────────────────────────────────────
外观:圆柱形,直径根据关节编号递减
├─ J1:直径 140mm(底座旋转,负载最大)
├─ J2:直径 120mm(肩俯仰,高负载)
├─ J3:直径 100mm(肩偏移,中等负载)
├─ J4:直径 85mm(肘俯仰,中等负载)
├─ J5:直径 65mm(腕俯仰,低负载)
└─ J6:直径 50mm(腕旋转,低负载)

每个关节内部(相同结构):
├─ 步进电机/BLDC电机(带编码器)
├─ 减速器(谐波或行星)
├─ 双轴承支撑(深沟球+角接触)
├─ 谐波减速器外壳(铝)
├─ 输出法兰(铝)
├─ 关节角度传感器(磁编码器)
└─ O型圈密封(IP65保证)

关节接口(标准化):
├─ 电气接口:防水航空插头(同一型号)
├─ 线缆走线:内部穿线,无外部线缆
└─ 安装接口:相同规格螺钉孔位(同一型号)

6.4 末端工具快换接口

代码语言:javascript
复制
末端快换接口设计(核心结构):
─────────────────────────────────────────────────────
结构:卡扣式自动锁紧机构

接口规格:
├─ 连接方式:中心定位销 + 环形磁吸 + 弹簧锁紧
├─ 重复定位精度:±0.1mm
├─ 锁紧力:≥ 50kg(安全可靠)
├─ 工具识别:磁编码(不同工具对应不同编码)
└─ 电气接口:2个引脚(供电)+ 2个引脚(信号)

工具切换流程(自动):
1. 控制器发出切换指令
2. 机械臂将当前工具对准回收位
3. 解锁机构释放(电磁铁断电,弹簧解锁)
4. 机械臂移向下一工具位
5. 新工具对准接口,插入
6. 磁吸自动对位
7. 锁紧机构锁死
8. 电气连接建立

切换时间:≤ 3秒(自动)

七、传感系统设计

7.1 传感器配置

📌 核心原则:够用即可,不过度配置 算法能力有限,传感器数据必须易于理解和处理。

传感器

数量

类型

用途

数据处理难度

关节角度传感器

6个

磁编码器(17-bit)

各关节角度反馈

极简单

关节力矩传感器

6个

电流估算(BLDC自带)

过载保护

简单

末端力限位开关

3个

微动开关

被动柔顺极限检测

简单

末端RGB-D相机

1个

Intel RealSense系列

视觉定位/污渍识别

中等

工具识别传感器

6个

磁编码(快换接口用)

当前工具类型识别

极简单

为什么不加更多传感器?

  • 六维力传感器:数据处理复杂(6通道融合),需要专门力控算法 → ❌ 不加
  • 电子皮肤(触觉阵列):数据量大,处理复杂 → ❌ 不加
  • IMU(惯性测量):数据处理需滤波融合 → ❌ 不加
  • 核心原则: 每加一个传感器,就必须有对应的算法处理它。在算法能力有限时,减少传感器数量增加传感器更明智。

7.2 关节角度传感器(必须)

代码语言:javascript
复制
磁编码器选型(每个关节1个):
├─ 类型:AMS AS5047P / AS5600(磁编码器)
├─ 分辨率:17-bit(±0.003°分辨率)
├─ 接口:ABI / SPI
├─ 特点:无接触,寿命长,不怕振动
└─ 成本:约 50–200元/个

数据用途:
├─ 正运动学计算(实时末端位置)
├─ 逆运动学求解(轨迹规划)
├─ 安全限位(关节角度超限报警)
└─ 速度/加速度计算(运动监控)

7.3 末端RGB-D相机

代码语言:javascript
复制
相机选型:Intel RealSense D435i
├─ 深度分辨率:1280×720
├─ 深度精度:±1%(2m内)
├─ RGB分辨率:1920×1080
├─ 接口:USB3.0
├─ 防护:IP65防护罩(必须)
├─ 价格:约 1500–2000元
└─ SDK支持:成熟(ROS/PCL/OpenCV均有支持)

数据用途:
├─ 3D点云采集(定位用)
├─ 污渍识别(YOLOv8,训练自己数据集)
├─ 清洁质量验证(前后对比)
└─ 辅助逆运动学初始值估计

算法依赖度:中等
├─ 点云处理:PCL库(成熟)
├─ 深度学习检测:YOLOv8(成熟)
└─ 结论:都有现成库和框架,算法工程师只需调用

八、防水防腐设计

8.1 防水等级需求分析

代码语言:javascript
复制
清洁场景的防水需求:
─────────────────────────────────────────────────────
清洁介质:
├─ 水:日常清洁使用
├─ 酸性清洁剂(pH 3–5):去除水垢
├─ 碱性清洁剂(pH 9–11):去除有机污渍
└─ 过氧化氢消毒液(H₂O₂):消毒用

防水挑战:
├─ 清洁液飞溅:方向不可预测
├─ 地面积水:底盘周围常有积水
├─ 高湿度:卫生间相对湿度常达60–80%
└─ 冲洗过程:大量水流冲刷

防水等级要求:
├─ 机械臂关节:IP65(防尘防水射流)
├─ 末端执行器:IP67(短时浸水)
├─ 控制柜:IP65
├─ 相机防护罩:IP67
└─ 电气接口:IP67

8.2 关节密封方案

密封方式

适用部位

防水效果

成本

推荐度

O型圈密封(静态)

关节外壳法兰连接处

IP65

首选

骨架油封(动态旋转轴)

电机输出轴穿过壳体处

IP65

必选

唇形密封圈

低速旋转轴

IP54–65

备选

机械密封

高速旋转轴

IP67

高要求场景

代码语言:javascript
复制
关节密封结构设计(剖面示意):
─────────────────────────────────────────────────────
 关节外壳(上半)
 ╔══════════════════════╗
 ║ [O型圈安装槽] ║ ← 静态密封(法兰连接处)
 ╠══════════════════════╣
 ║ ║
 ║ 减速器外壳 ║
 ║ ║
 ╠══════════════════════╣
 ║ [骨架油封] ║ ← 动态密封(输出轴穿出处)
 ╠══════════════════════╣
 ║ 输出轴 ║
 ╚══════════════════════╝
 关节外壳(下半)

O型圈选型:
├─ 材料:食品级硅胶(耐酸碱腐蚀)
├─ 硬度:70 Shore A
├─ 标准:AS568(美标)→ AS568-158(常见规格)
└─ 成本:约 5–20元/个(硅胶材质贵3–5倍)

骨架油封选型:
├─ 材料:氟橡胶(FKM/Viton)(最佳耐腐蚀)
├─ 轴径:根据输出轴直径定制
└─ 成本:约 20–50元/个

8.3 耐腐蚀材料方案

部位

推荐材料

耐腐蚀等级

成本系数

关节外壳

铝合金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倍。


九、控制系统简化设计

核心原则:用硬件换软件,用结构换算法 在算法能力有限的前提下,控制系统设计应尽量简单,减少软件层面的复杂性。

9.1 控制架构(三层简化)

代码语言:javascript
复制
三层控制架构(相比传统协作臂大幅简化):
─────────────────────────────────────────────────────
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轨迹,参数整定复杂
└─ 本方案:仅位置环,梯形规划,参数整定简单

9.2 逆运动学(解析解优先)

这是降低算法难度的关键:选择有解析解的构型

代码语言:javascript
复制
自研机械臂的逆运动学优势:
─────────────────────────────────────────────────────
通用6DOF臂:需要数值解,迭代计算,复杂

自研6DOF臂:选择特定构型,获得解析解,简单!

推荐构型特点(使逆运动学可解):
├─ 关节1–3:满足Pieper准则(关节3轴平行于关节1轴)
│ → 可分离位置和姿态的逆解
│ → 位置逆解:解析解,直接公式计算
│ → 姿态逆解:解析解,三角函数求解
│
└─ 关节4–6:标准腕部构型(三个旋转轴交于一点)
 → 腕部逆解独立求解,进一步简化

解析解 vs 数值解对比:
├─ 解析解:
│ ├─ 计算时间:< 1ms(硬件级)
│ ├─ 确定性:解唯一或有限多解,无收敛问题
│ └─ 代码实现:直接数学公式,无库依赖
│
└─ 数值解:
 ├─ 计算时间:5–20ms(需多次迭代)
 ├─ 确定性:可能不收敛,需初值估计
 └─ 代码实现:需调用数值库(如KDL),参数多

结论:选择使逆运动学可解的构型,是降低控制难度的核心

9.3 轨迹规划(梯形速度规划)

代码语言:javascript
复制
梯形速度规划(最简单的轨迹规划算法):
─────────────────────────────────────────────────────
原理:位置曲线为梯形(匀速段+匀加速/减速段)

参数:
├─ 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等复杂算法

9.4 控制算法清单(简化后)

算法

类型

复杂度

实现难度

推荐度

逆运动学(解析解)

位置控制

1

必选

梯形速度规划

轨迹规划

1

必选

PID位置环

关节控制

1

必选

限位保护

安全

1

必选

速度前馈

控制优化

2

可选

重力补偿

力学补偿

2

推荐

碰撞检测(电流法)

安全

2

推荐

S型曲线规划

轨迹优化

2

可选

📌 不需要(有意不实现):

  • 阻抗/导纳力控(被动柔顺结构已承担此功能)
  • 导纳控制(地面清洁不需要)
  • 自适应控制(参数固定,不需要自适应)
  • 模型预测控制(MPC)(过于复杂)

十、末端执行器接口

10.1 快换接口电气定义

代码语言:javascript
复制
末端工具电气接口(统一标准):
─────────────────────────────────────────────────────
引脚定义(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 → 自动加载对应参数和轨迹

10.2 末端执行器详细设计

工具1:内壁旋转刷头(核心工具)
代码语言:javascript
复制
结构设计:
├─ 刷毛:螺旋形尼龙刷毛,直径 80–100mm
├─ 刷毛硬度:中等硬度(软硬度可调)
├─ 驱动电机:无刷直流电机(BLDC),内置于刷头
├─ 转速:200–600 rpm(可调,默认400 rpm)
├─ 安装:快换接口,即插即用
├─ 重量:约 500g(含电机)
└─ 清洁液管路:内置喷嘴,刷洗同时喷液

关键设计细节:
├─ 刷毛材质:尼龙66(耐酸碱,默认颜色白色)
├─ 刷毛磨损:预计每月更换(通过快换接口5秒完成)
├─ 电机防水:IP67(刷头浸入水封也没问题)
└─ 中心轴:空心设计,清洁液从中流出

工作参数:
├─ 接触力:5–10N(由被动柔顺机构保证)
├─ 清洁液流量:10–30 mL/min(可调)
├─ 单耗液量:约 50–100 mL
└─ 单次清洁时间:约 60–90秒
工具2:座圈双面擦拭头
代码语言:javascript
复制
结构设计:
├─ 擦拭面:双面仿形擦拭布(上下表面同时擦)
├─ 基材:超细纤维布(吸水吸污性强)
├─ 驱动:被动(由机械臂运动带动擦拭)
├─ 清洁液:预喷,擦拭布自带少量清洁液
├─ 重量:约 300g
└─ 更换:一次性擦拭布(每次清洁换一张)

关键设计细节:
├─ 擦拭布贴合座圈曲率:被动形变适应
├─ 擦拭布固定:魔术贴(更换便捷)
├─ 用量:每个1张(按需更换)
└─ 末端集成小喷嘴:擦拭前预喷消毒液
工具3:消毒液喷洒头
代码语言:javascript
复制
结构设计:
├─ 喷嘴:雾化喷嘴(直径 0.3mm)
├─ 喷洒角度:60°–90°扇形
├─ 流量控制:电磁阀(精确控制开闭)
├─ 容量:机器人自带清洁液箱,此处为喷洒执行器
├─ 重量:约 200g
└─ 防护:IP67

工作参数:
├─ 喷洒量:10–50 mL/次(可调)
├─ 雾化粒径:50–100μm(消毒效果最佳范围)
├─ 喷洒距离:50–150mm
└─ 单消毒液量:约 30–50 mL
工具4:外壁平面擦拭头
代码语言:javascript
复制
结构设计:
├─ 擦拭面:平面超细纤维布
├─ 形状:圆形/方形,直径/边长 80–100mm
├─ 驱动:被动(机械臂运动带动)
├─ 清洁液:预喷
├─ 重量:约 200g
└─ 更换:每次清洁后更换擦拭布

十一、设计总结与核心参数汇总

11.1 核心设计决策总结

设计决策

选择

理由

自由度数量

6DOF

全覆盖 + 可获解析逆解

关节构型

满足Pieper准则

逆运动学有解析解,降低算法难度

连杆参数

L1=300, L2=250, L3=130mm

满足清洁工作空间

减速器

谐波(J1–4)+ 行星(J5–6)

谐波零背隙,简化控制

柔顺方式

被动柔顺(弹簧预压)

替代主动力控,降低算法依赖

关节电机

BLDC + FOC

高效高力矩,驱动芯片内置FOC

角度传感器

17-bit磁编码器

高精度无接触,寿命长

控制算法

PID + 梯形规划 + 解析逆解

算法工程师最熟悉的方案

防护等级

IP65(关节)/ IP67(末端)

防水防腐,满足场景

末端接口

快换接口(自动切换)

一机多用,5秒换工具

11.2 完整参数表

代码语言:javascript
复制
机械臂总体参数:
├─ 自由度: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 │ 每次 │
└────────────┴───────────┴──────────┴──────────┴─────────┘

11.3 成本估算

部件

成本估算

说明

铝合金结构件(加工)

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 采购

  • 国产协作臂(AUBO/JAKA):约 12–20万元
  • 自研机械臂:约 2–4.5万元(节省 60–80%
  • 代价:需要机械设计能力 + 一定的嵌入式开发能力
  • 收益:极高的性价比,适合预算有限的团队

11.4 与算法能力的匹配度分析

代码语言:javascript
复制
算法能力需求 vs 本方案实现:
─────────────────────────────────────────────────────
原本需要的算法能力(主动力控方案):
├─ 阻抗/导纳控制理论:需深度理解
├─ 力传感器数据融合:需6通道同步处理
├─ 自适应参数整定:需经验丰富的控制工程师
└─ 整体难度:5(需要专业团队)

本方案需要的算法能力(被动柔顺+简化控制):
├─ 逆运动学:解析解,公式直接代入
├─ 梯形轨迹规划:工科基础课内容
├─ PID控制:工科基础课内容
├─ 视觉识别:调用YOLOv8,训练自己的数据集
└─ 整体难度:3(本科毕业生可完成)

结论:本方案将算法难度从"专家级"降低到"工程师级",
 在有限算法能力下完全可以实现。
本文参与 腾讯云自媒体同步曝光计划,分享自微信公众号。
原始发表:2026-04-11,如有侵权请联系 cloudcommunity@tencent.com 删除

本文分享自 具身小站 微信公众号,前往查看

如有侵权,请联系 cloudcommunity@tencent.com 删除。

本文参与 腾讯云自媒体同步曝光计划  ,欢迎热爱写作的你一起参与!

评论
登录后参与评论
0 条评论
热度
最新
推荐阅读
目录
  • 七、传感系统设计
  • 7.1 传感器配置
    • 7.2 关节角度传感器(必须)
    • 7.3 末端RGB-D相机
  • 八、防水防腐设计
    • 8.1 防水等级需求分析
    • 8.2 关节密封方案
    • 8.3 耐腐蚀材料方案
  • 九、控制系统简化设计
    • 9.1 控制架构(三层简化)
    • 9.2 逆运动学(解析解优先)
    • 9.3 轨迹规划(梯形速度规划)
    • 9.4 控制算法清单(简化后)
  • 十、末端执行器接口
    • 10.1 快换接口电气定义
    • 10.2 末端执行器详细设计
      • 工具1:内壁旋转刷头(核心工具)
      • 工具2:座圈双面擦拭头
      • 工具3:消毒液喷洒头
      • 工具4:外壁平面擦拭头
  • 十一、设计总结与核心参数汇总
    • 11.1 核心设计决策总结
    • 11.2 完整参数表
    • 11.3 成本估算
    • 11.4 与算法能力的匹配度分析
领券
问题归档专栏文章快讯文章归档关键词归档开发者手册归档开发者手册 Section 归档