FB 292 FB_Rob_Safe
该块用来控制Safe机器人。
该数据块通常会随自己的背景数据块一起被调用。
名称 | 类型 | 说明 |
RefTaster | BOOL | Safe 机器人寻参按钮 |
BT | BOOL | 执行制动器测试 |
JT | BOOL | 执行校准测试 |
NL | BOOL | 执行延时关闭测量 |
UebZVer | BOOL | 桥接自动维护选择的延迟时间 |
NachlMessIO | BOOL | 延时关闭测量正常 |
NachlMessLaeuft | BOOL | 延时关闭测量正在进行 |
ZVer | TIME | 自动维护选择的延迟时间 |
Akt_MR | WORD | 活动的信号域 1 激活 Bit0 -> MR1 …..Bit15-> MR16 |
DB_Anz | WORD | 对接站最大数量 6 |
DB_Belegt | WORD | 对接站被占用 Bit0 -> DB1 …..Bit7-> DB8 |
Layer | INT | 可视化对象的 Layer 编号 |
Cfg | WORD | 组态位(参见组态位表格) |
VkStoe_In | BOOL | 与 Vk_Stoe_Out 连锁的集中故障 |
ASP | BOOL | 服务程序请求 |
Vorw | BOOL | 预警 |
BTNIO | BOOL | 制动器测试正常 |
JTNIO | BOOL | 校准寻参不正常 |
RefTasterNIO | BOOL | 寻参按钮故障 |
NachlMessNIO | BOOL | 延时关闭测量不正常 |
PPE | BOOL | 到达停放位置 |
Stoexx | BOOL | 故障 |
Vk_Stoe_Out | BOOL | 连锁故障 |
工作方式
该块用来控制Safe机器人。
执行制动器测试或校准测试
机器人在每个工作序列和维护序列中的序列开始处查询选择制动器测试、选择校准测试和服务程序请求。如果存在选择或请求,就执行相应的功能。在执行之后重新重置选择或请求,并且将序列处理完毕。
选择制动器测试或校准测试
如果机器人处在序列125中的0点,并且不存在其他后续任务,那么在选择制动器测试或者校准测试的情况下,就会在设置的延迟时间‘ZVer’结束之后,自动为机器人选择维护。执行制动器测试或者校准测试之后自动重新确认维护位置。如果机器人不使用延时执行所选的功能,则要么必须通过‘维护’按钮选择维护,或者块输入‘UebZVer’为True。这里也会在执行制动器测试或校准测试之后自动确认维护位置。
可以通过.Cfg.X1 true或.Cfg.X5 true禁用校准测试或制动器测试,如果机器人不予支持。
服务程序请求
如果机器人处在序列125中的0点处,并且不存在其他后续任务,那么当存在服务程序请求时,就会在设置的延迟时间‘ZVer’结束之后自动为机器人选择维护。执行所请求的功能之后自动重新确认维护位置。如果机器人不使用延时执行服务程序请求,则块输入‘UebZVer’必须为True。这里也会在执行所请求的功能之后自动确认维护位置。如果在出现服务程序请求时通过‘维护’按钮选择维护(没有选择制动器测试和校准测试),机器人就会在执行所请求的功能之后进入维护位置,并且停在那里(不自动确认)。
如果机器人将服务程序请求发送给PLC并且因此也必须自动选择制动器测试,则.Cfg.X4必须为true。
显示制动器测试、校准测试、寻参按钮、故障和服务请求
在可视化对象上显示制动器测试、校准测试、寻参按钮、故障和服务请求。此外还将详细的故障消息输入到消息系统之中。
‘A252制动器磨损预警’= True-并且-
'A253制动器测试不正常'= False
A254校准寻参不正常'= True
‘RefTaster’= True (Safe机器人寻参按钮)-或-'A250当校准测试时' = True
'A251服务程序请求' = True
选择和取消制动器测试
只能通过可视化选择制动器测试(通过‘制动器测试’按钮)。不可以取消制动器测试。
选择了制动器测试并且执行(按键颜色蓝色)'A249当制动器测试时' = True
选择和取消校准测试
可以通过‘校准测试’按钮选择或取消校准测试(切换功能)。当出现负边沿时‘当校准测试时’自动取消校准测试。仅当是KUKA机器人的时候才能进行校准测试。如果是ABB机器人,就会隐藏该按钮并且功能不激活。
A249当校准测试时' = True
选择和取消延时关闭测量
只能通过可视化选择延时关闭测量(通过‘延时关闭测量’按钮)。不可以取消延时关闭测量。
Safe机器人显示和消息激活
如果.Cfg.X6为true,则激活Safe机器人显示。此外如果Safe机器人未激活,也会生成消息。
可以通过.Cfg.X7定义是否通过安全的机器人输出A2.0(安全轴监控激活)或者A.7.7(Safe组态互锁)形成显示和消息。当.Cfg.X7为false时使用A2.0,为true时使用A7.7。
Safety连接
应通过现场总线、而不是在机器人机柜中连接校准寻参按钮。
Safe机器人寻参按钮
应使用内部编码器电源将所使用的寻参按钮设计成2通道。
应根据Safety通道设置的类型1将输入组件的通道参数化(参见设计规范“VASS V6 Standard设计规范TIA_V_x_y”附录中的表格“Distributed Safety”
机器人侧USER编程:
IF Mit_Safe_Rob THEN
IF ($BRAKETEST_WORK==TRUE) THEN ;抱闸测试工作开始
$OUT[O_Safe_BrTes] = TRUE
给PLC发出A249进行抱闸测试
ELSE
$OUT[O_Safe_BrTes] = FALSE
ENDIF
IF ($Flag[FlagNo_GoToMasRefTest]==TRUE) THEN
;$MasteringTest_Req_Ext、$MasteringTest_Req_IntF989调整测试开始
$OUT[O_Safe_JuTes] = TRUE 给PLC发出A250
ELSE
$OUT[O_Safe_JuTes] = FALSE
ENDIF
IF $MasteringTest_Req_Int OR $BrakeTest_Req_Int THEN ;要求对BMS进行制动或调整测试
$OUT[O_Safe_Anf] = TRUE A251测试请求
ELSE
$OUT[O_Safe_Anf] = FALSE
ENDIF
IF ($BRAKETEST_WARN==TRUE) THEN ;警告磨损制动器
$OUT[O_Safe_VW_Br] = TRUE A252警告磨损制动器
ELSE
$OUT[O_Safe_VW_Br] = FALSE
ENDIF
IF ($BRAKES_OK==FALSE) THEN ;制动试验不合格
$OUT[O_Safe_B_nio] = TRUEA253制动试验不合格
ELSE
$OUT[O_Safe_B_nio] = FALSE
ENDIF
IF ($MasteringTest_Active AND NOT $MasteringTest_Switch_OK) THEN ; 调整参考不合格
$OUT[O_Safe_R_nio] = TRUE A254 校准寻参不正常
ELSE
$OUT[O_Safe_R_nio] = FALSE
ENDIF
IF ($OUT[O_Safe_B_nio] OR $OUT[O_Safe_R_nio] OR ($MasteringTest_Active AND NOT $MasteringTest_Switch_OK)) THEN ; 总故障
$OUT[O_Safe_Samm] = TRUEA256 集中故障
ELSE
$OUT[O_Safe_Samm] = FALSE
ENDIF
ENDIF
;ENDFOLD
E/A 249 | 选择制动器测试 | 当制动器测试时 |
E/A 250 | 选择校准测试 | 当校准测试时 |
E/A 251 | 选择延时关闭测量 | 服务程序请求 |
E/A 252 | 预留 | 制动器磨损预警 |
E/A 253 | 预留 | 制动器测试正常 |
E/A 254 | 校准寻参开关被占用 | 校准寻参不正常 |
E/A 255 | 预留 | 到达停放位置 |
E/A 256 | 预留 | 集中故障 |
E/A 273 | 未分配调整参考按钮 | 安全轴监控激活 |
E/A 274 | 预留 | 校准寻参正常 |
E/A 275 | 预留 | 机器人校准正常 |
E/A 289 | 预留 | 没有侵犯信号域 1 |
E/A 290 | 预留 | 没有侵犯信号域 2 |
E/A 291 | 预留 | 没有侵犯信号域 3 |
E/A 292 | 预留 | 没有侵犯信号域 4 |
E/A 293 | 预留 | 没有侵犯信号域 5 |
E/A 294 | 预留 | 没有侵犯信号域 6 |
E/A 295 | 预留 | 没有侵犯信号域 7 |
E/A 296 | 预留 | 没有侵犯信号域 8 |
E/A 297 | 预留 | 没有侵犯信号域 9 |
E/A 298 | 预留 | 没有侵犯信号域 10 |
E/A 299 | 预留 | 没有侵犯信号域 11 |
E/A 300 | 预留 | 没有侵犯信号域 12 |
E/A 301 | 预留 | 没有侵犯信号域 13 |
E/A 302 | 预留 | 没有侵犯信号域 14 |
E/A 303 | 预留 | 没有侵犯信号域 15 |
E/A 304 | 预留 | 没有侵犯信号域 16 |
F989 TECH 安全机器人调整检查开启
F990 TECH 安全机器人制动器检查开启
F991 TECH 安全机器人安全停车位置ON
工作和维护folgen中的编程
2: PTP VB=100% VE=0% ACC=100% RobWzg=1 Base=0 SPSTrig=0[1/100s]
1: t1 ( EIN ) = 0[1/10Sek]
2: A15 = AUS
3: TECH1 SFR Justageanforderung pruefen Techaufruf=EIN
4: TECH1 SFR Bremsentestanforderung pruefen Techaufruf=EIN
5: WARTE BIS E23
6: FB PSPS = M30
UP123 = F989
UP124 = F990
UP125 = F991
......未完待续