1 /* 2 * altera.c 3 * 4 * altera FPGA driver 5 * 6 * Copyright (C) Altera Corporation 1998-2001 7 * Copyright (C) 2010,2011 NetUP Inc. 8 * Copyright (C) 2010,2011 Igor M. Liplianin <liplianin@netup.ru> 9 * 10 * This program is free software; you can redistribute it and/or modify 11 * it under the terms of the GNU General Public License as published by 12 * the Free Software Foundation; either version 2 of the License, or 13 * (at your option) any later version. 14 * 15 * This program is distributed in the hope that it will be useful, 16 * but WITHOUT ANY WARRANTY; without even the implied warranty of 17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 18 * 19 * GNU General Public License for more details. 20 * 21 * You should have received a copy of the GNU General Public License 22 * along with this program; if not, write to the Free Software 23 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 24 */ 25 26 #include <asm/unaligned.h> 27 #include <linux/ctype.h> 28 #include <linux/string.h> 29 #include <linux/firmware.h> 30 #include <linux/slab.h> 31 #include <linux/module.h> 32 #include <misc/altera.h> 33 #include "altera-exprt.h" 34 #include "altera-jtag.h" 35 36 static int debug = 1; 37 module_param(debug, int, 0644); 38 MODULE_PARM_DESC(debug, "enable debugging information"); 39 40 MODULE_DESCRIPTION("altera FPGA kernel module"); 41 MODULE_AUTHOR("Igor M. Liplianin <liplianin@netup.ru>"); 42 MODULE_LICENSE("GPL"); 43 44 #define dprintk(args...) \ 45 if (debug) { \ 46 printk(KERN_DEBUG args); \ 47 } 48 49 enum altera_fpga_opcode { 50 OP_NOP = 0, 51 OP_DUP, 52 OP_SWP, 53 OP_ADD, 54 OP_SUB, 55 OP_MULT, 56 OP_DIV, 57 OP_MOD, 58 OP_SHL, 59 OP_SHR, 60 OP_NOT, 61 OP_AND, 62 OP_OR, 63 OP_XOR, 64 OP_INV, 65 OP_GT, 66 OP_LT, 67 OP_RET, 68 OP_CMPS, 69 OP_PINT, 70 OP_PRNT, 71 OP_DSS, 72 OP_DSSC, 73 OP_ISS, 74 OP_ISSC, 75 OP_DPR = 0x1c, 76 OP_DPRL, 77 OP_DPO, 78 OP_DPOL, 79 OP_IPR, 80 OP_IPRL, 81 OP_IPO, 82 OP_IPOL, 83 OP_PCHR, 84 OP_EXIT, 85 OP_EQU, 86 OP_POPT, 87 OP_ABS = 0x2c, 88 OP_BCH0, 89 OP_PSH0 = 0x2f, 90 OP_PSHL = 0x40, 91 OP_PSHV, 92 OP_JMP, 93 OP_CALL, 94 OP_NEXT, 95 OP_PSTR, 96 OP_SINT = 0x47, 97 OP_ST, 98 OP_ISTP, 99 OP_DSTP, 100 OP_SWPN, 101 OP_DUPN, 102 OP_POPV, 103 OP_POPE, 104 OP_POPA, 105 OP_JMPZ, 106 OP_DS, 107 OP_IS, 108 OP_DPRA, 109 OP_DPOA, 110 OP_IPRA, 111 OP_IPOA, 112 OP_EXPT, 113 OP_PSHE, 114 OP_PSHA, 115 OP_DYNA, 116 OP_EXPV = 0x5c, 117 OP_COPY = 0x80, 118 OP_REVA, 119 OP_DSC, 120 OP_ISC, 121 OP_WAIT, 122 OP_VS, 123 OP_CMPA = 0xc0, 124 OP_VSC, 125 }; 126 127 struct altera_procinfo { 128 char *name; 129 u8 attrs; 130 struct altera_procinfo *next; 131 }; 132 133 /* This function checks if enough parameters are available on the stack. */ 134 static int altera_check_stack(int stack_ptr, int count, int *status) 135 { 136 if (stack_ptr < count) { 137 *status = -EOVERFLOW; 138 return 0; 139 } 140 141 return 1; 142 } 143 144 static void altera_export_int(char *key, s32 value) 145 { 146 dprintk("Export: key = \"%s\", value = %d\n", key, value); 147 } 148 149 #define HEX_LINE_CHARS 72 150 #define HEX_LINE_BITS (HEX_LINE_CHARS * 4) 151 152 static void altera_export_bool_array(char *key, u8 *data, s32 count) 153 { 154 char string[HEX_LINE_CHARS + 1]; 155 s32 i, offset; 156 u32 size, line, lines, linebits, value, j, k; 157 158 if (count > HEX_LINE_BITS) { 159 dprintk("Export: key = \"%s\", %d bits, value = HEX\n", 160 key, count); 161 lines = (count + (HEX_LINE_BITS - 1)) / HEX_LINE_BITS; 162 163 for (line = 0; line < lines; ++line) { 164 if (line < (lines - 1)) { 165 linebits = HEX_LINE_BITS; 166 size = HEX_LINE_CHARS; 167 offset = count - ((line + 1) * HEX_LINE_BITS); 168 } else { 169 linebits = 170 count - ((lines - 1) * HEX_LINE_BITS); 171 size = (linebits + 3) / 4; 172 offset = 0L; 173 } 174 175 string[size] = '\0'; 176 j = size - 1; 177 value = 0; 178 179 for (k = 0; k < linebits; ++k) { 180 i = k + offset; 181 if (data[i >> 3] & (1 << (i & 7))) 182 value |= (1 << (i & 3)); 183 if ((i & 3) == 3) { 184 sprintf(&string[j], "%1x", value); 185 value = 0; 186 --j; 187 } 188 } 189 if ((k & 3) > 0) 190 sprintf(&string[j], "%1x", value); 191 192 dprintk("%s\n", string); 193 } 194 195 } else { 196 size = (count + 3) / 4; 197 string[size] = '\0'; 198 j = size - 1; 199 value = 0; 200 201 for (i = 0; i < count; ++i) { 202 if (data[i >> 3] & (1 << (i & 7))) 203 value |= (1 << (i & 3)); 204 if ((i & 3) == 3) { 205 sprintf(&string[j], "%1x", value); 206 value = 0; 207 --j; 208 } 209 } 210 if ((i & 3) > 0) 211 sprintf(&string[j], "%1x", value); 212 213 dprintk("Export: key = \"%s\", %d bits, value = HEX %s\n", 214 key, count, string); 215 } 216 } 217 218 static int altera_execute(struct altera_state *astate, 219 u8 *p, 220 s32 program_size, 221 s32 *error_address, 222 int *exit_code, 223 int *format_version) 224 { 225 struct altera_config *aconf = astate->config; 226 char *msg_buff = astate->msg_buff; 227 long *stack = astate->stack; 228 int status = 0; 229 u32 first_word = 0L; 230 u32 action_table = 0L; 231 u32 proc_table = 0L; 232 u32 str_table = 0L; 233 u32 sym_table = 0L; 234 u32 data_sect = 0L; 235 u32 code_sect = 0L; 236 u32 debug_sect = 0L; 237 u32 action_count = 0L; 238 u32 proc_count = 0L; 239 u32 sym_count = 0L; 240 long *vars = NULL; 241 s32 *var_size = NULL; 242 char *attrs = NULL; 243 u8 *proc_attributes = NULL; 244 u32 pc; 245 u32 opcode_address; 246 u32 args[3]; 247 u32 opcode; 248 u32 name_id; 249 u8 charbuf[4]; 250 long long_tmp; 251 u32 variable_id; 252 u8 *charptr_tmp; 253 u8 *charptr_tmp2; 254 long *longptr_tmp; 255 int version = 0; 256 int delta = 0; 257 int stack_ptr = 0; 258 u32 arg_count; 259 int done = 0; 260 int bad_opcode = 0; 261 u32 count; 262 u32 index; 263 u32 index2; 264 s32 long_count; 265 s32 long_idx; 266 s32 long_idx2; 267 u32 i; 268 u32 j; 269 u32 uncomp_size; 270 u32 offset; 271 u32 value; 272 int current_proc = 0; 273 int reverse; 274 275 char *name; 276 277 dprintk("%s\n", __func__); 278 279 /* Read header information */ 280 if (program_size > 52L) { 281 first_word = get_unaligned_be32(&p[0]); 282 version = (first_word & 1L); 283 *format_version = version + 1; 284 delta = version * 8; 285 286 action_table = get_unaligned_be32(&p[4]); 287 proc_table = get_unaligned_be32(&p[8]); 288 str_table = get_unaligned_be32(&p[4 + delta]); 289 sym_table = get_unaligned_be32(&p[16 + delta]); 290 data_sect = get_unaligned_be32(&p[20 + delta]); 291 code_sect = get_unaligned_be32(&p[24 + delta]); 292 debug_sect = get_unaligned_be32(&p[28 + delta]); 293 action_count = get_unaligned_be32(&p[40 + delta]); 294 proc_count = get_unaligned_be32(&p[44 + delta]); 295 sym_count = get_unaligned_be32(&p[48 + (2 * delta)]); 296 } 297 298 if ((first_word != 0x4A414D00L) && (first_word != 0x4A414D01L)) { 299 done = 1; 300 status = -EIO; 301 goto exit_done; 302 } 303 304 if (sym_count <= 0) 305 goto exit_done; 306 307 vars = kcalloc(sym_count, sizeof(long), GFP_KERNEL); 308 309 if (vars == NULL) 310 status = -ENOMEM; 311 312 if (status == 0) { 313 var_size = kcalloc(sym_count, sizeof(s32), GFP_KERNEL); 314 315 if (var_size == NULL) 316 status = -ENOMEM; 317 } 318 319 if (status == 0) { 320 attrs = kzalloc(sym_count, GFP_KERNEL); 321 322 if (attrs == NULL) 323 status = -ENOMEM; 324 } 325 326 if ((status == 0) && (version > 0)) { 327 proc_attributes = kzalloc(proc_count, GFP_KERNEL); 328 329 if (proc_attributes == NULL) 330 status = -ENOMEM; 331 } 332 333 if (status != 0) 334 goto exit_done; 335 336 delta = version * 2; 337 338 for (i = 0; i < sym_count; ++i) { 339 offset = (sym_table + ((11 + delta) * i)); 340 341 value = get_unaligned_be32(&p[offset + 3 + delta]); 342 343 attrs[i] = p[offset]; 344 345 /* 346 * use bit 7 of attribute byte to indicate that 347 * this buffer was dynamically allocated 348 * and should be freed later 349 */ 350 attrs[i] &= 0x7f; 351 352 var_size[i] = get_unaligned_be32(&p[offset + 7 + delta]); 353 354 /* 355 * Attribute bits: 356 * bit 0: 0 = read-only, 1 = read-write 357 * bit 1: 0 = not compressed, 1 = compressed 358 * bit 2: 0 = not initialized, 1 = initialized 359 * bit 3: 0 = scalar, 1 = array 360 * bit 4: 0 = Boolean, 1 = integer 361 * bit 5: 0 = declared variable, 362 * 1 = compiler created temporary variable 363 */ 364 365 if ((attrs[i] & 0x0c) == 0x04) 366 /* initialized scalar variable */ 367 vars[i] = value; 368 else if ((attrs[i] & 0x1e) == 0x0e) { 369 /* initialized compressed Boolean array */ 370 uncomp_size = get_unaligned_le32(&p[data_sect + value]); 371 372 /* allocate a buffer for the uncompressed data */ 373 vars[i] = (long)kzalloc(uncomp_size, GFP_KERNEL); 374 if (vars[i] == 0L) 375 status = -ENOMEM; 376 else { 377 /* set flag so buffer will be freed later */ 378 attrs[i] |= 0x80; 379 380 /* uncompress the data */ 381 if (altera_shrink(&p[data_sect + value], 382 var_size[i], 383 (u8 *)vars[i], 384 uncomp_size, 385 version) != uncomp_size) 386 /* decompression failed */ 387 status = -EIO; 388 else 389 var_size[i] = uncomp_size * 8L; 390 391 } 392 } else if ((attrs[i] & 0x1e) == 0x0c) { 393 /* initialized Boolean array */ 394 vars[i] = value + data_sect + (long)p; 395 } else if ((attrs[i] & 0x1c) == 0x1c) { 396 /* initialized integer array */ 397 vars[i] = value + data_sect; 398 } else if ((attrs[i] & 0x0c) == 0x08) { 399 /* uninitialized array */ 400 401 /* flag attrs so that memory is freed */ 402 attrs[i] |= 0x80; 403 404 if (var_size[i] > 0) { 405 u32 size; 406 407 if (attrs[i] & 0x10) 408 /* integer array */ 409 size = (var_size[i] * sizeof(s32)); 410 else 411 /* Boolean array */ 412 size = ((var_size[i] + 7L) / 8L); 413 414 vars[i] = (long)kzalloc(size, GFP_KERNEL); 415 416 if (vars[i] == 0) { 417 status = -ENOMEM; 418 } else { 419 /* zero out memory */ 420 for (j = 0; j < size; ++j) 421 ((u8 *)(vars[i]))[j] = 0; 422 423 } 424 } else 425 vars[i] = 0; 426 427 } else 428 vars[i] = 0; 429 430 } 431 432 exit_done: 433 if (status != 0) 434 done = 1; 435 436 altera_jinit(astate); 437 438 pc = code_sect; 439 msg_buff[0] = '\0'; 440 441 /* 442 * For JBC version 2, we will execute the procedures corresponding to 443 * the selected ACTION 444 */ 445 if (version > 0) { 446 if (aconf->action == NULL) { 447 status = -EINVAL; 448 done = 1; 449 } else { 450 int action_found = 0; 451 for (i = 0; (i < action_count) && !action_found; ++i) { 452 name_id = get_unaligned_be32(&p[action_table + 453 (12 * i)]); 454 455 name = &p[str_table + name_id]; 456 457 if (strncasecmp(aconf->action, name, strlen(name)) == 0) { 458 action_found = 1; 459 current_proc = 460 get_unaligned_be32(&p[action_table + 461 (12 * i) + 8]); 462 } 463 } 464 465 if (!action_found) { 466 status = -EINVAL; 467 done = 1; 468 } 469 } 470 471 if (status == 0) { 472 int first_time = 1; 473 i = current_proc; 474 while ((i != 0) || first_time) { 475 first_time = 0; 476 /* check procedure attribute byte */ 477 proc_attributes[i] = 478 (p[proc_table + 479 (13 * i) + 8] & 480 0x03); 481 482 /* 483 * BIT0 - OPTIONAL 484 * BIT1 - RECOMMENDED 485 * BIT6 - FORCED OFF 486 * BIT7 - FORCED ON 487 */ 488 489 i = get_unaligned_be32(&p[proc_table + 490 (13 * i) + 4]); 491 } 492 493 /* 494 * Set current_proc to the first procedure 495 * to be executed 496 */ 497 i = current_proc; 498 while ((i != 0) && 499 ((proc_attributes[i] == 1) || 500 ((proc_attributes[i] & 0xc0) == 0x40))) { 501 i = get_unaligned_be32(&p[proc_table + 502 (13 * i) + 4]); 503 } 504 505 if ((i != 0) || ((i == 0) && (current_proc == 0) && 506 ((proc_attributes[0] != 1) && 507 ((proc_attributes[0] & 0xc0) != 0x40)))) { 508 current_proc = i; 509 pc = code_sect + 510 get_unaligned_be32(&p[proc_table + 511 (13 * i) + 9]); 512 if ((pc < code_sect) || (pc >= debug_sect)) 513 status = -ERANGE; 514 } else 515 /* there are no procedures to execute! */ 516 done = 1; 517 518 } 519 } 520 521 msg_buff[0] = '\0'; 522 523 while (!done) { 524 opcode = (p[pc] & 0xff); 525 opcode_address = pc; 526 ++pc; 527 528 if (debug > 1) 529 printk("opcode: %02x\n", opcode); 530 531 arg_count = (opcode >> 6) & 3; 532 for (i = 0; i < arg_count; ++i) { 533 args[i] = get_unaligned_be32(&p[pc]); 534 pc += 4; 535 } 536 537 switch (opcode) { 538 case OP_NOP: 539 break; 540 case OP_DUP: 541 if (altera_check_stack(stack_ptr, 1, &status)) { 542 stack[stack_ptr] = stack[stack_ptr - 1]; 543 ++stack_ptr; 544 } 545 break; 546 case OP_SWP: 547 if (altera_check_stack(stack_ptr, 2, &status)) { 548 long_tmp = stack[stack_ptr - 2]; 549 stack[stack_ptr - 2] = stack[stack_ptr - 1]; 550 stack[stack_ptr - 1] = long_tmp; 551 } 552 break; 553 case OP_ADD: 554 if (altera_check_stack(stack_ptr, 2, &status)) { 555 --stack_ptr; 556 stack[stack_ptr - 1] += stack[stack_ptr]; 557 } 558 break; 559 case OP_SUB: 560 if (altera_check_stack(stack_ptr, 2, &status)) { 561 --stack_ptr; 562 stack[stack_ptr - 1] -= stack[stack_ptr]; 563 } 564 break; 565 case OP_MULT: 566 if (altera_check_stack(stack_ptr, 2, &status)) { 567 --stack_ptr; 568 stack[stack_ptr - 1] *= stack[stack_ptr]; 569 } 570 break; 571 case OP_DIV: 572 if (altera_check_stack(stack_ptr, 2, &status)) { 573 --stack_ptr; 574 stack[stack_ptr - 1] /= stack[stack_ptr]; 575 } 576 break; 577 case OP_MOD: 578 if (altera_check_stack(stack_ptr, 2, &status)) { 579 --stack_ptr; 580 stack[stack_ptr - 1] %= stack[stack_ptr]; 581 } 582 break; 583 case OP_SHL: 584 if (altera_check_stack(stack_ptr, 2, &status)) { 585 --stack_ptr; 586 stack[stack_ptr - 1] <<= stack[stack_ptr]; 587 } 588 break; 589 case OP_SHR: 590 if (altera_check_stack(stack_ptr, 2, &status)) { 591 --stack_ptr; 592 stack[stack_ptr - 1] >>= stack[stack_ptr]; 593 } 594 break; 595 case OP_NOT: 596 if (altera_check_stack(stack_ptr, 1, &status)) 597 stack[stack_ptr - 1] ^= (-1L); 598 599 break; 600 case OP_AND: 601 if (altera_check_stack(stack_ptr, 2, &status)) { 602 --stack_ptr; 603 stack[stack_ptr - 1] &= stack[stack_ptr]; 604 } 605 break; 606 case OP_OR: 607 if (altera_check_stack(stack_ptr, 2, &status)) { 608 --stack_ptr; 609 stack[stack_ptr - 1] |= stack[stack_ptr]; 610 } 611 break; 612 case OP_XOR: 613 if (altera_check_stack(stack_ptr, 2, &status)) { 614 --stack_ptr; 615 stack[stack_ptr - 1] ^= stack[stack_ptr]; 616 } 617 break; 618 case OP_INV: 619 if (!altera_check_stack(stack_ptr, 1, &status)) 620 break; 621 stack[stack_ptr - 1] = stack[stack_ptr - 1] ? 0L : 1L; 622 break; 623 case OP_GT: 624 if (!altera_check_stack(stack_ptr, 2, &status)) 625 break; 626 --stack_ptr; 627 stack[stack_ptr - 1] = 628 (stack[stack_ptr - 1] > stack[stack_ptr]) ? 629 1L : 0L; 630 631 break; 632 case OP_LT: 633 if (!altera_check_stack(stack_ptr, 2, &status)) 634 break; 635 --stack_ptr; 636 stack[stack_ptr - 1] = 637 (stack[stack_ptr - 1] < stack[stack_ptr]) ? 638 1L : 0L; 639 640 break; 641 case OP_RET: 642 if ((version > 0) && (stack_ptr == 0)) { 643 /* 644 * We completed one of the main procedures 645 * of an ACTION. 646 * Find the next procedure 647 * to be executed and jump to it. 648 * If there are no more procedures, then EXIT. 649 */ 650 i = get_unaligned_be32(&p[proc_table + 651 (13 * current_proc) + 4]); 652 while ((i != 0) && 653 ((proc_attributes[i] == 1) || 654 ((proc_attributes[i] & 0xc0) == 0x40))) 655 i = get_unaligned_be32(&p[proc_table + 656 (13 * i) + 4]); 657 658 if (i == 0) { 659 /* no procedures to execute! */ 660 done = 1; 661 *exit_code = 0; /* success */ 662 } else { 663 current_proc = i; 664 pc = code_sect + get_unaligned_be32( 665 &p[proc_table + 666 (13 * i) + 9]); 667 if ((pc < code_sect) || 668 (pc >= debug_sect)) 669 status = -ERANGE; 670 } 671 672 } else 673 if (altera_check_stack(stack_ptr, 1, &status)) { 674 pc = stack[--stack_ptr] + code_sect; 675 if ((pc <= code_sect) || 676 (pc >= debug_sect)) 677 status = -ERANGE; 678 679 } 680 681 break; 682 case OP_CMPS: 683 /* 684 * Array short compare 685 * ...stack 0 is source 1 value 686 * ...stack 1 is source 2 value 687 * ...stack 2 is mask value 688 * ...stack 3 is count 689 */ 690 if (altera_check_stack(stack_ptr, 4, &status)) { 691 s32 a = stack[--stack_ptr]; 692 s32 b = stack[--stack_ptr]; 693 long_tmp = stack[--stack_ptr]; 694 count = stack[stack_ptr - 1]; 695 696 if ((count < 1) || (count > 32)) 697 status = -ERANGE; 698 else { 699 long_tmp &= ((-1L) >> (32 - count)); 700 701 stack[stack_ptr - 1] = 702 ((a & long_tmp) == (b & long_tmp)) 703 ? 1L : 0L; 704 } 705 } 706 break; 707 case OP_PINT: 708 /* 709 * PRINT add integer 710 * ...stack 0 is integer value 711 */ 712 if (!altera_check_stack(stack_ptr, 1, &status)) 713 break; 714 sprintf(&msg_buff[strlen(msg_buff)], 715 "%ld", stack[--stack_ptr]); 716 break; 717 case OP_PRNT: 718 /* PRINT finish */ 719 if (debug) 720 printk(msg_buff, "\n"); 721 722 msg_buff[0] = '\0'; 723 break; 724 case OP_DSS: 725 /* 726 * DRSCAN short 727 * ...stack 0 is scan data 728 * ...stack 1 is count 729 */ 730 if (!altera_check_stack(stack_ptr, 2, &status)) 731 break; 732 long_tmp = stack[--stack_ptr]; 733 count = stack[--stack_ptr]; 734 put_unaligned_le32(long_tmp, &charbuf[0]); 735 status = altera_drscan(astate, count, charbuf, 0); 736 break; 737 case OP_DSSC: 738 /* 739 * DRSCAN short with capture 740 * ...stack 0 is scan data 741 * ...stack 1 is count 742 */ 743 if (!altera_check_stack(stack_ptr, 2, &status)) 744 break; 745 long_tmp = stack[--stack_ptr]; 746 count = stack[stack_ptr - 1]; 747 put_unaligned_le32(long_tmp, &charbuf[0]); 748 status = altera_swap_dr(astate, count, charbuf, 749 0, charbuf, 0); 750 stack[stack_ptr - 1] = get_unaligned_le32(&charbuf[0]); 751 break; 752 case OP_ISS: 753 /* 754 * IRSCAN short 755 * ...stack 0 is scan data 756 * ...stack 1 is count 757 */ 758 if (!altera_check_stack(stack_ptr, 2, &status)) 759 break; 760 long_tmp = stack[--stack_ptr]; 761 count = stack[--stack_ptr]; 762 put_unaligned_le32(long_tmp, &charbuf[0]); 763 status = altera_irscan(astate, count, charbuf, 0); 764 break; 765 case OP_ISSC: 766 /* 767 * IRSCAN short with capture 768 * ...stack 0 is scan data 769 * ...stack 1 is count 770 */ 771 if (!altera_check_stack(stack_ptr, 2, &status)) 772 break; 773 long_tmp = stack[--stack_ptr]; 774 count = stack[stack_ptr - 1]; 775 put_unaligned_le32(long_tmp, &charbuf[0]); 776 status = altera_swap_ir(astate, count, charbuf, 777 0, charbuf, 0); 778 stack[stack_ptr - 1] = get_unaligned_le32(&charbuf[0]); 779 break; 780 case OP_DPR: 781 if (!altera_check_stack(stack_ptr, 1, &status)) 782 break; 783 count = stack[--stack_ptr]; 784 status = altera_set_dr_pre(&astate->js, count, 0, NULL); 785 break; 786 case OP_DPRL: 787 /* 788 * DRPRE with literal data 789 * ...stack 0 is count 790 * ...stack 1 is literal data 791 */ 792 if (!altera_check_stack(stack_ptr, 2, &status)) 793 break; 794 count = stack[--stack_ptr]; 795 long_tmp = stack[--stack_ptr]; 796 put_unaligned_le32(long_tmp, &charbuf[0]); 797 status = altera_set_dr_pre(&astate->js, count, 0, 798 charbuf); 799 break; 800 case OP_DPO: 801 /* 802 * DRPOST 803 * ...stack 0 is count 804 */ 805 if (altera_check_stack(stack_ptr, 1, &status)) { 806 count = stack[--stack_ptr]; 807 status = altera_set_dr_post(&astate->js, count, 808 0, NULL); 809 } 810 break; 811 case OP_DPOL: 812 /* 813 * DRPOST with literal data 814 * ...stack 0 is count 815 * ...stack 1 is literal data 816 */ 817 if (!altera_check_stack(stack_ptr, 2, &status)) 818 break; 819 count = stack[--stack_ptr]; 820 long_tmp = stack[--stack_ptr]; 821 put_unaligned_le32(long_tmp, &charbuf[0]); 822 status = altera_set_dr_post(&astate->js, count, 0, 823 charbuf); 824 break; 825 case OP_IPR: 826 if (altera_check_stack(stack_ptr, 1, &status)) { 827 count = stack[--stack_ptr]; 828 status = altera_set_ir_pre(&astate->js, count, 829 0, NULL); 830 } 831 break; 832 case OP_IPRL: 833 /* 834 * IRPRE with literal data 835 * ...stack 0 is count 836 * ...stack 1 is literal data 837 */ 838 if (altera_check_stack(stack_ptr, 2, &status)) { 839 count = stack[--stack_ptr]; 840 long_tmp = stack[--stack_ptr]; 841 put_unaligned_le32(long_tmp, &charbuf[0]); 842 status = altera_set_ir_pre(&astate->js, count, 843 0, charbuf); 844 } 845 break; 846 case OP_IPO: 847 /* 848 * IRPOST 849 * ...stack 0 is count 850 */ 851 if (altera_check_stack(stack_ptr, 1, &status)) { 852 count = stack[--stack_ptr]; 853 status = altera_set_ir_post(&astate->js, count, 854 0, NULL); 855 } 856 break; 857 case OP_IPOL: 858 /* 859 * IRPOST with literal data 860 * ...stack 0 is count 861 * ...stack 1 is literal data 862 */ 863 if (!altera_check_stack(stack_ptr, 2, &status)) 864 break; 865 count = stack[--stack_ptr]; 866 long_tmp = stack[--stack_ptr]; 867 put_unaligned_le32(long_tmp, &charbuf[0]); 868 status = altera_set_ir_post(&astate->js, count, 0, 869 charbuf); 870 break; 871 case OP_PCHR: 872 if (altera_check_stack(stack_ptr, 1, &status)) { 873 u8 ch; 874 count = strlen(msg_buff); 875 ch = (char) stack[--stack_ptr]; 876 if ((ch < 1) || (ch > 127)) { 877 /* 878 * character code out of range 879 * instead of flagging an error, 880 * force the value to 127 881 */ 882 ch = 127; 883 } 884 msg_buff[count] = ch; 885 msg_buff[count + 1] = '\0'; 886 } 887 break; 888 case OP_EXIT: 889 if (altera_check_stack(stack_ptr, 1, &status)) 890 *exit_code = stack[--stack_ptr]; 891 892 done = 1; 893 break; 894 case OP_EQU: 895 if (!altera_check_stack(stack_ptr, 2, &status)) 896 break; 897 --stack_ptr; 898 stack[stack_ptr - 1] = 899 (stack[stack_ptr - 1] == stack[stack_ptr]) ? 900 1L : 0L; 901 break; 902 case OP_POPT: 903 if (altera_check_stack(stack_ptr, 1, &status)) 904 --stack_ptr; 905 906 break; 907 case OP_ABS: 908 if (!altera_check_stack(stack_ptr, 1, &status)) 909 break; 910 if (stack[stack_ptr - 1] < 0) 911 stack[stack_ptr - 1] = 0 - stack[stack_ptr - 1]; 912 913 break; 914 case OP_BCH0: 915 /* 916 * Batch operation 0 917 * SWP 918 * SWPN 7 919 * SWP 920 * SWPN 6 921 * DUPN 8 922 * SWPN 2 923 * SWP 924 * DUPN 6 925 * DUPN 6 926 */ 927 928 /* SWP */ 929 if (altera_check_stack(stack_ptr, 2, &status)) { 930 long_tmp = stack[stack_ptr - 2]; 931 stack[stack_ptr - 2] = stack[stack_ptr - 1]; 932 stack[stack_ptr - 1] = long_tmp; 933 } 934 935 /* SWPN 7 */ 936 index = 7 + 1; 937 if (altera_check_stack(stack_ptr, index, &status)) { 938 long_tmp = stack[stack_ptr - index]; 939 stack[stack_ptr - index] = stack[stack_ptr - 1]; 940 stack[stack_ptr - 1] = long_tmp; 941 } 942 943 /* SWP */ 944 if (altera_check_stack(stack_ptr, 2, &status)) { 945 long_tmp = stack[stack_ptr - 2]; 946 stack[stack_ptr - 2] = stack[stack_ptr - 1]; 947 stack[stack_ptr - 1] = long_tmp; 948 } 949 950 /* SWPN 6 */ 951 index = 6 + 1; 952 if (altera_check_stack(stack_ptr, index, &status)) { 953 long_tmp = stack[stack_ptr - index]; 954 stack[stack_ptr - index] = stack[stack_ptr - 1]; 955 stack[stack_ptr - 1] = long_tmp; 956 } 957 958 /* DUPN 8 */ 959 index = 8 + 1; 960 if (altera_check_stack(stack_ptr, index, &status)) { 961 stack[stack_ptr] = stack[stack_ptr - index]; 962 ++stack_ptr; 963 } 964 965 /* SWPN 2 */ 966 index = 2 + 1; 967 if (altera_check_stack(stack_ptr, index, &status)) { 968 long_tmp = stack[stack_ptr - index]; 969 stack[stack_ptr - index] = stack[stack_ptr - 1]; 970 stack[stack_ptr - 1] = long_tmp; 971 } 972 973 /* SWP */ 974 if (altera_check_stack(stack_ptr, 2, &status)) { 975 long_tmp = stack[stack_ptr - 2]; 976 stack[stack_ptr - 2] = stack[stack_ptr - 1]; 977 stack[stack_ptr - 1] = long_tmp; 978 } 979 980 /* DUPN 6 */ 981 index = 6 + 1; 982 if (altera_check_stack(stack_ptr, index, &status)) { 983 stack[stack_ptr] = stack[stack_ptr - index]; 984 ++stack_ptr; 985 } 986 987 /* DUPN 6 */ 988 index = 6 + 1; 989 if (altera_check_stack(stack_ptr, index, &status)) { 990 stack[stack_ptr] = stack[stack_ptr - index]; 991 ++stack_ptr; 992 } 993 break; 994 case OP_PSH0: 995 stack[stack_ptr++] = 0; 996 break; 997 case OP_PSHL: 998 stack[stack_ptr++] = (s32) args[0]; 999 break; 1000 case OP_PSHV: 1001 stack[stack_ptr++] = vars[args[0]]; 1002 break; 1003 case OP_JMP: 1004 pc = args[0] + code_sect; 1005 if ((pc < code_sect) || (pc >= debug_sect)) 1006 status = -ERANGE; 1007 break; 1008 case OP_CALL: 1009 stack[stack_ptr++] = pc; 1010 pc = args[0] + code_sect; 1011 if ((pc < code_sect) || (pc >= debug_sect)) 1012 status = -ERANGE; 1013 break; 1014 case OP_NEXT: 1015 /* 1016 * Process FOR / NEXT loop 1017 * ...argument 0 is variable ID 1018 * ...stack 0 is step value 1019 * ...stack 1 is end value 1020 * ...stack 2 is top address 1021 */ 1022 if (altera_check_stack(stack_ptr, 3, &status)) { 1023 s32 step = stack[stack_ptr - 1]; 1024 s32 end = stack[stack_ptr - 2]; 1025 s32 top = stack[stack_ptr - 3]; 1026 s32 iterator = vars[args[0]]; 1027 int break_out = 0; 1028 1029 if (step < 0) { 1030 if (iterator <= end) 1031 break_out = 1; 1032 } else if (iterator >= end) 1033 break_out = 1; 1034 1035 if (break_out) { 1036 stack_ptr -= 3; 1037 } else { 1038 vars[args[0]] = iterator + step; 1039 pc = top + code_sect; 1040 if ((pc < code_sect) || 1041 (pc >= debug_sect)) 1042 status = -ERANGE; 1043 } 1044 } 1045 break; 1046 case OP_PSTR: 1047 /* 1048 * PRINT add string 1049 * ...argument 0 is string ID 1050 */ 1051 count = strlen(msg_buff); 1052 strlcpy(&msg_buff[count], 1053 &p[str_table + args[0]], 1054 ALTERA_MESSAGE_LENGTH - count); 1055 break; 1056 case OP_SINT: 1057 /* 1058 * STATE intermediate state 1059 * ...argument 0 is state code 1060 */ 1061 status = altera_goto_jstate(astate, args[0]); 1062 break; 1063 case OP_ST: 1064 /* 1065 * STATE final state 1066 * ...argument 0 is state code 1067 */ 1068 status = altera_goto_jstate(astate, args[0]); 1069 break; 1070 case OP_ISTP: 1071 /* 1072 * IRSTOP state 1073 * ...argument 0 is state code 1074 */ 1075 status = altera_set_irstop(&astate->js, args[0]); 1076 break; 1077 case OP_DSTP: 1078 /* 1079 * DRSTOP state 1080 * ...argument 0 is state code 1081 */ 1082 status = altera_set_drstop(&astate->js, args[0]); 1083 break; 1084 1085 case OP_SWPN: 1086 /* 1087 * Exchange top with Nth stack value 1088 * ...argument 0 is 0-based stack entry 1089 * to swap with top element 1090 */ 1091 index = (args[0]) + 1; 1092 if (altera_check_stack(stack_ptr, index, &status)) { 1093 long_tmp = stack[stack_ptr - index]; 1094 stack[stack_ptr - index] = stack[stack_ptr - 1]; 1095 stack[stack_ptr - 1] = long_tmp; 1096 } 1097 break; 1098 case OP_DUPN: 1099 /* 1100 * Duplicate Nth stack value 1101 * ...argument 0 is 0-based stack entry to duplicate 1102 */ 1103 index = (args[0]) + 1; 1104 if (altera_check_stack(stack_ptr, index, &status)) { 1105 stack[stack_ptr] = stack[stack_ptr - index]; 1106 ++stack_ptr; 1107 } 1108 break; 1109 case OP_POPV: 1110 /* 1111 * Pop stack into scalar variable 1112 * ...argument 0 is variable ID 1113 * ...stack 0 is value 1114 */ 1115 if (altera_check_stack(stack_ptr, 1, &status)) 1116 vars[args[0]] = stack[--stack_ptr]; 1117 1118 break; 1119 case OP_POPE: 1120 /* 1121 * Pop stack into integer array element 1122 * ...argument 0 is variable ID 1123 * ...stack 0 is array index 1124 * ...stack 1 is value 1125 */ 1126 if (!altera_check_stack(stack_ptr, 2, &status)) 1127 break; 1128 variable_id = args[0]; 1129 1130 /* 1131 * If variable is read-only, 1132 * convert to writable array 1133 */ 1134 if ((version > 0) && 1135 ((attrs[variable_id] & 0x9c) == 0x1c)) { 1136 /* Allocate a writable buffer for this array */ 1137 count = var_size[variable_id]; 1138 long_tmp = vars[variable_id]; 1139 longptr_tmp = kcalloc(count, sizeof(long), 1140 GFP_KERNEL); 1141 vars[variable_id] = (long)longptr_tmp; 1142 1143 if (vars[variable_id] == 0) { 1144 status = -ENOMEM; 1145 break; 1146 } 1147 1148 /* copy previous contents into buffer */ 1149 for (i = 0; i < count; ++i) { 1150 longptr_tmp[i] = 1151 get_unaligned_be32(&p[long_tmp]); 1152 long_tmp += sizeof(long); 1153 } 1154 1155 /* 1156 * set bit 7 - buffer was 1157 * dynamically allocated 1158 */ 1159 attrs[variable_id] |= 0x80; 1160 1161 /* clear bit 2 - variable is writable */ 1162 attrs[variable_id] &= ~0x04; 1163 attrs[variable_id] |= 0x01; 1164 1165 } 1166 1167 /* check that variable is a writable integer array */ 1168 if ((attrs[variable_id] & 0x1c) != 0x18) 1169 status = -ERANGE; 1170 else { 1171 longptr_tmp = (long *)vars[variable_id]; 1172 1173 /* pop the array index */ 1174 index = stack[--stack_ptr]; 1175 1176 /* pop the value and store it into the array */ 1177 longptr_tmp[index] = stack[--stack_ptr]; 1178 } 1179 1180 break; 1181 case OP_POPA: 1182 /* 1183 * Pop stack into Boolean array 1184 * ...argument 0 is variable ID 1185 * ...stack 0 is count 1186 * ...stack 1 is array index 1187 * ...stack 2 is value 1188 */ 1189 if (!altera_check_stack(stack_ptr, 3, &status)) 1190 break; 1191 variable_id = args[0]; 1192 1193 /* 1194 * If variable is read-only, 1195 * convert to writable array 1196 */ 1197 if ((version > 0) && 1198 ((attrs[variable_id] & 0x9c) == 0x0c)) { 1199 /* Allocate a writable buffer for this array */ 1200 long_tmp = 1201 (var_size[variable_id] + 7L) >> 3L; 1202 charptr_tmp2 = (u8 *)vars[variable_id]; 1203 charptr_tmp = 1204 kzalloc(long_tmp, GFP_KERNEL); 1205 vars[variable_id] = (long)charptr_tmp; 1206 1207 if (vars[variable_id] == 0) { 1208 status = -ENOMEM; 1209 break; 1210 } 1211 1212 /* zero the buffer */ 1213 for (long_idx = 0L; 1214 long_idx < long_tmp; 1215 ++long_idx) { 1216 charptr_tmp[long_idx] = 0; 1217 } 1218 1219 /* copy previous contents into buffer */ 1220 for (long_idx = 0L; 1221 long_idx < var_size[variable_id]; 1222 ++long_idx) { 1223 long_idx2 = long_idx; 1224 1225 if (charptr_tmp2[long_idx2 >> 3] & 1226 (1 << (long_idx2 & 7))) { 1227 charptr_tmp[long_idx >> 3] |= 1228 (1 << (long_idx & 7)); 1229 } 1230 } 1231 1232 /* 1233 * set bit 7 - buffer was 1234 * dynamically allocated 1235 */ 1236 attrs[variable_id] |= 0x80; 1237 1238 /* clear bit 2 - variable is writable */ 1239 attrs[variable_id] &= ~0x04; 1240 attrs[variable_id] |= 0x01; 1241 1242 } 1243 1244 /* 1245 * check that variable is 1246 * a writable Boolean array 1247 */ 1248 if ((attrs[variable_id] & 0x1c) != 0x08) { 1249 status = -ERANGE; 1250 break; 1251 } 1252 1253 charptr_tmp = (u8 *)vars[variable_id]; 1254 1255 /* pop the count (number of bits to copy) */ 1256 long_count = stack[--stack_ptr]; 1257 1258 /* pop the array index */ 1259 long_idx = stack[--stack_ptr]; 1260 1261 reverse = 0; 1262 1263 if (version > 0) { 1264 /* 1265 * stack 0 = array right index 1266 * stack 1 = array left index 1267 */ 1268 1269 if (long_idx > long_count) { 1270 reverse = 1; 1271 long_tmp = long_count; 1272 long_count = 1 + long_idx - 1273 long_count; 1274 long_idx = long_tmp; 1275 1276 /* reverse POPA is not supported */ 1277 status = -ERANGE; 1278 break; 1279 } else 1280 long_count = 1 + long_count - 1281 long_idx; 1282 1283 } 1284 1285 /* pop the data */ 1286 long_tmp = stack[--stack_ptr]; 1287 1288 if (long_count < 1) { 1289 status = -ERANGE; 1290 break; 1291 } 1292 1293 for (i = 0; i < long_count; ++i) { 1294 if (long_tmp & (1L << (s32) i)) 1295 charptr_tmp[long_idx >> 3L] |= 1296 (1L << (long_idx & 7L)); 1297 else 1298 charptr_tmp[long_idx >> 3L] &= 1299 ~(1L << (long_idx & 7L)); 1300 1301 ++long_idx; 1302 } 1303 1304 break; 1305 case OP_JMPZ: 1306 /* 1307 * Pop stack and branch if zero 1308 * ...argument 0 is address 1309 * ...stack 0 is condition value 1310 */ 1311 if (altera_check_stack(stack_ptr, 1, &status)) { 1312 if (stack[--stack_ptr] == 0) { 1313 pc = args[0] + code_sect; 1314 if ((pc < code_sect) || 1315 (pc >= debug_sect)) 1316 status = -ERANGE; 1317 } 1318 } 1319 break; 1320 case OP_DS: 1321 case OP_IS: 1322 /* 1323 * DRSCAN 1324 * IRSCAN 1325 * ...argument 0 is scan data variable ID 1326 * ...stack 0 is array index 1327 * ...stack 1 is count 1328 */ 1329 if (!altera_check_stack(stack_ptr, 2, &status)) 1330 break; 1331 long_idx = stack[--stack_ptr]; 1332 long_count = stack[--stack_ptr]; 1333 reverse = 0; 1334 if (version > 0) { 1335 /* 1336 * stack 0 = array right index 1337 * stack 1 = array left index 1338 * stack 2 = count 1339 */ 1340 long_tmp = long_count; 1341 long_count = stack[--stack_ptr]; 1342 1343 if (long_idx > long_tmp) { 1344 reverse = 1; 1345 long_idx = long_tmp; 1346 } 1347 } 1348 1349 charptr_tmp = (u8 *)vars[args[0]]; 1350 1351 if (reverse) { 1352 /* 1353 * allocate a buffer 1354 * and reverse the data order 1355 */ 1356 charptr_tmp2 = charptr_tmp; 1357 charptr_tmp = kzalloc((long_count >> 3) + 1, 1358 GFP_KERNEL); 1359 if (charptr_tmp == NULL) { 1360 status = -ENOMEM; 1361 break; 1362 } 1363 1364 long_tmp = long_idx + long_count - 1; 1365 long_idx2 = 0; 1366 while (long_idx2 < long_count) { 1367 if (charptr_tmp2[long_tmp >> 3] & 1368 (1 << (long_tmp & 7))) 1369 charptr_tmp[long_idx2 >> 3] |= 1370 (1 << (long_idx2 & 7)); 1371 else 1372 charptr_tmp[long_idx2 >> 3] &= 1373 ~(1 << (long_idx2 & 7)); 1374 1375 --long_tmp; 1376 ++long_idx2; 1377 } 1378 } 1379 1380 if (opcode == 0x51) /* DS */ 1381 status = altera_drscan(astate, long_count, 1382 charptr_tmp, long_idx); 1383 else /* IS */ 1384 status = altera_irscan(astate, long_count, 1385 charptr_tmp, long_idx); 1386 1387 if (reverse) 1388 kfree(charptr_tmp); 1389 1390 break; 1391 case OP_DPRA: 1392 /* 1393 * DRPRE with array data 1394 * ...argument 0 is variable ID 1395 * ...stack 0 is array index 1396 * ...stack 1 is count 1397 */ 1398 if (!altera_check_stack(stack_ptr, 2, &status)) 1399 break; 1400 index = stack[--stack_ptr]; 1401 count = stack[--stack_ptr]; 1402 1403 if (version > 0) 1404 /* 1405 * stack 0 = array right index 1406 * stack 1 = array left index 1407 */ 1408 count = 1 + count - index; 1409 1410 charptr_tmp = (u8 *)vars[args[0]]; 1411 status = altera_set_dr_pre(&astate->js, count, index, 1412 charptr_tmp); 1413 break; 1414 case OP_DPOA: 1415 /* 1416 * DRPOST with array data 1417 * ...argument 0 is variable ID 1418 * ...stack 0 is array index 1419 * ...stack 1 is count 1420 */ 1421 if (!altera_check_stack(stack_ptr, 2, &status)) 1422 break; 1423 index = stack[--stack_ptr]; 1424 count = stack[--stack_ptr]; 1425 1426 if (version > 0) 1427 /* 1428 * stack 0 = array right index 1429 * stack 1 = array left index 1430 */ 1431 count = 1 + count - index; 1432 1433 charptr_tmp = (u8 *)vars[args[0]]; 1434 status = altera_set_dr_post(&astate->js, count, index, 1435 charptr_tmp); 1436 break; 1437 case OP_IPRA: 1438 /* 1439 * IRPRE with array data 1440 * ...argument 0 is variable ID 1441 * ...stack 0 is array index 1442 * ...stack 1 is count 1443 */ 1444 if (!altera_check_stack(stack_ptr, 2, &status)) 1445 break; 1446 index = stack[--stack_ptr]; 1447 count = stack[--stack_ptr]; 1448 1449 if (version > 0) 1450 /* 1451 * stack 0 = array right index 1452 * stack 1 = array left index 1453 */ 1454 count = 1 + count - index; 1455 1456 charptr_tmp = (u8 *)vars[args[0]]; 1457 status = altera_set_ir_pre(&astate->js, count, index, 1458 charptr_tmp); 1459 1460 break; 1461 case OP_IPOA: 1462 /* 1463 * IRPOST with array data 1464 * ...argument 0 is variable ID 1465 * ...stack 0 is array index 1466 * ...stack 1 is count 1467 */ 1468 if (!altera_check_stack(stack_ptr, 2, &status)) 1469 break; 1470 index = stack[--stack_ptr]; 1471 count = stack[--stack_ptr]; 1472 1473 if (version > 0) 1474 /* 1475 * stack 0 = array right index 1476 * stack 1 = array left index 1477 */ 1478 count = 1 + count - index; 1479 1480 charptr_tmp = (u8 *)vars[args[0]]; 1481 status = altera_set_ir_post(&astate->js, count, index, 1482 charptr_tmp); 1483 1484 break; 1485 case OP_EXPT: 1486 /* 1487 * EXPORT 1488 * ...argument 0 is string ID 1489 * ...stack 0 is integer expression 1490 */ 1491 if (altera_check_stack(stack_ptr, 1, &status)) { 1492 name = &p[str_table + args[0]]; 1493 long_tmp = stack[--stack_ptr]; 1494 altera_export_int(name, long_tmp); 1495 } 1496 break; 1497 case OP_PSHE: 1498 /* 1499 * Push integer array element 1500 * ...argument 0 is variable ID 1501 * ...stack 0 is array index 1502 */ 1503 if (!altera_check_stack(stack_ptr, 1, &status)) 1504 break; 1505 variable_id = args[0]; 1506 index = stack[stack_ptr - 1]; 1507 1508 /* check variable type */ 1509 if ((attrs[variable_id] & 0x1f) == 0x19) { 1510 /* writable integer array */ 1511 longptr_tmp = (long *)vars[variable_id]; 1512 stack[stack_ptr - 1] = longptr_tmp[index]; 1513 } else if ((attrs[variable_id] & 0x1f) == 0x1c) { 1514 /* read-only integer array */ 1515 long_tmp = vars[variable_id] + 1516 (index * sizeof(long)); 1517 stack[stack_ptr - 1] = 1518 get_unaligned_be32(&p[long_tmp]); 1519 } else 1520 status = -ERANGE; 1521 1522 break; 1523 case OP_PSHA: 1524 /* 1525 * Push Boolean array 1526 * ...argument 0 is variable ID 1527 * ...stack 0 is count 1528 * ...stack 1 is array index 1529 */ 1530 if (!altera_check_stack(stack_ptr, 2, &status)) 1531 break; 1532 variable_id = args[0]; 1533 1534 /* check that variable is a Boolean array */ 1535 if ((attrs[variable_id] & 0x18) != 0x08) { 1536 status = -ERANGE; 1537 break; 1538 } 1539 1540 charptr_tmp = (u8 *)vars[variable_id]; 1541 1542 /* pop the count (number of bits to copy) */ 1543 count = stack[--stack_ptr]; 1544 1545 /* pop the array index */ 1546 index = stack[stack_ptr - 1]; 1547 1548 if (version > 0) 1549 /* 1550 * stack 0 = array right index 1551 * stack 1 = array left index 1552 */ 1553 count = 1 + count - index; 1554 1555 if ((count < 1) || (count > 32)) { 1556 status = -ERANGE; 1557 break; 1558 } 1559 1560 long_tmp = 0L; 1561 1562 for (i = 0; i < count; ++i) 1563 if (charptr_tmp[(i + index) >> 3] & 1564 (1 << ((i + index) & 7))) 1565 long_tmp |= (1L << i); 1566 1567 stack[stack_ptr - 1] = long_tmp; 1568 1569 break; 1570 case OP_DYNA: 1571 /* 1572 * Dynamically change size of array 1573 * ...argument 0 is variable ID 1574 * ...stack 0 is new size 1575 */ 1576 if (!altera_check_stack(stack_ptr, 1, &status)) 1577 break; 1578 variable_id = args[0]; 1579 long_tmp = stack[--stack_ptr]; 1580 1581 if (long_tmp > var_size[variable_id]) { 1582 var_size[variable_id] = long_tmp; 1583 1584 if (attrs[variable_id] & 0x10) 1585 /* allocate integer array */ 1586 long_tmp *= sizeof(long); 1587 else 1588 /* allocate Boolean array */ 1589 long_tmp = (long_tmp + 7) >> 3; 1590 1591 /* 1592 * If the buffer was previously allocated, 1593 * free it 1594 */ 1595 if (attrs[variable_id] & 0x80) { 1596 kfree((void *)vars[variable_id]); 1597 vars[variable_id] = 0; 1598 } 1599 1600 /* 1601 * Allocate a new buffer 1602 * of the requested size 1603 */ 1604 vars[variable_id] = (long) 1605 kzalloc(long_tmp, GFP_KERNEL); 1606 1607 if (vars[variable_id] == 0) { 1608 status = -ENOMEM; 1609 break; 1610 } 1611 1612 /* 1613 * Set the attribute bit to indicate that 1614 * this buffer was dynamically allocated and 1615 * should be freed later 1616 */ 1617 attrs[variable_id] |= 0x80; 1618 1619 /* zero out memory */ 1620 count = ((var_size[variable_id] + 7L) / 1621 8L); 1622 charptr_tmp = (u8 *)(vars[variable_id]); 1623 for (index = 0; index < count; ++index) 1624 charptr_tmp[index] = 0; 1625 1626 } 1627 1628 break; 1629 case OP_EXPV: 1630 /* 1631 * Export Boolean array 1632 * ...argument 0 is string ID 1633 * ...stack 0 is variable ID 1634 * ...stack 1 is array right index 1635 * ...stack 2 is array left index 1636 */ 1637 if (!altera_check_stack(stack_ptr, 3, &status)) 1638 break; 1639 if (version == 0) { 1640 /* EXPV is not supported in JBC 1.0 */ 1641 bad_opcode = 1; 1642 break; 1643 } 1644 name = &p[str_table + args[0]]; 1645 variable_id = stack[--stack_ptr]; 1646 long_idx = stack[--stack_ptr];/* right indx */ 1647 long_idx2 = stack[--stack_ptr];/* left indx */ 1648 1649 if (long_idx > long_idx2) { 1650 /* reverse indices not supported */ 1651 status = -ERANGE; 1652 break; 1653 } 1654 1655 long_count = 1 + long_idx2 - long_idx; 1656 1657 charptr_tmp = (u8 *)vars[variable_id]; 1658 charptr_tmp2 = NULL; 1659 1660 if ((long_idx & 7L) != 0) { 1661 s32 k = long_idx; 1662 charptr_tmp2 = 1663 kzalloc(((long_count + 7L) / 8L), 1664 GFP_KERNEL); 1665 if (charptr_tmp2 == NULL) { 1666 status = -ENOMEM; 1667 break; 1668 } 1669 1670 for (i = 0; i < long_count; ++i) { 1671 if (charptr_tmp[k >> 3] & 1672 (1 << (k & 7))) 1673 charptr_tmp2[i >> 3] |= 1674 (1 << (i & 7)); 1675 else 1676 charptr_tmp2[i >> 3] &= 1677 ~(1 << (i & 7)); 1678 1679 ++k; 1680 } 1681 charptr_tmp = charptr_tmp2; 1682 1683 } else if (long_idx != 0) 1684 charptr_tmp = &charptr_tmp[long_idx >> 3]; 1685 1686 altera_export_bool_array(name, charptr_tmp, 1687 long_count); 1688 1689 /* free allocated buffer */ 1690 if ((long_idx & 7L) != 0) 1691 kfree(charptr_tmp2); 1692 1693 break; 1694 case OP_COPY: { 1695 /* 1696 * Array copy 1697 * ...argument 0 is dest ID 1698 * ...argument 1 is source ID 1699 * ...stack 0 is count 1700 * ...stack 1 is dest index 1701 * ...stack 2 is source index 1702 */ 1703 s32 copy_count; 1704 s32 copy_index; 1705 s32 copy_index2; 1706 s32 destleft; 1707 s32 src_count; 1708 s32 dest_count; 1709 int src_reverse = 0; 1710 int dest_reverse = 0; 1711 1712 if (!altera_check_stack(stack_ptr, 3, &status)) 1713 break; 1714 1715 copy_count = stack[--stack_ptr]; 1716 copy_index = stack[--stack_ptr]; 1717 copy_index2 = stack[--stack_ptr]; 1718 reverse = 0; 1719 1720 if (version > 0) { 1721 /* 1722 * stack 0 = source right index 1723 * stack 1 = source left index 1724 * stack 2 = destination right index 1725 * stack 3 = destination left index 1726 */ 1727 destleft = stack[--stack_ptr]; 1728 1729 if (copy_count > copy_index) { 1730 src_reverse = 1; 1731 reverse = 1; 1732 src_count = 1 + copy_count - copy_index; 1733 /* copy_index = source start index */ 1734 } else { 1735 src_count = 1 + copy_index - copy_count; 1736 /* source start index */ 1737 copy_index = copy_count; 1738 } 1739 1740 if (copy_index2 > destleft) { 1741 dest_reverse = 1; 1742 reverse = !reverse; 1743 dest_count = 1 + copy_index2 - destleft; 1744 /* destination start index */ 1745 copy_index2 = destleft; 1746 } else 1747 dest_count = 1 + destleft - copy_index2; 1748 1749 copy_count = (src_count < dest_count) ? 1750 src_count : dest_count; 1751 1752 if ((src_reverse || dest_reverse) && 1753 (src_count != dest_count)) 1754 /* 1755 * If either the source or destination 1756 * is reversed, we can't tolerate 1757 * a length mismatch, because we 1758 * "left justify" arrays when copying. 1759 * This won't work correctly 1760 * with reversed arrays. 1761 */ 1762 status = -ERANGE; 1763 1764 } 1765 1766 count = copy_count; 1767 index = copy_index; 1768 index2 = copy_index2; 1769 1770 /* 1771 * If destination is a read-only array, 1772 * allocate a buffer and convert it to a writable array 1773 */ 1774 variable_id = args[1]; 1775 if ((version > 0) && 1776 ((attrs[variable_id] & 0x9c) == 0x0c)) { 1777 /* Allocate a writable buffer for this array */ 1778 long_tmp = 1779 (var_size[variable_id] + 7L) >> 3L; 1780 charptr_tmp2 = (u8 *)vars[variable_id]; 1781 charptr_tmp = 1782 kzalloc(long_tmp, GFP_KERNEL); 1783 vars[variable_id] = (long)charptr_tmp; 1784 1785 if (vars[variable_id] == 0) { 1786 status = -ENOMEM; 1787 break; 1788 } 1789 1790 /* zero the buffer */ 1791 for (long_idx = 0L; long_idx < long_tmp; 1792 ++long_idx) 1793 charptr_tmp[long_idx] = 0; 1794 1795 /* copy previous contents into buffer */ 1796 for (long_idx = 0L; 1797 long_idx < var_size[variable_id]; 1798 ++long_idx) { 1799 long_idx2 = long_idx; 1800 1801 if (charptr_tmp2[long_idx2 >> 3] & 1802 (1 << (long_idx2 & 7))) 1803 charptr_tmp[long_idx >> 3] |= 1804 (1 << (long_idx & 7)); 1805 1806 } 1807 1808 /* 1809 set bit 7 - buffer was dynamically allocated */ 1810 attrs[variable_id] |= 0x80; 1811 1812 /* clear bit 2 - variable is writable */ 1813 attrs[variable_id] &= ~0x04; 1814 attrs[variable_id] |= 0x01; 1815 } 1816 1817 charptr_tmp = (u8 *)vars[args[1]]; 1818 charptr_tmp2 = (u8 *)vars[args[0]]; 1819 1820 /* check if destination is a writable Boolean array */ 1821 if ((attrs[args[1]] & 0x1c) != 0x08) { 1822 status = -ERANGE; 1823 break; 1824 } 1825 1826 if (count < 1) { 1827 status = -ERANGE; 1828 break; 1829 } 1830 1831 if (reverse) 1832 index2 += (count - 1); 1833 1834 for (i = 0; i < count; ++i) { 1835 if (charptr_tmp2[index >> 3] & 1836 (1 << (index & 7))) 1837 charptr_tmp[index2 >> 3] |= 1838 (1 << (index2 & 7)); 1839 else 1840 charptr_tmp[index2 >> 3] &= 1841 ~(1 << (index2 & 7)); 1842 1843 ++index; 1844 if (reverse) 1845 --index2; 1846 else 1847 ++index2; 1848 } 1849 1850 break; 1851 } 1852 case OP_DSC: 1853 case OP_ISC: { 1854 /* 1855 * DRSCAN with capture 1856 * IRSCAN with capture 1857 * ...argument 0 is scan data variable ID 1858 * ...argument 1 is capture variable ID 1859 * ...stack 0 is capture index 1860 * ...stack 1 is scan data index 1861 * ...stack 2 is count 1862 */ 1863 s32 scan_right, scan_left; 1864 s32 capture_count = 0; 1865 s32 scan_count = 0; 1866 s32 capture_index; 1867 s32 scan_index; 1868 1869 if (!altera_check_stack(stack_ptr, 3, &status)) 1870 break; 1871 1872 capture_index = stack[--stack_ptr]; 1873 scan_index = stack[--stack_ptr]; 1874 1875 if (version > 0) { 1876 /* 1877 * stack 0 = capture right index 1878 * stack 1 = capture left index 1879 * stack 2 = scan right index 1880 * stack 3 = scan left index 1881 * stack 4 = count 1882 */ 1883 scan_right = stack[--stack_ptr]; 1884 scan_left = stack[--stack_ptr]; 1885 capture_count = 1 + scan_index - capture_index; 1886 scan_count = 1 + scan_left - scan_right; 1887 scan_index = scan_right; 1888 } 1889 1890 long_count = stack[--stack_ptr]; 1891 /* 1892 * If capture array is read-only, allocate a buffer 1893 * and convert it to a writable array 1894 */ 1895 variable_id = args[1]; 1896 if ((version > 0) && 1897 ((attrs[variable_id] & 0x9c) == 0x0c)) { 1898 /* Allocate a writable buffer for this array */ 1899 long_tmp = 1900 (var_size[variable_id] + 7L) >> 3L; 1901 charptr_tmp2 = (u8 *)vars[variable_id]; 1902 charptr_tmp = 1903 kzalloc(long_tmp, GFP_KERNEL); 1904 vars[variable_id] = (long)charptr_tmp; 1905 1906 if (vars[variable_id] == 0) { 1907 status = -ENOMEM; 1908 break; 1909 } 1910 1911 /* zero the buffer */ 1912 for (long_idx = 0L; long_idx < long_tmp; 1913 ++long_idx) 1914 charptr_tmp[long_idx] = 0; 1915 1916 /* copy previous contents into buffer */ 1917 for (long_idx = 0L; 1918 long_idx < var_size[variable_id]; 1919 ++long_idx) { 1920 long_idx2 = long_idx; 1921 1922 if (charptr_tmp2[long_idx2 >> 3] & 1923 (1 << (long_idx2 & 7))) 1924 charptr_tmp[long_idx >> 3] |= 1925 (1 << (long_idx & 7)); 1926 1927 } 1928 1929 /* 1930 * set bit 7 - buffer was 1931 * dynamically allocated 1932 */ 1933 attrs[variable_id] |= 0x80; 1934 1935 /* clear bit 2 - variable is writable */ 1936 attrs[variable_id] &= ~0x04; 1937 attrs[variable_id] |= 0x01; 1938 1939 } 1940 1941 charptr_tmp = (u8 *)vars[args[0]]; 1942 charptr_tmp2 = (u8 *)vars[args[1]]; 1943 1944 if ((version > 0) && 1945 ((long_count > capture_count) || 1946 (long_count > scan_count))) { 1947 status = -ERANGE; 1948 break; 1949 } 1950 1951 /* 1952 * check that capture array 1953 * is a writable Boolean array 1954 */ 1955 if ((attrs[args[1]] & 0x1c) != 0x08) { 1956 status = -ERANGE; 1957 break; 1958 } 1959 1960 if (status == 0) { 1961 if (opcode == 0x82) /* DSC */ 1962 status = altera_swap_dr(astate, 1963 long_count, 1964 charptr_tmp, 1965 scan_index, 1966 charptr_tmp2, 1967 capture_index); 1968 else /* ISC */ 1969 status = altera_swap_ir(astate, 1970 long_count, 1971 charptr_tmp, 1972 scan_index, 1973 charptr_tmp2, 1974 capture_index); 1975 1976 } 1977 1978 break; 1979 } 1980 case OP_WAIT: 1981 /* 1982 * WAIT 1983 * ...argument 0 is wait state 1984 * ...argument 1 is end state 1985 * ...stack 0 is cycles 1986 * ...stack 1 is microseconds 1987 */ 1988 if (!altera_check_stack(stack_ptr, 2, &status)) 1989 break; 1990 long_tmp = stack[--stack_ptr]; 1991 1992 if (long_tmp != 0L) 1993 status = altera_wait_cycles(astate, long_tmp, 1994 args[0]); 1995 1996 long_tmp = stack[--stack_ptr]; 1997 1998 if ((status == 0) && (long_tmp != 0L)) 1999 status = altera_wait_msecs(astate, 2000 long_tmp, 2001 args[0]); 2002 2003 if ((status == 0) && (args[1] != args[0])) 2004 status = altera_goto_jstate(astate, 2005 args[1]); 2006 2007 if (version > 0) { 2008 --stack_ptr; /* throw away MAX cycles */ 2009 --stack_ptr; /* throw away MAX microseconds */ 2010 } 2011 break; 2012 case OP_CMPA: { 2013 /* 2014 * Array compare 2015 * ...argument 0 is source 1 ID 2016 * ...argument 1 is source 2 ID 2017 * ...argument 2 is mask ID 2018 * ...stack 0 is source 1 index 2019 * ...stack 1 is source 2 index 2020 * ...stack 2 is mask index 2021 * ...stack 3 is count 2022 */ 2023 s32 a, b; 2024 u8 *source1 = (u8 *)vars[args[0]]; 2025 u8 *source2 = (u8 *)vars[args[1]]; 2026 u8 *mask = (u8 *)vars[args[2]]; 2027 u32 index1; 2028 u32 index2; 2029 u32 mask_index; 2030 2031 if (!altera_check_stack(stack_ptr, 4, &status)) 2032 break; 2033 2034 index1 = stack[--stack_ptr]; 2035 index2 = stack[--stack_ptr]; 2036 mask_index = stack[--stack_ptr]; 2037 long_count = stack[--stack_ptr]; 2038 2039 if (version > 0) { 2040 /* 2041 * stack 0 = source 1 right index 2042 * stack 1 = source 1 left index 2043 * stack 2 = source 2 right index 2044 * stack 3 = source 2 left index 2045 * stack 4 = mask right index 2046 * stack 5 = mask left index 2047 */ 2048 s32 mask_right = stack[--stack_ptr]; 2049 s32 mask_left = stack[--stack_ptr]; 2050 /* source 1 count */ 2051 a = 1 + index2 - index1; 2052 /* source 2 count */ 2053 b = 1 + long_count - mask_index; 2054 a = (a < b) ? a : b; 2055 /* mask count */ 2056 b = 1 + mask_left - mask_right; 2057 a = (a < b) ? a : b; 2058 /* source 2 start index */ 2059 index2 = mask_index; 2060 /* mask start index */ 2061 mask_index = mask_right; 2062 long_count = a; 2063 } 2064 2065 long_tmp = 1L; 2066 2067 if (long_count < 1) 2068 status = -ERANGE; 2069 else { 2070 count = long_count; 2071 2072 for (i = 0; i < count; ++i) { 2073 if (mask[mask_index >> 3] & 2074 (1 << (mask_index & 7))) { 2075 a = source1[index1 >> 3] & 2076 (1 << (index1 & 7)) 2077 ? 1 : 0; 2078 b = source2[index2 >> 3] & 2079 (1 << (index2 & 7)) 2080 ? 1 : 0; 2081 2082 if (a != b) /* failure */ 2083 long_tmp = 0L; 2084 } 2085 ++index1; 2086 ++index2; 2087 ++mask_index; 2088 } 2089 } 2090 2091 stack[stack_ptr++] = long_tmp; 2092 2093 break; 2094 } 2095 default: 2096 /* Unrecognized opcode -- ERROR! */ 2097 bad_opcode = 1; 2098 break; 2099 } 2100 2101 if (bad_opcode) 2102 status = -ENOSYS; 2103 2104 if ((stack_ptr < 0) || (stack_ptr >= ALTERA_STACK_SIZE)) 2105 status = -EOVERFLOW; 2106 2107 if (status != 0) { 2108 done = 1; 2109 *error_address = (s32)(opcode_address - code_sect); 2110 } 2111 } 2112 2113 altera_free_buffers(astate); 2114 2115 /* Free all dynamically allocated arrays */ 2116 if ((attrs != NULL) && (vars != NULL)) 2117 for (i = 0; i < sym_count; ++i) 2118 if (attrs[i] & 0x80) 2119 kfree((void *)vars[i]); 2120 2121 kfree(vars); 2122 kfree(var_size); 2123 kfree(attrs); 2124 kfree(proc_attributes); 2125 2126 return status; 2127 } 2128 2129 static int altera_get_note(u8 *p, s32 program_size, 2130 s32 *offset, char *key, char *value, int length) 2131 /* 2132 * Gets key and value of NOTE fields in the JBC file. 2133 * Can be called in two modes: if offset pointer is NULL, 2134 * then the function searches for note fields which match 2135 * the key string provided. If offset is not NULL, then 2136 * the function finds the next note field of any key, 2137 * starting at the offset specified by the offset pointer. 2138 * Returns 0 for success, else appropriate error code 2139 */ 2140 { 2141 int status = -ENODATA; 2142 u32 note_strings = 0L; 2143 u32 note_table = 0L; 2144 u32 note_count = 0L; 2145 u32 first_word = 0L; 2146 int version = 0; 2147 int delta = 0; 2148 char *key_ptr; 2149 char *value_ptr; 2150 int i; 2151 2152 /* Read header information */ 2153 if (program_size > 52L) { 2154 first_word = get_unaligned_be32(&p[0]); 2155 version = (first_word & 1L); 2156 delta = version * 8; 2157 2158 note_strings = get_unaligned_be32(&p[8 + delta]); 2159 note_table = get_unaligned_be32(&p[12 + delta]); 2160 note_count = get_unaligned_be32(&p[44 + (2 * delta)]); 2161 } 2162 2163 if ((first_word != 0x4A414D00L) && (first_word != 0x4A414D01L)) 2164 return -EIO; 2165 2166 if (note_count <= 0L) 2167 return status; 2168 2169 if (offset == NULL) { 2170 /* 2171 * We will search for the first note with a specific key, 2172 * and return only the value 2173 */ 2174 for (i = 0; (i < note_count) && 2175 (status != 0); ++i) { 2176 key_ptr = &p[note_strings + 2177 get_unaligned_be32( 2178 &p[note_table + (8 * i)])]; 2179 if (key && !strncasecmp(key, key_ptr, strlen(key_ptr))) { 2180 status = 0; 2181 2182 value_ptr = &p[note_strings + 2183 get_unaligned_be32( 2184 &p[note_table + (8 * i) + 4])]; 2185 2186 if (value != NULL) 2187 strlcpy(value, value_ptr, length); 2188 2189 } 2190 } 2191 } else { 2192 /* 2193 * We will search for the next note, regardless of the key, 2194 * and return both the value and the key 2195 */ 2196 2197 i = *offset; 2198 2199 if ((i >= 0) && (i < note_count)) { 2200 status = 0; 2201 2202 if (key != NULL) 2203 strlcpy(key, &p[note_strings + 2204 get_unaligned_be32( 2205 &p[note_table + (8 * i)])], 2206 length); 2207 2208 if (value != NULL) 2209 strlcpy(value, &p[note_strings + 2210 get_unaligned_be32( 2211 &p[note_table + (8 * i) + 4])], 2212 length); 2213 2214 *offset = i + 1; 2215 } 2216 } 2217 2218 return status; 2219 } 2220 2221 static int altera_check_crc(u8 *p, s32 program_size) 2222 { 2223 int status = 0; 2224 u16 local_expected = 0, 2225 local_actual = 0, 2226 shift_reg = 0xffff; 2227 int bit, feedback; 2228 u8 databyte; 2229 u32 i; 2230 u32 crc_section = 0L; 2231 u32 first_word = 0L; 2232 int version = 0; 2233 int delta = 0; 2234 2235 if (program_size > 52L) { 2236 first_word = get_unaligned_be32(&p[0]); 2237 version = (first_word & 1L); 2238 delta = version * 8; 2239 2240 crc_section = get_unaligned_be32(&p[32 + delta]); 2241 } 2242 2243 if ((first_word != 0x4A414D00L) && (first_word != 0x4A414D01L)) 2244 status = -EIO; 2245 2246 if (crc_section >= program_size) 2247 status = -EIO; 2248 2249 if (status == 0) { 2250 local_expected = (u16)get_unaligned_be16(&p[crc_section]); 2251 2252 for (i = 0; i < crc_section; ++i) { 2253 databyte = p[i]; 2254 for (bit = 0; bit < 8; bit++) { 2255 feedback = (databyte ^ shift_reg) & 0x01; 2256 shift_reg >>= 1; 2257 if (feedback) 2258 shift_reg ^= 0x8408; 2259 2260 databyte >>= 1; 2261 } 2262 } 2263 2264 local_actual = (u16)~shift_reg; 2265 2266 if (local_expected != local_actual) 2267 status = -EILSEQ; 2268 2269 } 2270 2271 if (debug || status) { 2272 switch (status) { 2273 case 0: 2274 printk(KERN_INFO "%s: CRC matched: %04x\n", __func__, 2275 local_actual); 2276 break; 2277 case -EILSEQ: 2278 printk(KERN_ERR "%s: CRC mismatch: expected %04x, " 2279 "actual %04x\n", __func__, local_expected, 2280 local_actual); 2281 break; 2282 case -ENODATA: 2283 printk(KERN_ERR "%s: expected CRC not found, " 2284 "actual CRC = %04x\n", __func__, 2285 local_actual); 2286 break; 2287 case -EIO: 2288 printk(KERN_ERR "%s: error: format isn't " 2289 "recognized.\n", __func__); 2290 break; 2291 default: 2292 printk(KERN_ERR "%s: CRC function returned error " 2293 "code %d\n", __func__, status); 2294 break; 2295 } 2296 } 2297 2298 return status; 2299 } 2300 2301 static int altera_get_file_info(u8 *p, 2302 s32 program_size, 2303 int *format_version, 2304 int *action_count, 2305 int *procedure_count) 2306 { 2307 int status = -EIO; 2308 u32 first_word = 0; 2309 int version = 0; 2310 2311 if (program_size <= 52L) 2312 return status; 2313 2314 first_word = get_unaligned_be32(&p[0]); 2315 2316 if ((first_word == 0x4A414D00L) || (first_word == 0x4A414D01L)) { 2317 status = 0; 2318 2319 version = (first_word & 1L); 2320 *format_version = version + 1; 2321 2322 if (version > 0) { 2323 *action_count = get_unaligned_be32(&p[48]); 2324 *procedure_count = get_unaligned_be32(&p[52]); 2325 } 2326 } 2327 2328 return status; 2329 } 2330 2331 static int altera_get_act_info(u8 *p, 2332 s32 program_size, 2333 int index, 2334 char **name, 2335 char **description, 2336 struct altera_procinfo **proc_list) 2337 { 2338 int status = -EIO; 2339 struct altera_procinfo *procptr = NULL; 2340 struct altera_procinfo *tmpptr = NULL; 2341 u32 first_word = 0L; 2342 u32 action_table = 0L; 2343 u32 proc_table = 0L; 2344 u32 str_table = 0L; 2345 u32 note_strings = 0L; 2346 u32 action_count = 0L; 2347 u32 proc_count = 0L; 2348 u32 act_name_id = 0L; 2349 u32 act_desc_id = 0L; 2350 u32 act_proc_id = 0L; 2351 u32 act_proc_name = 0L; 2352 u8 act_proc_attribute = 0; 2353 2354 if (program_size <= 52L) 2355 return status; 2356 /* Read header information */ 2357 first_word = get_unaligned_be32(&p[0]); 2358 2359 if (first_word != 0x4A414D01L) 2360 return status; 2361 2362 action_table = get_unaligned_be32(&p[4]); 2363 proc_table = get_unaligned_be32(&p[8]); 2364 str_table = get_unaligned_be32(&p[12]); 2365 note_strings = get_unaligned_be32(&p[16]); 2366 action_count = get_unaligned_be32(&p[48]); 2367 proc_count = get_unaligned_be32(&p[52]); 2368 2369 if (index >= action_count) 2370 return status; 2371 2372 act_name_id = get_unaligned_be32(&p[action_table + (12 * index)]); 2373 act_desc_id = get_unaligned_be32(&p[action_table + (12 * index) + 4]); 2374 act_proc_id = get_unaligned_be32(&p[action_table + (12 * index) + 8]); 2375 2376 *name = &p[str_table + act_name_id]; 2377 2378 if (act_desc_id < (note_strings - str_table)) 2379 *description = &p[str_table + act_desc_id]; 2380 2381 do { 2382 act_proc_name = get_unaligned_be32( 2383 &p[proc_table + (13 * act_proc_id)]); 2384 act_proc_attribute = 2385 (p[proc_table + (13 * act_proc_id) + 8] & 0x03); 2386 2387 procptr = 2388 kzalloc(sizeof(struct altera_procinfo), 2389 GFP_KERNEL); 2390 2391 if (procptr == NULL) 2392 status = -ENOMEM; 2393 else { 2394 procptr->name = &p[str_table + act_proc_name]; 2395 procptr->attrs = act_proc_attribute; 2396 procptr->next = NULL; 2397 2398 /* add record to end of linked list */ 2399 if (*proc_list == NULL) 2400 *proc_list = procptr; 2401 else { 2402 tmpptr = *proc_list; 2403 while (tmpptr->next != NULL) 2404 tmpptr = tmpptr->next; 2405 tmpptr->next = procptr; 2406 } 2407 } 2408 2409 act_proc_id = get_unaligned_be32( 2410 &p[proc_table + (13 * act_proc_id) + 4]); 2411 } while ((act_proc_id != 0) && (act_proc_id < proc_count)); 2412 2413 return status; 2414 } 2415 2416 int altera_init(struct altera_config *config, const struct firmware *fw) 2417 { 2418 struct altera_state *astate = NULL; 2419 struct altera_procinfo *proc_list = NULL; 2420 struct altera_procinfo *procptr = NULL; 2421 char *key = NULL; 2422 char *value = NULL; 2423 char *action_name = NULL; 2424 char *description = NULL; 2425 int exec_result = 0; 2426 int exit_code = 0; 2427 int format_version = 0; 2428 int action_count = 0; 2429 int procedure_count = 0; 2430 int index = 0; 2431 s32 offset = 0L; 2432 s32 error_address = 0L; 2433 int retval = 0; 2434 2435 key = kzalloc(33, GFP_KERNEL); 2436 if (!key) { 2437 retval = -ENOMEM; 2438 goto out; 2439 } 2440 value = kzalloc(257, GFP_KERNEL); 2441 if (!value) { 2442 retval = -ENOMEM; 2443 goto free_key; 2444 } 2445 astate = kzalloc(sizeof(struct altera_state), GFP_KERNEL); 2446 if (!astate) { 2447 retval = -ENOMEM; 2448 goto free_value; 2449 } 2450 2451 astate->config = config; 2452 if (!astate->config->jtag_io) { 2453 dprintk("%s: using byteblaster!\n", __func__); 2454 astate->config->jtag_io = netup_jtag_io_lpt; 2455 } 2456 2457 altera_check_crc((u8 *)fw->data, fw->size); 2458 2459 if (debug) { 2460 altera_get_file_info((u8 *)fw->data, fw->size, &format_version, 2461 &action_count, &procedure_count); 2462 printk(KERN_INFO "%s: File format is %s ByteCode format\n", 2463 __func__, (format_version == 2) ? "Jam STAPL" : 2464 "pre-standardized Jam 1.1"); 2465 while (altera_get_note((u8 *)fw->data, fw->size, 2466 &offset, key, value, 256) == 0) 2467 printk(KERN_INFO "%s: NOTE \"%s\" = \"%s\"\n", 2468 __func__, key, value); 2469 } 2470 2471 if (debug && (format_version == 2) && (action_count > 0)) { 2472 printk(KERN_INFO "%s: Actions available:\n", __func__); 2473 for (index = 0; index < action_count; ++index) { 2474 altera_get_act_info((u8 *)fw->data, fw->size, 2475 index, &action_name, 2476 &description, 2477 &proc_list); 2478 2479 if (description == NULL) 2480 printk(KERN_INFO "%s: %s\n", 2481 __func__, 2482 action_name); 2483 else 2484 printk(KERN_INFO "%s: %s \"%s\"\n", 2485 __func__, 2486 action_name, 2487 description); 2488 2489 procptr = proc_list; 2490 while (procptr != NULL) { 2491 if (procptr->attrs != 0) 2492 printk(KERN_INFO "%s: %s (%s)\n", 2493 __func__, 2494 procptr->name, 2495 (procptr->attrs == 1) ? 2496 "optional" : "recommended"); 2497 2498 proc_list = procptr->next; 2499 kfree(procptr); 2500 procptr = proc_list; 2501 } 2502 } 2503 2504 printk(KERN_INFO "\n"); 2505 } 2506 2507 exec_result = altera_execute(astate, (u8 *)fw->data, fw->size, 2508 &error_address, &exit_code, &format_version); 2509 2510 if (exit_code) 2511 exec_result = -EREMOTEIO; 2512 2513 if ((format_version == 2) && (exec_result == -EINVAL)) { 2514 if (astate->config->action == NULL) 2515 printk(KERN_ERR "%s: error: no action specified for " 2516 "Jam STAPL file.\nprogram terminated.\n", 2517 __func__); 2518 else 2519 printk(KERN_ERR "%s: error: action \"%s\"" 2520 " is not supported " 2521 "for this Jam STAPL file.\n" 2522 "Program terminated.\n", __func__, 2523 astate->config->action); 2524 2525 } else if (exec_result) 2526 printk(KERN_ERR "%s: error %d\n", __func__, exec_result); 2527 2528 kfree(astate); 2529 free_value: 2530 kfree(value); 2531 free_key: 2532 kfree(key); 2533 out: 2534 return retval; 2535 } 2536 EXPORT_SYMBOL(altera_init); 2537