当前位置：首页 > news >正文

软体机器人安全控制：力安全检测算法与工程实践

news 2026/4/24 5:39:35

软体机器人凭借其固有的柔顺特性，在医疗手术、精密装配等需要与环境进行安全交互的场景中展现出独特优势。然而，这种柔顺性也带来了新的控制难题：如何确保机器人在接触过程中施加的力始终处于安全阈值内？传统刚性机器人的碰撞检测方法在这里显得力不从心。

在刚性机器人领域，碰撞检测通常被视为一个纯粹的几何问题——只要机器人与障碍物不发生物理接触即视为安全。这种二元判断标准对软体机器人显然不再适用。想象一下外科手术场景：机械臂需要轻柔地触碰人体组织进行手术操作，完全避免接触既不现实也不合理。关键在于控制接触力的大小，这正是"力安全"概念的核心。

力安全检测面临三个主要技术瓶颈：

核心创新在于建立了任务空间(Task Space)与配置空间(C-space)之间的力安全映射关系。在任务空间中，我们定义原始障碍物为多面体N = {r | Hr ≤ h}，其中H和h定义了多面体的几何边界。通过引入力-形变模型ψ(n)，将最大允许接触力F_max转换为最大允许变形量n_max：

n_max = δ^(-1)ψ^(-1)(F_max)

这里δ∈[0,1]是安全系数，ψ^(-1)表示力-位移关系的逆函数。将N的每个面向内偏移n_max，就得到力不安全变形区域FODR(Force-Unsafe Obstacle Deformation Region)：

FODR = P = {r | H'r ≤ h'}

其中H' = H，h' = h - n_max√(m² + 1)，m是构成多面体的各超平面斜率。这种数学构造巧妙地将力安全标准编码到几何空间中。

为实现高效计算，采用分段常曲率(PCC)模型描述软体机械臂的运动学。对于n段机械臂，每段用三个参数描述：

曲率κi = qi/Li，曲率半径Ri = 1/κi = Li/qi。通过齐次变换矩阵T_i^(i-1)将各段参考系映射到相邻段：

T_i^(i-1) = [ R_i t_i [0] 1 ]

其中R_i∈SO(3)为旋转矩阵，t_i∈R3为平移向量。这种参数化方式将无限自由度的连续体离散化为有限维的配置空间q = (q1,...,qn)，为后续计算奠定基础。

直接检测机械臂整体与FODR的碰撞计算量巨大。我们采用Minkowski和方法，将FODR沿机械臂厚度r进行膨胀：

Or = O ⊕ M = {o + m | o∈O, m∈M}

其中M = {m∈R3 | ||m-b||≤r, ∀b∈B}表示以机械臂中心线B为基准的厚度区域。这样就将复杂的体积碰撞检测简化为中心线与膨胀后障碍物的相交测试，计算效率提升显著。

算法核心流程如下：

α-shape算法通过控制尺度参数α，生成包裹离散点云的紧致多边形边界。相比凸包方法，它能更精确地捕捉不安全区域的拓扑结构。MATLAB的alphaShape函数实现了这一过程，输出为简单多边形集合{Pk}。

为实现毫秒级响应，预处理阶段完成两项关键工作：

实际运行时，只需将当前配置q与Funsafe进行包含判断，计算复杂度为O(m)，m是多边形边数。实测平均查询时间仅0.000223秒，完全满足实时控制需求。

开发了二维仿真环境验证算法有效性：

通过离散采样(Δq=1°)构建配置空间地图，图6展示了任务空间与配置空间的对应关系。绿色区域表示安全配置，红色区域代表可能产生危险接触力的配置。

实物测试系统包含：

实验结果显示，当机械臂进入Funsafe区域时，实测接触力确实超过F_max(图10-11)，验证了算法的准确性。颜色编码的安全状态与实际力测量结果高度一致。

安全系数δ的选取：
- 建议初始值0.9-0.95
- 过高会导致机械臂动作过于保守
- 过低则可能失去保护作用
- 可通过增量测试法校准：从0.9开始，每次增加0.01，直到实测接触力略低于F_max
离散化分辨率Δq的权衡：
- 高分辨率(如0.5°)提升精度但增加计算负担
- 低分辨率(如2°)降低内存占用但可能遗漏细小不安全区域
- 对于多数应用，1°是较好的折中选择