Skip to content

MovLSearch 直线寻位

寻位指令(MovLSearch)是指在执行该直线运动指令的过程中,实时进行 IO 信号检测轴力矩检测。一旦满足设定的触发条件(如 IO 到达触发值或轴力矩达到阈值),机器人将停止当前指令的运行,记录位置并继续执行后续程序。

注意:该指令会打断路径的过渡效果。

指令格式

MovLSearch(P, [V], [B], [C], [Tool], [Coord], [PayLoad], Type, Number, Value, [StopType], [StopDecScale], R, [SearchP], [Goto], [DO])

MovLSearch(目标点, [速度], [平滑], [姿态], [工具], [坐标系], [负载], 搜索类型, 端口号, 触发值, [停止方式], [减速比例], 结果变量, [搜索点记录], [跳转行号], [端口输出])

(备注:带 [] 参数为可选参数)


参数详细说明

参数类型说明默认值/备注
PAPOS 或 CPOS 变量坐标系下的理论目标点位置。必填
[V]SPEED 变量指定直线运动速度。SPEED 变量中的 tcp(平移)和 ori(旋转)分量有效;有外部轴时,exj_lexj_r 分量有效。可选,默认 V4000
[B]enum(FINE / DEFAULT)机器人逼近终点时的过渡方式。可选,默认 FINE
[C]ZONE 变量机器人逼近终点时的过渡值。可选,默认 C100
[Tool]TOOL 变量机器人执行该轨迹时使用的工具参数。可选,默认使用当前系统设置的工具参数
[Coord]USERCOOR 变量 / EXTTCP 变量 / 变位机变量机器人执行该轨迹时使用的坐标系参数。可选,默认使用当前系统设置的坐标系参数
[PayLoad]PAYLOAD 变量机器人执行该轨迹时使用的负载参数。可选,默认使用当前系统设置的负载参数
Typeenum检测类型:
DITrig:物理数字输入口触发。
AITrig:物理模拟量输入口触发。
SIMDITrig:虚拟数字输入口触发。
SIMAITrig:虚拟模拟量输入口触发。
TorqTrig:力矩触发。
必填
Numberint若为 DITrig,对应输入口号;若为 TorqTrig,对应轴编号必填
Valuereal检测阈值。若为 DITrig,为高低电平状态;若为 TorqTrig,为轴额定转矩的千分比必填
[StopType]enumHARDSTOP(立即停止,默认)、SOFTSTOP(减速停止)、DEFAULT可选,默认 HARDSTOP
[StopDecScale]real仅在 SOFTSTOP 时有效,值越大减速越快。可选
RINT 变量返回值:0(未满足条件结束)、1(运行中满足条件触发)、2(起点处已满足条件)。必填
[SearchP]CPOS记录满足触发条件时刻的坐标位置。可选
[Goto]label若寻位失败(R=0),程序跳转到该标签处。可选
[DO]string指令结束后可触发的 IO 指令(如 SetDO 等)。可选

应用示例

示例 1:直线寻位

estun
MovL(P1, V50, "RELATIVE", C100)
MovLSearch(P2, V50, "RELATIVE", C100, "DITrig", 16, 1, INT0)
MovL(P3, V50, "RELATIVE", C100)
  1. 机器人以 50 速度直线运动到 P1 点。
  2. 随后向 P2 做直线运动,并实时监控 16 号输入口
  3. 如果检测到高电平 (1):机器人立即停止向 P2 的运动,将 INT0 设为 1,直接开始向 P3 运动。
  4. 如果运动到 P2 仍无信号:机器人到达 P2 后将 INT0 设为 0,继续向 P3 运动。

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