123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251 |
- <?xml version="1.0" encoding="utf-8"?>
- <TcPlcObject Version="1.1.0.1" ProductVersion="3.1.4024.12">
- <POU Name="MC_Axis" Id="{fad15423-8beb-467d-9406-8ef20a004661}" SpecialFunc="None">
- <Declaration><![CDATA[PROGRAM MC_Axis
- VAR
- Buffer : AxisFunction;
- Boat : AxisFunction;
- CAPS : AxisFunction;
- END_VAR
- ]]></Declaration>
- <Implementation>
- <ST><![CDATA[//01.Axis 基础参数设置(TP MODE)
- Boat(AxisControl:=_200_Axis.BoatControl ,AxisData:= _200_Axis.BoatData, AxisState=>_200_Axis.BoatAxisState );
- Buffer(AxisControl:=_200_Axis.BufferControl ,AxisData:=_200_Axis.BufferData ,AxisState=>_200_Axis.BufferAxisState );
- CAPS(AxisControl:=_200_Axis.CapControl ,AxisData:=_200_Axis.CapData ,AxisState=>_200_Axis.CapAxisState );
- //轴最大转矩设置
- _200_Axis.BufferMaxTorque:=_200_Axis.BufferData.MaxTorque:=1000;
- _200_Axis.BoatMaxTorque:=_200_Axis.BoatData.MaxTorque:=1000;
- _200_Axis.CapMaxTorque:=_200_Axis.CapData.MaxTorque:=1000;
-
- //轴最大速度
- _200_Axis.BufferMaxSpeed:=_200_Axis.BufferData.MaxSpeed:=400;
- _200_Axis.BoatMaxSpeed:=_200_Axis.BoatData.MaxSpeed:=400;
- _200_Axis.CapMaxSpeed:=_200_Axis.CapData.MaxSpeed:=1000;
-
- //轴转矩当前值
- _200_Axis.BufferData.ActTorque:=_200_Axis.BufferActTorque;
- _200_Axis.BoatData.ActTorque:=_200_Axis.BoatActTorque;
-
-
- //--.01 Buffer
- //Buffer使能
- _200_Axis.BufferControl.RobotToAxisEnable:=FBI.I403_15;
- //Buffer JOG+
- _200_Axis.BufferControl.TPToAxisJogForward:=_200_Axis.JogPosEn AND _200_Axis.Run;
- //Buffer JOG-
- _200_Axis.BufferControl.TPToAxisJogBackwards:=_200_Axis.JogNegEn AND _200_Axis.Run;
- //Buffer JOG速度
- _200_Axis.BufferData.Vel[31]:=_200_Axis.JogVel;
- //Buffer 相对定位
- _200_Axis.BufferControl.RobotToCmdMoveRelative:=_200_Axis.MoveRelEn AND _200_Axis.Run;
- //Buffer 绝对定位
- _200_Axis.BufferControl.RobotToCmdMoveAbsolute:=_200_Axis.MovAbsEn AND _200_Axis.Run;
- //原点回归
- _200_Axis.BufferControl.RobotToCmdHome:=_200_Axis.HomeEn AND _200_Axis.Run;
- //A1 位置保存
- IF _200_Axis.A1PosSaveEn THEN
- _200_Axis.A1Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[1]:=_200_Axis.A1Position;
- ELSE
- _200_Axis.A1Position:=_200_Axis.BufferData.Pos[1];
- END_IF
-
-
- //A2 位置保存
- IF _200_Axis.A2PosSaveEn THEN
- _200_Axis.A2Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[2]:=_200_Axis.A2Position;
- ELSE
- _200_Axis.A2Position:=_200_Axis.BufferData.Pos[2];
- END_IF
-
- //A3 位置保存
- IF _200_Axis.A3PosSaveEn THEN
- _200_Axis.A3Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[3]:=_200_Axis.A3Position;
- ELSE
- _200_Axis.A3Position:=_200_Axis.BufferData.Pos[3];
- END_IF
-
- //A4 位置保存
- IF _200_Axis.A4PosSaveEn THEN
- _200_Axis.A4Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[4]:=_200_Axis.A4Position;
- ELSE
- _200_Axis.A4Position:=_200_Axis.BufferData.Pos[4];
- END_IF
-
- //B1 位置保存
- IF _200_Axis.B1PosSaveEn THEN
- _200_Axis.B1Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[5]:=_200_Axis.B1Position;
- ELSE
- _200_Axis.B1Position:=_200_Axis.BufferData.Pos[5];
- END_IF
- //B2 位置保存
- IF _200_Axis.B2PosSaveEn THEN
- _200_Axis.B2Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[6]:=_200_Axis.B2Position;
- ELSE
- _200_Axis.B2Position:=_200_Axis.BufferData.Pos[6];
- END_IF
- //B3 位置保存
- IF _200_Axis.B3PosSaveEn THEN
- _200_Axis.B3Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[7]:=_200_Axis.B3Position;
- ELSE
- _200_Axis.B3Position:=_200_Axis.BufferData.Pos[7];
- END_IF
- //B4 位置保存
- IF _200_Axis.B4PosSaveEn THEN
- _200_Axis.B4Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[8]:=_200_Axis.B4Position;
- ELSE
- _200_Axis.B4Position:=_200_Axis.BufferData.Pos[8];
- END_IF
- //C1 位置保存
- IF _200_Axis.C1PosSaveEn THEN
- _200_Axis.C1Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[9]:=_200_Axis.C1Position;
- ELSE
- _200_Axis.C1Position:=_200_Axis.BufferData.Pos[9];
- END_IF
- //C2 位置保存
- IF _200_Axis.C2PosSaveEn THEN
- _200_Axis.C2Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[10]:=_200_Axis.C2Position;
- ELSE
- _200_Axis.C2Position:=_200_Axis.BufferData.Pos[10];
- END_IF
- //C3 位置保存
- IF _200_Axis.C3PosSaveEn THEN
- _200_Axis.C3Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[11]:=_200_Axis.C3Position;
- ELSE
- _200_Axis.C3Position:=_200_Axis.BufferData.Pos[11];
- END_IF
- //C4 位置保存
- IF _200_Axis.C4PosSaveEn THEN
- _200_Axis.C4Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[12]:=_200_Axis.C4Position;
- ELSE
- _200_Axis.C4Position:=_200_Axis.BufferData.Pos[12];
- END_IF
- //D1 位置保存
- IF _200_Axis.D1PosSaveEn THEN
- _200_Axis.D1Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[13]:=_200_Axis.D1Position;
- ELSE
- _200_Axis.D1Position:=_200_Axis.BufferData.Pos[13];
- END_IF
- //D2 位置保存
- IF _200_Axis.D2PosSaveEn THEN
- _200_Axis.D2Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[14]:=_200_Axis.D2Position;
- ELSE
- _200_Axis.D2Position:=_200_Axis.BufferData.Pos[14];
- END_IF
- //D3 位置保存
- IF _200_Axis.D3PosSaveEn THEN
- _200_Axis.D3Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[15]:=_200_Axis.D3Position;
- ELSE
- _200_Axis.D3Position:=_200_Axis.BufferData.Pos[15];
- END_IF
- //D4 位置保存
- IF _200_Axis.D4PosSaveEn THEN
- _200_Axis.D4Position:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[16]:=_200_Axis.D4Position;
- ELSE
- _200_Axis.D4Position:=_200_Axis.BufferData.Pos[16];
- END_IF
- //正极限位置保存
- IF _200_Axis.PosSoftLimitSaveEN THEN
- _200_Axis.PosSoftLimit:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[17]:=_200_Axis.PosSoftLimit;
- ELSE
- _200_Axis.PosSoftLimit:=_200_Axis.BufferData.Pos[17];
- END_IF
- //负限位置保存
- IF _200_Axis.NegSoftLimitSaveEN THEN
- _200_Axis.NegSoftLimit:=_200_Axis.TPInputPos;
- _200_Axis.BufferData.Pos[18]:=_200_Axis.NegSoftLimit;
- ELSE
- _200_Axis.NegSoftLimit:=_200_Axis.BufferData.Pos[18];
- END_IF
- //点动速度限制
- IF _200_Axis.JogVel >10.0 THEN
- _200_Axis.JogVel:=1;
- ELSIF _200_Axis.JogVel <0.0 THEN
- _200_Axis.JogVel:=1;
- END_IF
-
-
-
- //A1 在位信号
-
- //A2 在位信号
- //A3 在位信号
- //A4 在位信号
- //B1 在位信号
- //B2 在位信号
- //B3 在位信号
- //B4 在位信号
- //C1 在位信号
- //C2 在位信号
- //C3 在位信号
- //C4 在位信号
- //D1 在位信号
- //D2 在位信号
- //D3 在位信号
- //D4 在位信号
- //位置显示
- _200_Axis.ActPos:=_200_Axis.BufferAxisState.Pos;
- //速度显示
- _200_Axis.ActVel:=_200_Axis.BufferAxisState.vel;
- //转矩显示
- _200_Axis.ActTorque:=_200_Axis.BufferActTorque;
- //使能显示
- _200_Axis.TeachServoOn:=_200_Axis.BufferAxisState.Enabled;
- //运动中
- _200_Axis.TeachServoMoving:=_200_Axis.BufferAxisState.Busy;
- //异常显示
- _200_Axis.TeachServoAlarm:=_200_Axis.BufferAxisState.Error;
- //正极限显示
- //负极限显示
- //异常ID
- _200_Axis.ServoCode:=_200_Axis.BufferAxisState.ErrorID;
- //按钮互锁
- IF _200_Axis.HMINo=190 THEN
- IF _200_Axis.HomeEn THEN
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.JogPosEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.JogNegEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.A1PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.B1PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.C1PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.D1PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.A2PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.B2PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.C2PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.D2PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.A3PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.B3PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.C3PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.D3PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.A4PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.B4PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.C4PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
- END_IF
- IF _200_Axis.D4PosSaveEn THEN
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- END_IF
- ELSE
- _200_Axis.HomeEn:=0;
- _200_Axis.JogPosEn:=0;
- _200_Axis.JogNegEn:=0;
- _200_Axis.A1PosSaveEn:=0;
- _200_Axis.B1PosSaveEn:=0;
- _200_Axis.C1PosSaveEn:=0;
- _200_Axis.D1PosSaveEn:=0;
- _200_Axis.A2PosSaveEn:=0;
- _200_Axis.B2PosSaveEn:=0;
- _200_Axis.C2PosSaveEn:=0;
- _200_Axis.D2PosSaveEn:=0;
- _200_Axis.A3PosSaveEn:=0;
- _200_Axis.B3PosSaveEn:=0;
- _200_Axis.C3PosSaveEn:=0;
- _200_Axis.D3PosSaveEn:=0;
- _200_Axis.A4PosSaveEn:=0;
- _200_Axis.B4PosSaveEn:=0;
- _200_Axis.C4PosSaveEn:=0;
- _200_Axis.D4PosSaveEn:=0;
-
-
- END_IF
- //--.02 Boat
- //Boat使能
- _200_Axis.BoatControl.RobotToAxisEnable:=_200_Axis.HMINo=191;
- //Boat JOG+
- _200_Axis.BoatControl.TPToAxisJogBackwards:=_200_Axis.BoatJogUPEn AND _200_Axis.Run1;
- //Boat JOG-
- _200_Axis.BoatControl.TPToAxisJogForward:=_200_Axis.BoatJogDownEn AND _200_Axis.Run1;
- //Boat JOG速度
- _200_Axis.BoatData.Vel[31]:=_200_Axis.BoatJogVel;
- //Boat 相对定位
- _200_Axis.BoatControl.RobotToCmdMoveRelative:=_200_Axis.BoatMoveRelEn AND _200_Axis.Run1;
- //Boat 绝对定位
- _200_Axis.BoatControl.RobotToCmdMoveAbsolute:=_200_Axis.BoatMovAbsEn AND _200_Axis.Run1;
- //原点回归
- _200_Axis.BoatControl.RobotToCmdHome:=_200_Axis.BoatHomeEn AND _200_Axis.Run1;
- //HOME保存
- IF _200_Axis.BoatHomePosEN THEN
- _200_Axis.BoatHomePos:=_200_Axis.BoatTPInputPos;
- _200_Axis.BoatData.Pos[1]:=_200_Axis.BoatHomePos;
- ELSE
- _200_Axis.BoatHomePos:=_200_Axis.BoatData.Pos[1];
- END_IF
- //MID保存
- IF _200_Axis.BoatMidPosEN THEN
- _200_Axis.BoatMidPos:=_200_Axis.BoatTPInputPos;
- _200_Axis.BoatData.Pos[2]:=_200_Axis.BoatMidPos;
- ELSE
- _200_Axis.BoatMidPos:=_200_Axis.BoatData.Pos[2];
- END_IF
- //CAP保存
- IF _200_Axis.BoatCapsPosEN THEN
- _200_Axis.BoatCapsPos:=_200_Axis.BoatTPInputPos;
- _200_Axis.BoatData.Pos[3]:=_200_Axis.BoatCapsPos;
- ELSE
- _200_Axis.BoatCapsPos:=_200_Axis.BoatData.Pos[3];
- END_IF
- //hmoe在位
- //mid在位
- //CAP在位
- //点动速度限制
- IF _200_Axis.BoatJogVel >10.0 THEN
- _200_Axis.BoatJogVel:=1;
- ELSIF _200_Axis.BoatJogVel <0.0 THEN
- _200_Axis.BoatJogVel:=1;
- END_IF
- //位置显示
- _200_Axis.BoatActPos:=_200_Axis.BoatAxisState.Pos;
- //速度显示
- _200_Axis.BoatActVel:=_200_Axis.BoatAxisState.vel;
- //转矩显示
- _200_Axis.TPBoatActTorque:=_200_Axis.BoatActTorque;
- //使能显示
- _200_Axis.BoatServoOn:=_200_Axis.BoatAxisState.Enabled;
- //运动中
- _200_Axis.BoatServoMoving:=_200_Axis.BoatAxisState.Busy;
- //异常显示
- _200_Axis.BoatServoAlarm:=_200_Axis.BoatAxisState.Error;
- //正极限显示
- //负极限显示
- //异常ID
- _200_Axis.BoatServoCode:=_200_Axis.BoatAxisState.ErrorID;
- //按钮互锁
- IF _200_Axis.HMINo=191 THEN
- IF _200_Axis.BoatHomeEn THEN
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatJogUPEn THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatJogDownEn THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatMovAbsEn THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatMoveRelEn THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatPosSoftLimitSaveEN THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatNegSoftLimitSaveEN THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatCapsPosEN THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatMidPosEN THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatHomePosEN THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatPosSoftLimitEN THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
- END_IF
- IF _200_Axis.BoatNegSoftLimitEN THEN
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- END_IF
- ELSE
- _200_Axis.BoatHomeEn:=0;
- _200_Axis.BoatJogUPEn:=0;
- _200_Axis.BoatJogDownEn:=0;
- _200_Axis.BoatMovAbsEn:=0;
- _200_Axis.BoatMoveRelEn:=0;
- _200_Axis.BoatPosSoftLimitSaveEN:=0;
- _200_Axis.BoatNegSoftLimitSaveEN:=0;
- _200_Axis.BoatCapsPosEN:=0;
- _200_Axis.BoatMidPosEN:=0;
- _200_Axis.BoatHomePosEN:=0;
- _200_Axis.BoatPosSoftLimitEN:=0;
- _200_Axis.BoatNegSoftLimitEN:=0;
-
- END_IF
-
-
-
-
-
-
-
-
-
-
- //--.03 Cap
- //Cap 使能
- _200_Axis.CapControl.RobotToAxisEnable:=_200_Axis.HMINo=191;
- //Cap JOG+
- _200_Axis.CapControl.TPToAxisJogForward:=_200_Axis.CapsJogFEn AND _200_Axis.Run1;
- //Cap JOG-
- _200_Axis.CapControl.TPToAxisJogBackwards:=_200_Axis.CapsJogBEn AND _200_Axis.Run1;
- //Cap JOG速度
- _200_Axis.CapData.Vel[31]:=_200_Axis.CapsJogVel;
- //原点传感器
- _200_Axis.CapControl.HomeSW:=NOT LAI.I503_01;
- //原点回归
- _200_Axis.CapControl.RobotToCmdHome:=_200_Axis.CapsHomeEn AND _200_Axis.Run1;
- //原点在位判断
-
- //位置显示
- _200_Axis.CapsActPos:=_200_Axis.CapAxisState.Pos;
- //速度显示
- _200_Axis.CapsActPos:=_200_Axis.CapAxisState.vel;
- //使能显示
- _200_Axis.CapsServoOnOK:=_200_Axis.CapAxisState.Enabled;
- //运动中
- _200_Axis.CapsServoMoving:=_200_Axis.CapAxisState.Busy;
- //异常显示
- _200_Axis.CapsServoAlarm:=_200_Axis.CapAxisState.Error;
- //正极限显示
-
- //负极限显示
-
- //异常ID
- _200_Axis.CapsServoCode:=_200_Axis.CapAxisState.ErrorID;
- //按钮互锁
- IF _200_Axis.HMINo=190 THEN
- IF _200_Axis.CapsHomeEn THEN
- _200_Axis.CapsJogFEn:=0;
- _200_Axis.CapsJogBEn:=0;
- _200_Axis.CapsServoOn:=0;
- END_IF
- IF _200_Axis.CapsJogFEn THEN
- _200_Axis.CapsHomeEn:=0;
- _200_Axis.CapsJogBEn:=0;
- _200_Axis.CapsServoOn:=0;
- END_IF
- IF _200_Axis.CapsJogBEn THEN
- _200_Axis.CapsHomeEn:=0;
- _200_Axis.CapsJogFEn:=0;
- _200_Axis.CapsServoOn:=0;
- END_IF
- IF _200_Axis.CapsServoOn THEN
- _200_Axis.CapsHomeEn:=0;
- _200_Axis.CapsJogFEn:=0;
- _200_Axis.CapsJogBEn:=0;
- END_IF
- ELSE
- _200_Axis.CapsHomeEn:=0;
- _200_Axis.CapsJogFEn:=0;
- _200_Axis.CapsJogBEn:=0;
- _200_Axis.CapsServoOn:=0;
-
- END_IF
- //点动速度限制
- IF _200_Axis.CapsJogVel >50.0 THEN
- _200_Axis.CapsJogVel:=1;
- ELSIF _200_Axis.CapsJogVel <0.0 THEN
- _200_Axis.CapsJogVel:=1;
- END_IF
- //02.Axis 基础参数设置(PC MODE)
- //03.Axis Error(轴异常报警)
-
- ]]></ST>
- </Implementation>
- <LineIds Name="MC_Axis">
- <LineId Id="73" Count="2" />
- <LineId Id="77" Count="0" />
- <LineId Id="80" Count="0" />
- <LineId Id="156" Count="0" />
- <LineId Id="81" Count="2" />
- <LineId Id="157" Count="0" />
- <LineId Id="104" Count="3" />
- <LineId Id="158" Count="0" />
- <LineId Id="108" Count="0" />
- <LineId Id="84" Count="0" />
- <LineId Id="118" Count="0" />
- <LineId Id="159" Count="0" />
- <LineId Id="128" Count="0" />
- <LineId Id="160" Count="0" />
- <LineId Id="142" Count="0" />
- <LineId Id="139" Count="0" />
- <LineId Id="161" Count="0" />
- <LineId Id="141" Count="0" />
- <LineId Id="162" Count="0" />
- <LineId Id="140" Count="0" />
- <LineId Id="163" Count="0" />
- <LineId Id="143" Count="0" />
- <LineId Id="185" Count="0" />
- <LineId Id="237" Count="0" />
- <LineId Id="187" Count="0" />
- <LineId Id="239" Count="0" />
- <LineId Id="208" Count="0" />
- <LineId Id="241" Count="0" />
- <LineId Id="181" Count="0" />
- <LineId Id="253" Count="0" />
- <LineId Id="275" Count="0" />
- <LineId Id="339" Count="0" />
- <LineId Id="336" Count="1" />
- <LineId Id="276" Count="0" />
- <LineId Id="274" Count="0" />
- <LineId Id="272" Count="1" />
- <LineId Id="193" Count="0" />
- <LineId Id="278" Count="1" />
- <LineId Id="341" Count="1" />
- <LineId Id="340" Count="0" />
- <LineId Id="277" Count="0" />
- <LineId Id="254" Count="0" />
- <LineId Id="194" Count="0" />
- <LineId Id="281" Count="1" />
- <LineId Id="344" Count="1" />
- <LineId Id="343" Count="0" />
- <LineId Id="280" Count="0" />
- <LineId Id="255" Count="0" />
- <LineId Id="195" Count="0" />
- <LineId Id="284" Count="1" />
- <LineId Id="347" Count="1" />
- <LineId Id="346" Count="0" />
- <LineId Id="283" Count="0" />
- <LineId Id="256" Count="0" />
- <LineId Id="196" Count="0" />
- <LineId Id="287" Count="1" />
- <LineId Id="350" Count="1" />
- <LineId Id="349" Count="0" />
- <LineId Id="286" Count="0" />
- <LineId Id="197" Count="0" />
- <LineId Id="290" Count="1" />
- <LineId Id="353" Count="1" />
- <LineId Id="352" Count="0" />
- <LineId Id="289" Count="0" />
- <LineId Id="198" Count="0" />
- <LineId Id="293" Count="1" />
- <LineId Id="356" Count="1" />
- <LineId Id="355" Count="0" />
- <LineId Id="292" Count="0" />
- <LineId Id="199" Count="0" />
- <LineId Id="296" Count="1" />
- <LineId Id="359" Count="1" />
- <LineId Id="358" Count="0" />
- <LineId Id="295" Count="0" />
- <LineId Id="200" Count="0" />
- <LineId Id="299" Count="1" />
- <LineId Id="362" Count="1" />
- <LineId Id="361" Count="0" />
- <LineId Id="298" Count="0" />
- <LineId Id="201" Count="0" />
- <LineId Id="302" Count="1" />
- <LineId Id="365" Count="1" />
- <LineId Id="364" Count="0" />
- <LineId Id="301" Count="0" />
- <LineId Id="202" Count="0" />
- <LineId Id="305" Count="1" />
- <LineId Id="368" Count="1" />
- <LineId Id="367" Count="0" />
- <LineId Id="304" Count="0" />
- <LineId Id="203" Count="0" />
- <LineId Id="308" Count="1" />
- <LineId Id="371" Count="1" />
- <LineId Id="370" Count="0" />
- <LineId Id="307" Count="0" />
- <LineId Id="204" Count="0" />
- <LineId Id="311" Count="1" />
- <LineId Id="374" Count="1" />
- <LineId Id="373" Count="0" />
- <LineId Id="310" Count="0" />
- <LineId Id="205" Count="0" />
- <LineId Id="314" Count="1" />
- <LineId Id="377" Count="1" />
- <LineId Id="376" Count="0" />
- <LineId Id="313" Count="0" />
- <LineId Id="206" Count="0" />
- <LineId Id="317" Count="1" />
- <LineId Id="380" Count="1" />
- <LineId Id="379" Count="0" />
- <LineId Id="316" Count="0" />
- <LineId Id="207" Count="0" />
- <LineId Id="320" Count="1" />
- <LineId Id="383" Count="1" />
- <LineId Id="382" Count="0" />
- <LineId Id="319" Count="0" />
- <LineId Id="323" Count="0" />
- <LineId Id="331" Count="1" />
- <LineId Id="386" Count="1" />
- <LineId Id="385" Count="0" />
- <LineId Id="330" Count="0" />
- <LineId Id="329" Count="0" />
- <LineId Id="334" Count="1" />
- <LineId Id="389" Count="1" />
- <LineId Id="388" Count="0" />
- <LineId Id="333" Count="0" />
- <LineId Id="324" Count="1" />
- <LineId Id="391" Count="0" />
- <LineId Id="393" Count="0" />
- <LineId Id="395" Count="0" />
- <LineId Id="392" Count="0" />
- <LineId Id="326" Count="2" />
- <LineId Id="182" Count="0" />
- <LineId Id="322" Count="0" />
- <LineId Id="209" Count="14" />
- <LineId Id="257" Count="2" />
- <LineId Id="179" Count="0" />
- <LineId Id="260" Count="11" />
- <LineId Id="478" Count="0" />
- <LineId Id="507" Count="0" />
- <LineId Id="479" Count="0" />
- <LineId Id="483" Count="4" />
- <LineId Id="489" Count="13" />
- <LineId Id="529" Count="18" />
- <LineId Id="503" Count="0" />
- <LineId Id="548" Count="18" />
- <LineId Id="504" Count="0" />
- <LineId Id="568" Count="18" />
- <LineId Id="567" Count="0" />
- <LineId Id="588" Count="18" />
- <LineId Id="587" Count="0" />
- <LineId Id="627" Count="18" />
- <LineId Id="607" Count="0" />
- <LineId Id="647" Count="18" />
- <LineId Id="646" Count="0" />
- <LineId Id="667" Count="18" />
- <LineId Id="666" Count="0" />
- <LineId Id="687" Count="18" />
- <LineId Id="686" Count="0" />
- <LineId Id="707" Count="18" />
- <LineId Id="706" Count="0" />
- <LineId Id="726" Count="18" />
- <LineId Id="505" Count="0" />
- <LineId Id="746" Count="18" />
- <LineId Id="745" Count="0" />
- <LineId Id="766" Count="18" />
- <LineId Id="765" Count="0" />
- <LineId Id="787" Count="18" />
- <LineId Id="786" Count="0" />
- <LineId Id="807" Count="18" />
- <LineId Id="806" Count="0" />
- <LineId Id="827" Count="18" />
- <LineId Id="826" Count="0" />
- <LineId Id="848" Count="18" />
- <LineId Id="847" Count="0" />
- <LineId Id="868" Count="18" />
- <LineId Id="867" Count="0" />
- <LineId Id="888" Count="18" />
- <LineId Id="887" Count="0" />
- <LineId Id="506" Count="0" />
- <LineId Id="528" Count="0" />
- <LineId Id="510" Count="16" />
- <LineId Id="508" Count="1" />
- <LineId Id="488" Count="0" />
- <LineId Id="482" Count="0" />
- <LineId Id="164" Count="0" />
- <LineId Id="145" Count="1" />
- <LineId Id="165" Count="0" />
- <LineId Id="147" Count="0" />
- <LineId Id="166" Count="0" />
- <LineId Id="148" Count="0" />
- <LineId Id="168" Count="0" />
- <LineId Id="144" Count="0" />
- <LineId Id="175" Count="3" />
- <LineId Id="224" Count="0" />
- <LineId Id="242" Count="0" />
- <LineId Id="225" Count="0" />
- <LineId Id="416" Count="4" />
- <LineId Id="405" Count="0" />
- <LineId Id="227" Count="0" />
- <LineId Id="422" Count="4" />
- <LineId Id="421" Count="0" />
- <LineId Id="228" Count="0" />
- <LineId Id="428" Count="4" />
- <LineId Id="427" Count="0" />
- <LineId Id="229" Count="2" />
- <LineId Id="410" Count="0" />
- <LineId Id="412" Count="3" />
- <LineId Id="411" Count="0" />
- <LineId Id="444" Count="14" />
- <LineId Id="433" Count="1" />
- <LineId Id="907" Count="1" />
- <LineId Id="914" Count="0" />
- <LineId Id="916" Count="2" />
- <LineId Id="920" Count="0" />
- <LineId Id="919" Count="0" />
- <LineId Id="921" Count="2" />
- <LineId Id="925" Count="0" />
- <LineId Id="924" Count="0" />
- <LineId Id="915" Count="0" />
- <LineId Id="939" Count="11" />
- <LineId Id="910" Count="0" />
- <LineId Id="952" Count="11" />
- <LineId Id="951" Count="0" />
- <LineId Id="965" Count="11" />
- <LineId Id="964" Count="0" />
- <LineId Id="978" Count="11" />
- <LineId Id="977" Count="0" />
- <LineId Id="991" Count="11" />
- <LineId Id="990" Count="0" />
- <LineId Id="1004" Count="11" />
- <LineId Id="1003" Count="0" />
- <LineId Id="1017" Count="11" />
- <LineId Id="1016" Count="0" />
- <LineId Id="1030" Count="11" />
- <LineId Id="1029" Count="0" />
- <LineId Id="1043" Count="11" />
- <LineId Id="1042" Count="0" />
- <LineId Id="1056" Count="11" />
- <LineId Id="1055" Count="0" />
- <LineId Id="1069" Count="11" />
- <LineId Id="1068" Count="0" />
- <LineId Id="911" Count="0" />
- <LineId Id="938" Count="0" />
- <LineId Id="928" Count="9" />
- <LineId Id="912" Count="1" />
- <LineId Id="909" Count="0" />
- <LineId Id="435" Count="8" />
- <LineId Id="226" Count="0" />
- <LineId Id="236" Count="0" />
- <LineId Id="150" Count="1" />
- <LineId Id="170" Count="0" />
- <LineId Id="152" Count="0" />
- <LineId Id="172" Count="0" />
- <LineId Id="153" Count="0" />
- <LineId Id="173" Count="0" />
- <LineId Id="149" Count="0" />
- <LineId Id="174" Count="0" />
- <LineId Id="192" Count="0" />
- <LineId Id="232" Count="0" />
- <LineId Id="243" Count="0" />
- <LineId Id="233" Count="0" />
- <LineId Id="459" Count="0" />
- <LineId Id="461" Count="3" />
- <LineId Id="467" Count="6" />
- <LineId Id="476" Count="0" />
- <LineId Id="474" Count="0" />
- <LineId Id="477" Count="0" />
- <LineId Id="475" Count="0" />
- <LineId Id="460" Count="0" />
- <LineId Id="188" Count="0" />
- <LineId Id="1081" Count="0" />
- <LineId Id="1086" Count="0" />
- <LineId Id="1090" Count="2" />
- <LineId Id="1087" Count="0" />
- <LineId Id="1099" Count="3" />
- <LineId Id="1088" Count="0" />
- <LineId Id="1104" Count="3" />
- <LineId Id="1103" Count="0" />
- <LineId Id="1109" Count="3" />
- <LineId Id="1108" Count="0" />
- <LineId Id="1098" Count="0" />
- <LineId Id="1094" Count="2" />
- <LineId Id="1084" Count="1" />
- <LineId Id="1083" Count="0" />
- <LineId Id="1113" Count="4" />
- <LineId Id="154" Count="0" />
- <LineId Id="234" Count="1" />
- <LineId Id="87" Count="7" />
- <LineId Id="55" Count="0" />
- <LineId Id="49" Count="0" />
- <LineId Id="56" Count="1" />
- <LineId Id="63" Count="0" />
- <LineId Id="65" Count="0" />
- </LineIds>
- </POU>
- </TcPlcObject>
|