error_04.56k

基于PMAC运动控制卡的八轴数控磨床PLC运动控制程序

;C:\Lynuc\CNC\PLC\address.h
;C:\Lynuc\CNC\PLC\y_home_11.pmc
;C:\Lynuc\CNC\PLC\oem.h
;C:\Lynuc\CNC\PLC\y_home_11.pmc
;C:\Lynuc\CNC\PLC\tsodick1.h
;C:\Lynuc\CNC\PLC\y_home_11.pmc
;C:\Lynuc\CNC\PLC\tsodick2.h
;C:\Lynuc\CNC\PLC\y_home_11.pmc
;C:\Lynuc\CNC\PLC\tsodick3.h
;C:\Lynuc\CNC\PLC\y_home_11.pmc
DELETE GATHER;23
DELETE TRACE;24
OPEN PLC 11 CLEAR;26
I7022=11;30
IF (M456 < 0);32
  I222=-100;33
ELSE;34
  I222=100;35
ENDIF;36
I51 = 0;37
IF (M381 = 0);41
  IF (I223 < 0);42
    CMD"#2 j^100000000";43
  ELSE;44
    CMD"#2 j^-100000000";45
  ENDIF;46
  ;47
  WHILE (M381 = 0);48
  ENDWHILE;49
  CMD"#2 j/";50
  ;51
  P733=2;52
  WHILE (P733 > 0);53
    P733=P733-1;54
  ENDWHILE;55
  WHILE ((M731&1) = 0) ;56
ENDWHILE;57
ENDIF;58
CMD"#2 hm";60
P733=2;63
WHILE (P733 > 0);64
  P733=P733-1;65
ENDWHILE;66
WHILE ((M731&$400) = 0) ;68
ENDWHILE;69
P733=5;72
WHILE (P733 > 0);73
  P733=P733-1;74
ENDWHILE;75
WHILE ((M731&$1) = 0) ;77
ENDWHILE;78
I51 = 1;84
M3 = M3 & (M3 ^ 262144);85
M3 = M3 & (M3 ^ 524288);86
DISABLE PLC 11;87
CLOSE;88
;C:\Lynuc\CNC\PLC\error_04.pmc
;C:\Lynuc\CNC\PLC\c_home_14.pmc
;C:\Lynuc\CNC\PLC\address.h
;C:\Lynuc\CNC\PLC\c_home_14.pmc
;C:\Lynuc\CNC\PLC\oem.h
;C:\Lynuc\CNC\PLC\c_home_14.pmc
;C:\Lynuc\CNC\PLC\tsodick1.h
;C:\Lynuc\CNC\PLC\c_home_14.pmc
;C:\Lynuc\CNC\PLC\tsodick2.h
;C:\Lynuc\CNC\PLC\c_home_14.pmc
;C:\Lynuc\CNC\PLC\tsodick3.h
;C:\Lynuc\CNC\PLC\c_home_14.pmc
DELETE GATHER;23
DELETE TRACE;24
OPEN PLC 14 CLEAR;26
I7112=11;30
IF (M456 < 0);31
  I522=-100;32
ELSE;33
  I522=100;34
ENDIF;35
I51 = 0;36
IF (M384 = 0);39
  IF (I523 < 0);40
    CMD"#5 j^10000000000";41
  ELSE;42
    CMD"#5 j^-10000000000";43
  ENDIF;44
  WHILE (M384 = 0);45
  ENDWHILE;46
  CMD"#5 j/";47
  ;48
  P733=2;49
  WHILE (P733 > 0);50
    P733=P733-1;51
  ENDWHILE;52
  WHILE ((M734&1) = 0) ;53
ENDWHILE;54
ENDIF;55
CMD"#5 hm";57
P733=2;60
WHILE (P733 > 0);61
  P733=P733-1;62
ENDWHILE;63
WHILE ((M734&$400) = 0) ;65
ENDWHILE;66
P733=5;69
WHILE (P733 > 0);70
  P733=P733-1;71
