00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037 #ifdef _MSC_VER
00038 #include <winsock2.h>
00039 #endif
00040
00041 #include "xsvf.h"
00042 #include "host.h"
00043 #include "tapsm.h"
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00054
00055
00056
00057
00058
00059
00060
00061
00062
00063
00064
00065
00066
00067
00068 static int BitStringCmp(int len, u_char *op1, u_char *op2, u_char *mask)
00069 {
00070 int rc = 0;
00071
00072 #if !defined(_WIN32)
00073 int i;
00074 u_char diff;
00075
00076 for (i = 0; i < len; i += 8) {
00077 diff = *op1++ ^ *op2++;
00078 if (mask) {
00079 diff &= *mask++;
00080 }
00081 if (diff) {
00082 rc = 1;
00083 break;
00084 }
00085 }
00086 #endif
00087
00088 return rc;
00089 }
00090
00091
00092
00093
00094
00095
00096
00097
00098
00099 static void BitStringAdd(int len, u_char *op1, u_char *op2)
00100 {
00101 int i;
00102 u_short sum;
00103 u_char ovr = 0;
00104
00105 i = (int)((len + 7UL) / 8UL);
00106 while (i--) {
00107 if((sum = (u_short)((u_short)op1[i] + (u_short)op2[i] + ovr)) > (u_short)255) {
00108 ovr = 1;
00109 }
00110 else {
00111 ovr = 0;
00112 }
00113 op1[i] = (u_char)sum;
00114 }
00115 }
00116
00117
00118
00119
00120
00121
00122
00123
00124
00125 static int BitStringOnes(int len, u_char *op)
00126 {
00127 int rc = 0;
00128 u_char mask;
00129 int i = (int)((len + 7UL) / 8UL);
00130
00131 while (i--) {
00132 for(mask = op[i]; mask; mask >>= 1) {
00133 rc += mask & 1;
00134 }
00135 }
00136 return rc;
00137 }
00138
00139
00140
00141
00142
00143
00144
00145
00146
00147
00148
00149
00150
00151
00152
00153
00154
00155
00156 static void UpdateTdi(int len, u_char *tdi_val, int len2, u_char *tdi_val2, u_char *data_mask)
00157 {
00158 u_char tdibit;
00159 u_char mask;
00160 int i;
00161 u_char d = 0;
00162 u_char m = 0;
00163
00164 for (i = len - 1; i >= 0; --i) {
00165 mask = data_mask[i];
00166 if (mask) {
00167 tdibit = 1;
00168 while (mask) {
00169 if (mask & 1) {
00170 if (m == 0) {
00171 d = tdi_val2[--len2];
00172 m = 1;
00173 }
00174 if (d & m) {
00175 tdi_val[i] |= tdibit;
00176 } else {
00177 tdi_val[i] &= ~tdibit;
00178 }
00179 m <<= 1;
00180 }
00181 tdibit <<= 1;
00182 mask >>= 1;
00183 }
00184 }
00185 }
00186 }
00187
00188
00189
00190
00191
00192
00193
00194
00195
00196
00197
00198
00199
00200
00201
00202
00203
00204 static int ReShift(int len, u_char *tdi_val, u_char *tdo_exp, u_char *tdo_msk,
00205 u_char sState, u_char eState, long delay, u_char retries)
00206 {
00207 int rc = 0;
00208 u_char tdo_val[MAX_BITVEC_BYTES];
00209
00210 if (len == 0) {
00211 if (delay) {
00212 TapStateChange(RUN_TEST_IDLE);
00213 XsvfDelay(delay);
00214 }
00215 } else {
00216 int last_byte = (int)((len + 7UL) / 8UL - 1UL);
00217
00218
00219
00220
00221 do {
00222 u_char *tdi = &tdi_val[last_byte];
00223 u_char *tdo = &tdo_val[last_byte];
00224 int bitcnt;
00225 u_char bitmsk;
00226
00227 TapStateChange(sState);
00228
00229
00230
00231
00232 for(bitcnt = len; bitcnt;) {
00233 *tdo = 0;
00234
00235
00236
00237
00238 for (bitmsk = 1; bitmsk && bitcnt; bitmsk <<= 1) {
00239 if (sState != eState && bitcnt == 1) {
00240
00241 SET_TMS();
00242 TapStateInc();
00243 }
00244
00245
00246 if(*tdi & bitmsk) {
00247 SET_TDI();
00248 }
00249 else {
00250 CLR_TDI();
00251 }
00252 CLR_TCK();
00253
00254
00255
00256
00257
00258
00259 bitcnt--;
00260 if(GET_TDO()) {
00261 *tdo |= bitmsk;
00262 }
00263 SET_TCK();
00264 }
00265 tdi--;
00266 tdo--;
00267 }
00268
00269
00270
00271
00272 if (tdo_exp) {
00273 if(BitStringCmp(len, tdo_exp, tdo_val, tdo_msk)) {
00274 rc = XE_TDOMISMATCH;
00275 }
00276 else {
00277 rc = 0;
00278 }
00279 }
00280
00281
00282
00283
00284 if (sState != eState) {
00285 if (rc && delay && retries) {
00286
00287 TapStateChange(PAUSE_DR);
00288 TapStateChange(SHIFT_DR);
00289 } else {
00290 TapStateChange(eState);
00291 }
00292
00293
00294
00295
00296
00297 if (delay) {
00298 TapStateChange(RUN_TEST_IDLE);
00299 XsvfDelay(delay);
00300
00301 delay += (delay >> 2);
00302 }
00303 }
00304 } while (rc && retries--);
00305 }
00306 return rc;
00307 }
00308
00309
00310
00311
00312
00313
00314
00315
00316
00317
00318
00319
00320
00321
00322
00323
00324 static int Shift(int len, u_char *tdi_val, u_char *tdo_exp, u_char sState, u_char eState)
00325 {
00326 XsvfReadBitString(tdi_val, len);
00327 if(tdo_exp) {
00328 XsvfReadBitString(tdo_exp, len);
00329 }
00330 return ReShift(len, tdi_val, tdo_exp, 0, sState, eState, 0, 0);
00331 }
00332
00333
00334
00335
00336 static u_char tdiVal[MAX_BITVEC_BYTES];
00337
00338
00339
00340
00341 static u_char tdiVal2[MAX_BITVEC_BYTES];
00342
00343
00344
00345
00346 static u_char tdoExp[MAX_BITVEC_BYTES];
00347
00348
00349
00350
00351 static u_char tdoMask[MAX_BITVEC_BYTES];
00352
00353
00354
00355
00356 static u_char dataMask[MAX_BITVEC_BYTES];
00357
00358
00359
00360
00361 static u_char addrMask[MAX_BITVEC_BYTES];
00362
00363
00364
00365
00366
00367
00368
00369
00370
00371 static int Execute(void)
00372 {
00373 int rc = 0;
00374 u_char cmd;
00375 u_char endIr = RUN_TEST_IDLE;
00376 u_char endDr = RUN_TEST_IDLE;
00377 u_char retries = DEFAULT_REPEAT;
00378 long delay = 0;
00379 int drSize = 0;
00380 int drSize2 = 0;
00381 int irSize;
00382
00383 TapStateInit();
00384
00385
00386 while (rc == 0) {
00387 cmd = XsvfGetCmd();
00388
00389 if(cmd == XCOMPLETE) {
00390
00391
00392
00393 break;
00394 }
00395 switch(cmd) {
00396
00397 case XTDOMASK:
00398
00399
00400
00401 XsvfReadBitString(tdoMask, drSize);
00402 break;
00403
00404 case XRUNTEST:
00405
00406
00407
00408
00409 delay = XsvfGetLong();
00410 break;
00411
00412 case XREPEAT:
00413
00414
00415
00416
00417 retries = XsvfGetByte();
00418 break;
00419
00420 case XSDRSIZE:
00421
00422
00423
00424 drSize = (int)XsvfGetLong();
00425 if ((drSize + 7) / 8 > MAX_BITVEC_BYTES) {
00426 rc = XE_DATAOVERFLOW;
00427 }
00428 break;
00429
00430 case XSIR:
00431 case XSIR2:
00432
00433
00434
00435
00436 if(cmd == XSIR) {
00437 irSize = XsvfGetByte();
00438 }
00439 else {
00440 irSize = XsvfGetShort();
00441 }
00442 XsvfReadBitString(tdiVal, irSize);
00443 rc = ReShift(irSize, tdiVal, 0, 0, SHIFT_IR, endIr, delay, 0);
00444 break;
00445
00446 case XSDRTDO:
00447
00448
00449
00450
00451
00452
00453
00454 XsvfReadBitString(tdiVal, drSize);
00455 XsvfReadBitString(tdoExp, drSize);
00456 rc = ReShift(drSize, tdiVal, tdoExp, tdoMask, SHIFT_DR, endDr, delay, retries);
00457 break;
00458
00459 case XSDR:
00460
00461
00462
00463
00464
00465
00466 XsvfReadBitString(tdiVal, drSize);
00467 rc = ReShift(drSize, tdiVal, tdoExp, tdoMask, SHIFT_DR, endDr, delay, retries);
00468 break;
00469
00470 case XSDRB:
00471 case XSDRC:
00472
00473
00474
00475
00476 rc = Shift(drSize, tdiVal, 0, SHIFT_DR, SHIFT_DR);
00477 break;
00478
00479 case XSDRE:
00480
00481
00482
00483
00484
00485 rc = Shift(drSize, tdiVal, 0, SHIFT_DR, endDr);
00486 break;
00487
00488 case XSDRTDOB:
00489 case XSDRTDOC:
00490
00491
00492
00493
00494
00495 rc = Shift(drSize, tdiVal, tdoExp, SHIFT_DR, SHIFT_DR);
00496 break;
00497
00498 case XSDRTDOE:
00499
00500
00501
00502
00503
00504
00505 rc = Shift(drSize, tdiVal, tdoExp, SHIFT_DR, endDr);
00506 break;
00507
00508 case XSTATE:
00509
00510
00511
00512 rc = TapStateChange(XsvfGetState(TEST_LOGIC_RESET, RUN_TEST_IDLE));
00513 break;
00514
00515 case XENDIR:
00516
00517
00518
00519 endIr = XsvfGetState(RUN_TEST_IDLE, PAUSE_IR);
00520 break;
00521
00522 case XENDDR:
00523
00524
00525
00526 endDr = XsvfGetState(RUN_TEST_IDLE, PAUSE_DR);
00527 break;
00528
00529 case XSETSDRMASKS:
00530
00531
00532
00533 XsvfReadBitString(addrMask, drSize);
00534 XsvfReadBitString(dataMask, drSize);
00535 drSize2 = BitStringOnes(drSize, dataMask);
00536 break;
00537
00538 case XSDRINC:
00539
00540
00541
00542 XsvfReadBitString(tdiVal, drSize);
00543 rc = ReShift(drSize, tdiVal, tdoExp, tdoMask, SHIFT_DR, endDr, delay, retries);
00544 if (rc == 0) {
00545 int num = XsvfGetByte();
00546
00547 while(num-- && rc == 0) {
00548 XsvfReadBitString(tdiVal2, drSize2);
00549 BitStringAdd(drSize, tdiVal, addrMask);
00550 UpdateTdi(drSize, tdiVal, drSize2, tdiVal2, dataMask);
00551 rc = ReShift(drSize, tdiVal, tdoExp, tdoMask, SHIFT_DR, endDr, delay, retries);
00552 }
00553 }
00554 break;
00555
00556 case XCOMMENT:
00557
00558
00559
00560 XsvfSkipComment();
00561 break;
00562
00563 default:
00564 rc = XE_ILLEGALCMD;
00565 break;
00566 }
00567
00568
00569 if(rc == 0) {
00570 rc = XsvfGetError();
00571 }
00572 }
00573 return rc;
00574 }
00575
00576
00577
00578
00579
00580
00581 int main(void)
00582 {
00583 int rc;
00584
00585
00586 rc = XsvfInit();
00587
00588 if(rc == 0) {
00589
00590 rc = Execute();
00591 }
00592
00593
00594 XsvfExit(rc);
00595
00596 return rc;
00597 }
00598
00599