'//////////////定义输入////////////DefIoin0=Bit,0DefIoin1=Bit,1DefIoin3=Bit,3DefIoin4=Bit,4DefIoin5=Bit,5DefIoin6=Bit,6DefIoin7=Bit,7DefIoin8=Bit,8DefIoin9=Bit,9DefIoin10=Bit,10DefIoin11=Bit,11DefIoin12=Bit,12DefIoin13=Bit,13DefIoin14=Bit,14DefIoin15=Bit,15'///////////////定义/输出//////////DefIoout0=Bit,0DefIoout1=Bit,1DefIoout3=Bit,3DefIoout4=Bit,4DefIoout5=Bit,5DefIoout6=Bit,6DefIoout7=Bit,7DefIoout8=Bit,8DefIoout9=Bit,9DefIoout10=Bit,10DefIoout11=Bit,11DefIoout12=Bit,12DefIoout13=Bit,13DefIoout14=Bit,14DefIoout15=Bit,15'//////////////定义变量//////////////DefJntjyd'定义安全点DefPlt1,p11,p17,p71,p77,4,4,1'定义托盘点j1=(+1.11,-60.00,+145.00,+0.00,+0.00,+86.61)jyd=(+0.00,-60.00,+145.00,+0.00,+0.00,-90.00)p0=(+0.00,+0.00,+20.00,+0.00,+0.00,+0.00)(0,0)p200=(+0.00,+0.00,+5.00,+0.00,+0.00,+0.00)(0,0)p201=(+0.00,+0.00,+150.00,+0.00,+0.00,+0.00)(0,0)p202=(+0.00,+135.00,+0.00,+0.00,+0.00,+0.00)(0,0)p203=(+0.00,+0.00,+60.00,+0.00,+0.00,+0.00)(0,0)p204=(+0.00,+20.00,+0.00,+0.00,+0.00,+0.00)(0,0)'////////////托盘点//////////////p12=p11p21=p11p22=p11p12.Y=p11.Y+12p21.X=p11.X+12p22.X=p11.X+12p22.Y=p11.Y+12p15=(Plt1,3)p16=p15p25=p15p26=p15p16.Y=p15.Y+12p25.X=p15.X+12p26.X=p15.X+12p26.Y=p15.Y+12p31=(Plt1,8)p32=p31p41=p31p42=p31p32.Y=p31.Y+12p41.X=p31.X+12p42.X=p31.X+12p42.Y=p31.Y+12p35=(Plt1,6)p36=p35p45=p35p46=p35p36.Y=p35.Y+12p45.X=p35.X+12p46.X=p35.X+12p46.Y=p35.Y+12p51=(Plt1,9)p52=p51p61=p51p62=p51p52.Y=p51.Y+12p61.X=p51.X+12p62.X=p51.X+12p62.Y=p51.Y+12p55=(Plt1,11)p56=p55p65=p55p66=p55p56.Y=p55.Y+12p65.X=p55.X+12p66.X=p55.X+12p66.Y=p55.Y+12p75=(Plt1,14)p76=p75p85=p75p86=p75p76.Y=p75.Y+12p85.X=p75.X+12p86.X=p75.X+12p86.Y=p75.Y+12p72=p71p81=p71p82=p71p72.Y=p71.Y+12p81.X=p71.X+12p82.X=p71.X+12p81.Y=p71.Y+12'///////////////判断/////////////IfM_In(9)=1AndM_In(10)=0Then'判断3个夹具是否在原位IfM_In(11)=0AndM_In(13)=0ThenGoSub*fw'程序fwEndIfEndIfIfM_In(9)=1AndM_In(10)=1Then'判断1夹具是否在原位IfM_In(11)=0AndM_In(13)=0ThenGoSub*fw1'夹具1复位EndIfEndIfIfM_In(9)=1AndM_In(10)=0Then'判断夹具2是否在原位IfM_In(11)=1AndM_In(13)=0ThenGoSub*fw2'夹具2复位EndIfEndIfIfM_In(9)=1AndM_In(10)=0Then'判断夹具3是否在原位IfM_In(11)=0AndM_In(13)=1ThenGoSub*fw3'夹具3复位EndIfEndIfIfM_05#>3Thenout14=1M_05#=0EndIfIfM_In(6)=1AndM_05#=0ThenGoSub*ks1'一次装机EndIfIfM_In(6)=1AndM_05#=1ThenGoSub*ks2'二次装机EndIfIfM_In(6)=1AndM_05#=2ThenGoSub*ks3'三次装机EndIfIfM_In(6)=1AndM_05#=3ThenGoSub*ks4'四次装机EndIfEnd'////////////////复位程序////////////*fw'程序复位Ovrd80j1=J_Currj1.J2=jyd.J2j1.J3=jyd.J3j1.J4=jyd.J4j1.J5=jyd.J5Movj1Movjydout5=1m_outb(6)=0'将输出信号6-13的8个位关闭M_00#=0M_05#=0M_01#=0Return'/////////////////////////////////////'//////////////////复位1/////////////////////*fw1Ovrd70j1=J_Currj1.J2=jyd.J2j1.J3=jyd.J3j1.J4=jyd.J4j1.J5=jyd.J5Movj1Movjydout12=0out13=0Movp1Movp23ovrd50Spd400Mvsp20-p204Mvsp20Dly0.2out11=1Dly0.2Mvsp20+p203out11=0GoSub*fw4Return'///////////////////////////'///////////////////////复位2////////////*fw2Ovrd70j1=J_Currj1.J2=jyd.J2j1.J3=jyd.J3j1.J4=jyd.J4j1.J5=jyd.J5Movj1Movjydout12=0out13=0ovrd50Movp40+p201Spd400Mvsp40Dly0.2out11=1Dly0.2Mvsp40+p203out11=0GoSub*fw4Return'///////////////////////////'/////////////////复位3////////////////*fw3Ovrd70j1=J_Currj1.J2=jyd.J2j1.J3=jyd.J3j1.J4=jyd.J4j1.J5=jyd.J5Movj1Movjydout12=1out13=0Movp5out12=0ovrd51Movp2Spd600Mvsp33Mvsp30+p200Mvsp30Dly0.2out1...
