VASS06安全机器人控制V9.22

科技   汽车   2024-10-14 20:01   吉林  

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


......未完待续

机器人及PLC自动化应用
机器人技术讲解,PLC程序分析讲解,PLC机器人自动化培训. 以工业自动化培训为主.也会有些个人喜爱的军事和休闲.
 最新文章