ENDWHILE;72
WHILE ((M734&$1) = 0) ;74
ENDWHILE;75
I51 = 1;79
M3 = M3 & (M3 ^ 262144);80
M3 = M3 & (M3 ^ 524288);81
DISABLE PLC 14;82
CLOSE;83
;C:\Lynuc\CNC\PLC\error_04.pmc
;C:\Lynuc\CNC\PLC\u_home_12.pmc
;C:\Lynuc\CNC\PLC\address.h
;C:\Lynuc\CNC\PLC\u_home_12.pmc
;C:\Lynuc\CNC\PLC\oem.h
;C:\Lynuc\CNC\PLC\u_home_12.pmc
;C:\Lynuc\CNC\PLC\tsodick1.h
;C:\Lynuc\CNC\PLC\u_home_12.pmc
;C:\Lynuc\CNC\PLC\tsodick2.h
;C:\Lynuc\CNC\PLC\u_home_12.pmc
;C:\Lynuc\CNC\PLC\tsodick3.h
;C:\Lynuc\CNC\PLC\u_home_12.pmc
DELETE GATHER;23
DELETE TRACE;24
OPEN PLC 12 CLEAR;26
I7032=11;30
IF (M456 < 0);31
  I322=-100;32
ELSE;33
  I322=100;34
ENDIF;35
I51 = 0;36
IF (M382 = 0);39
  IF (I323 < 0);40
    CMD"#3 j^1000000000";41
  ELSE;42
    CMD"#3 j^-1000000000";43
  ENDIF;44
  WHILE (M382 = 0);45
  ENDWHILE;46
  CMD"#3 j/";47
  ;48
  P733=2;49
  WHILE (P733 > 0);50
    P733=P733-1;51
  ENDWHILE;52
  WHILE ((M732&1) = 0) ;53
ENDWHILE;54
ENDIF;55
CMD"#3 hm";57
P733=2;60
WHILE (P733 > 0);61
  P733=P733-1;62
ENDWHILE;63
WHILE ((M732&$400) = 0) ;65
ENDWHILE;66
P733=5;69
WHILE (P733 > 0);70
  P733=P733-1;71
ENDWHILE;72
WHILE ((M732&$1) = 0) ;74
ENDWHILE;75
I51 = 1;77
M3 = M3 & (M3 ^ 262144);78
M3 = M3 & (M3 ^ 524288);79
DISABLE PLC 12;80
CLOSE;81
;C:\Lynuc\CNC\PLC\error_04.pmc
;C:\Lynuc\CNC\PLC\v_home_13.pmc
;C:\Lynuc\CNC\PLC\address.h
;C:\Lynuc\CNC\PLC\v_home_13.pmc
;C:\Lynuc\CNC\PLC\oem.h
;C:\Lynuc\CNC\PLC\v_home_13.pmc
;C:\Lynuc\CNC\PLC\tsodick1.h
;C:\Lynuc\CNC\PLC\v_home_13.pmc
;C:\Lynuc\CNC\PLC\tsodick2.h
;C:\Lynuc\CNC\PLC\v_home_13.pmc
;C:\Lynuc\CNC\PLC\tsodick3.h
;C:\Lynuc\CNC\PLC\v_home_13.pmc
DELETE GATHER;23
DELETE TRACE;24
OPEN PLC 13 CLEAR;26
I7042=11;30
IF (M456 < 0);31
  I422=-100;32
ELSE;33
  I422=100;34
ENDIF;35
I51 = 0;36
IF (M383 = 0);39
  IF (I423 < 0);40
    CMD"#4 j^1000000";41
  ELSE;42
    CMD"#4 j^-1000000";43
  ENDIF;44
  WHILE (M383 = 0);45
  ENDWHILE;46
  CMD"#4 j/";47
  ;48
  P733=2;49
  WHILE (P733 > 0);50
    P733=P733-1;51
  ENDWHILE;52
  WHILE ((M733&1) = 0) ;53
