Skip to content

SetColliParam 设置碰撞检测参数

该指令用于手动配置机器人各关节轴的碰撞检测开关状态及具体的灵敏度百分比。通过为不同轴设定差异化的阈值,可以实现更灵活的安全保护策略,例如在复杂工况下加强末端轴的灵敏度,或放宽大负载轴的限制。

指令格式

SetColliParam(colliId, AxisID, Valid, Value) SetColliParam(碰撞参数, 轴号, 有效性, 灵敏度值)


参数详细说明

参数类型说明默认值/备注
[colliId] 碰撞参数 (colliId)COLLIPARAM 变量碰撞检测功能所引用的参数组。可缺省,默认为系统出厂的 DEFAULT 参数。
AxisID:轴号枚举型* GROUP:所有轴
* A1-A6:对应 1 至 6 轴
* DEFAULT:无意义
Valid:有效性枚举型* ENABLE:开启检测
* DISABLE:关闭检测
仅在轴号为非 DEFAULT 时有效。
Value:灵敏度值整型单位为百分比 (%),取值范围 1~500。数值越小越灵敏。仅在轴号为非 DEFAULT 时有效。

工作原理

碰撞检测系统通过实时监控电机电流并与动力学模型计算出的理论力矩进行比对。该指令通过调整 Value(灵敏度值)来改变允许的偏差范围。当偏差超过 Value 设定的百分比阈值时,系统判定发生碰撞并触发停机保护。


示例

estun
// 示例 1:开启全部轴的碰撞检测,灵敏度设为 100%
SetColliParam(COLLI1, "GROUP", "ENABLE", 100)

// 示例 2:针对末端 6 轴进行强化保护,灵敏度设为 50%
SetColliParam(COLLI1, "A6", "ENABLE", 50)

执行结果

指令执行后,对应的轴会立即应用新的开关状态和灵敏度。如果后续运动中该轴受到的外力矩偏差超过了设定的百分比阈值,机器人将立即停止运动,并产生相应的碰撞报警提示。


应用场景

  • 差异化保护:搬运重物时,为防止惯性引起大轴误报,可适当放宽 A1-A3 轴灵敏度(如 150%),同时保持 A4-A6 小轴的高灵敏度以保护末端工具。
  • 特殊工艺放宽:在执行需要接触挤压力的动作(如压装)时,临时 DISABLE 特定轴或将 Value 调大,避免因工艺正常阻力导致程序中断。
  • 精细防碰撞:在狭窄空间内作业时,统一将所有轴的 Value 调小(如 80%),确保极轻微的触碰即可触发保护停机。

ESTUN Robotics — ER 系列机器人编程语言指令参考