ENDWHILE;54
ENDIF;55
CMD"#4 hm";57
P733=2;60
WHILE (P733 > 0);61
  P733=P733-1;62
ENDWHILE;63
WHILE ((M733&$400) = 0) ;65
ENDWHILE;66
P733=5;69
WHILE (P733 > 0);70
  P733=P733-1;71
ENDWHILE;72
WHILE ((M733&$1) = 0) ;74
ENDWHILE;75
I51 = 1;77
M3 = M3 & (M3 ^ 262144);78
M3 = M3 & (M3 ^ 524288);79
DISABLE PLC 13;80
CLOSE;81
;C:\Lynuc\CNC\PLC\error_04.pmc
;C:\Lynuc\CNC\PLC\z_home_15.pmc
;C:\Lynuc\CNC\PLC\address.h
;C:\Lynuc\CNC\PLC\z_home_15.pmc
;C:\Lynuc\CNC\PLC\oem.h
;C:\Lynuc\CNC\PLC\z_home_15.pmc
;C:\Lynuc\CNC\PLC\tsodick1.h
;C:\Lynuc\CNC\PLC\z_home_15.pmc
;C:\Lynuc\CNC\PLC\tsodick2.h
;C:\Lynuc\CNC\PLC\z_home_15.pmc
;C:\Lynuc\CNC\PLC\tsodick3.h
;C:\Lynuc\CNC\PLC\z_home_15.pmc
DELETE GATHER;25
DELETE TRACE;26
OPEN PLC 15 CLEAR;28
I7122=1;32
IF (M456 < 0);34
  I622=-8.5;35
ELSE;36
  I622=8.5;37
ENDIF;38
I51 = 0;39
CMD"#6 hm";61
P733=2;65
WHILE (P733 > 0);66
  P733=P733-1;67
ENDWHILE;68
WHILE ((M735&$400) = 0) ;70
ENDWHILE;71
P733=5;74
WHILE (P733 > 0);75
  P733=P733-1;76
ENDWHILE;77
WHILE ((M735&$1) = 0) ;79
ENDWHILE;80
M1227=0;82
P1228=M1228/2;83
I51 = 1;84
M3 = M3 & (M3 ^ 262144);85
M3 = M3 & (M3 ^ 524288);86
DISABLE PLC 15;87
CLOSE;88
;C:\Lynuc\CNC\PLC\error_04.pmc
;C:\Lynuc\CNC\PLC\tofro_prog100.pmc
;C:\Lynuc\CNC\PLC\address.h
;C:\Lynuc\CNC\PLC\tofro_prog100.pmc
;C:\Lynuc\CNC\PLC\tsodick3.h
;C:\Lynuc\CNC\PLC\tofro_prog100.pmc
OPEN PROG 100 CLEAR;5
ABS;8
LIN;9
TA100;10
TS50;11
F200;12
Z(P1230);13
DWE0;14
CIR1;15
WHILE (P1033 = 1);19
  ;20
  TA(60*1000/P1032/2/5);21
  TS0;22
  F(P1031*3.1415926*P1032*2);23
  ;24
  Z(P1230) W0 I(-P1031/2);25
  Z(P1031+P1230) W0 I(P1031/2);26
ENDWHILE;27
CLOSE;29
;C:\Lynuc\CNC\PLC\error_04.pmc
;C:\Lynuc\CNC\PLC\grinder8a_g_mu.pmc
;C:\Lynuc\CNC\PLC\address.h
;C:\Lynuc\CNC\PLC\grinder8a_g_mu.pmc
;C:\Lynuc\CNC\PLC\oemm.h
;C:\Lynuc\CNC\PLC\grinder8a_g_mu.pmc
;C:\Lynuc\CNC\PLC\oem.h
;C:\Lynuc\CNC\PLC\grinder8a_g_mu.pmc
;C:\Lynuc\CNC\PLC\TSODICK3.H
;C:\Lynuc\CNC\PLC\grinder8a_g_mu.pmc
;C:\Lynuc\CNC\PLC\TSODICK1.H
;C:\Lynuc\CNC\PLC\grinder8a_g_mu.pmc
;C:\Lynuc\CNC\PLC\TSODICK2.H
;C:\Lynuc\CNC\PLC\grinder8a_g_mu.pmc
OPEN PROG 1000 CLEAR;30
M171 == 0;34
RAPID;39
RETURN;47
N1000;51
M171 == 1;52
LINEAR;56
RETURN;57
N2000;61
M171 == 2;62
CIR1;66
RETURN;67
N3000;70
M171 == 3;71
CIR2;75
RETURN;76
N4000;79
M170==4;80
READ(P,L);83
IF (Q100&$800 > 0);85
  WHILE (Q112 > 0.5);86
    DWELL(8000000);87
    Q112 = Q112 - 1.0;88
  ENDWHILE;89
ENDIF;90
IF (Q100&$8000 > 0);91
  IF (M2 & 16384 = 16384);92
    STOP;93
  ENDIF;94
    DWELL(Q116 * 1000.0);95
  IF (M171 = 0);96
    RAPID;97
  ENDIF;98
  IF (M171 = 2);99
    CIR1;100
  ENDIF;101
  IF (M171 = 3);102
    CIR2;103
  ENDIF;104
  ENDIF;105
  M170==0;106
  ;107
  ;108
  GOSUB 4;109
  ;110
  RETURN;111
  ;112
  ;113
  ;114
  N06000;115
  M170 = 6;116
  RETURN;117
  ;118
  ;119
  N08000;120
  RETURN;121
  ;122
  ;123
  N09000;124
  RETURN;125
  ;126
  ;127
  ;128
  N17000;129
  NORMAL K-1;130
  M172 = 17;131
  RETURN;132
  ;133
  ;134
  ;135
  ;136
  N20000;137
  M176 == 20;138
  ;139
  M5 == M5 & (M5 ^ 1048576);140
  RETURN;141
  ;142
  ;143
  N21000;144
  M176 == 21;145
  ;146
  M5 == M5 | 1048576;147
  RETURN;148
  ;149
  ;150
  ;151
  N20100;152
  M191 == 1020;153
  RETURN;154
  ;155
  ;156
  N21100;157
  M191 == 1021;158
  RETURN;159
  ;160
  ;161
  ;162
  N36000;163
  RETURN;164
  ;165
  ;166
  ;167
  N39000;168
  RETURN;169
  ;170
  ;171
  ;172
  N40000;173
  M177 = 40;174
  ;175
  ;176
  ;177
  ;178
  RETURN;179
  ;180
  ;181
  N41000;182
  M177 = 41;183
  ;184
  RETURN;185
  ;186
  ;187
  N42000;188
  M177 = 42;189
  ;190
  RETURN;191
  ;192
  ;193
  ;194
  N50000;195
  M181 = 50;196
  RETURN;197
  ;198
  ;199
  ;200
  N01000;201
  ;202
  M14 == M14 & (M14^256);203
  DWELL0;204
  M14 == M14 & (M14^512);205
  DWELL0;206
  M188 =  1050;207
  RETURN;208
  ;209
  ;210
  ;211
  N51100;212
  READ(A,B,C,X,Y,Z,U,V,W);213
  ;214
  IF (Q100&$800000 = $800000);215
    M14 == M14 | 256;216
    DWELL0;217
  ENDIF;218
  IF (Q100&$2000000 = $2000000);219
    M14 == M14 | 512;220
    DWELL0;221
  ENDIF;222
  M188 = 1051;223
  RETURN;224
  ;225
  ;226
  ;227
  ;228
  N51000;229
  READ(X,Y,Z,I,J,K,P);230
  M181 =  51;231
  RETURN;232
  ;233
  ;234
  ;235
  N52000;236
  READ(X,Y,Z,U,V,W,A,B,C);237
  M170 = 52;238
  Q201 = 0;239
  Q204 = 0;240
  Q207 = 0;241
  Q210 = 0;242
  Q213 = 0;243
  Q216 = 0;244
  Q219 = 0;245
  Q222 = 0;246
  Q225 = 0;247
  IF (Q100&$01 > 0);248
    Q201 = Q101;249
  ENDIF;250
  IF (Q100&$02 > 0);251
    Q204 = Q102;252
  ENDIF;253
  IF (Q100&$04 > 0);254
    Q207 = Q103;255
  ENDIF;256
  IF (Q100&$800000 > 0);257
    Q210 = Q124;258
  ENDIF;259
  IF (Q100&$1000000 > 0);260
    Q213 = Q125;261
  ENDIF;262
  IF (Q100&$2000000 > 0);263
    Q216 = Q126;264
  ENDIF;265
  IF (Q100&$100000 > 0);266
    Q219 = Q121;267
  ENDIF;268
  IF (Q100&$200000 > 0);269
    Q222 = Q122;270
  ENDIF;271
  IF (Q100&$400000 > 0);272
    Q225 = Q123;273
  ENDIF;274
  M118 = Q200 + Q201 + Q254;275
  M119 = Q203 + Q204 + Q255;276
  M120 = Q206 + Q207 + Q256;277
  M121 = Q209 + Q210 + Q257;278
  M122 = Q212 + Q213 + Q258;279
  M123 = Q215 + Q216 + Q259;280
  M124 = Q218 + Q219 + Q260;281
  M125 = Q221 + Q222 + Q261;282
  M126 = Q224 + Q225 + Q262;283
  RETURN;284
  ;285
  ;286
  ;287
  N53000;288
  M170 =  53;289
  RETURN;290
  ;291
  ;292
  ;293
  ;294
  ;295
  ;296
  ;297
  N54000;298
  READ(I,A,B,C,X,Y,Z,U,V,W);299
  GOSUB 54;300
  M184 =  54;301
  RETURN;302
  ;303
  ;304
  N55000;305
  READ(I,A,B,C,X,Y,Z,U,V,W);306
  GOSUB 54;307
  M184 =  55;308
  RETURN;309
  ;310
  ;311
  N56000;312
  READ(I,A,B,C,X,Y,Z,U,V,W);313
  GOSUB 54;314
  M184 =  56;315
  RETURN;316
  ;317
  ;318
  N57000;319
  READ(I,A,B,C,X,Y,Z,U,V,W);320
  GOSUB 54;321
  M184 =  57;322
  RETURN;323
  ;324
  ;325
  N58000;326
  READ(I,A,B,C,X,Y,Z,U,V,W);327
  GOSUB 54;328
  M184 =  58;329
  RETURN;330
  ;331
  ;332
  N59000;333
  READ(I,A,B,C,X,Y,Z,U,V,W);334
  GOSUB 54;335
  M184 =  59;336
  RETURN;337
  ;338
  ;339
  ;340
  ;341
  ;342
  N68000;343
  M186 = 68;344
  RETURN;345
  READ(X,Y,Z,U,V,W,R);346
  ;347
  ;348
  ;349
  ;350
  ;351
  IF (Q100&$800000 > 0);352
    M5 = M5 | 4194304;353
  ENDIF;354
  ;355
  IF (Q100&$1000000 > 0);356
    M5 = M5 | 4194304;357
  ENDIF;358
  ;359
  IF (Q100&$2000000 > 0);360
    M5 = M5 | 4194304;361
  ENDIF;362
  RETURN;363
  ;364
  ;365
  ;366
  ;367
  N69000;368
  M186 = 69;369
  RETURN;370
  M5 = M5 & (M5 ^ 4194304);371
  RETURN;372
  ;373
  ;374
  ;375
  N90000;376
  ABS;377
  M173 = 90;378