1 /*- 2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3 * 4 * Copyright (c) 2013-2016 Qlogic Corporation 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 18 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE 21 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 22 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 23 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 24 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 25 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 26 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 27 * POSSIBILITY OF SUCH DAMAGE. 28 */ 29 /* 30 * File : ql_misc.c 31 * Author : David C Somayajulu, Qlogic Corporation, Aliso Viejo, CA 92656. 32 */ 33 34 #include <sys/cdefs.h> 35 __FBSDID("$FreeBSD$"); 36 37 #include "ql_os.h" 38 #include "ql_hw.h" 39 #include "ql_def.h" 40 #include "ql_inline.h" 41 #include "ql_glbl.h" 42 #include "ql_dbg.h" 43 #include "ql_tmplt.h" 44 45 #define QL_FDT_OFFSET 0x3F0000 46 #define Q8_FLASH_SECTOR_SIZE 0x10000 47 48 static int qla_ld_fw_init(qla_host_t *ha); 49 50 /* 51 * structure encapsulating the value to read/write to offchip memory 52 */ 53 typedef struct _offchip_mem_val { 54 uint32_t data_lo; 55 uint32_t data_hi; 56 uint32_t data_ulo; 57 uint32_t data_uhi; 58 } offchip_mem_val_t; 59 60 /* 61 * Name: ql_rdwr_indreg32 62 * Function: Read/Write an Indirect Register 63 */ 64 int 65 ql_rdwr_indreg32(qla_host_t *ha, uint32_t addr, uint32_t *val, uint32_t rd) 66 { 67 uint32_t wnd_reg; 68 uint32_t count = 100; 69 70 wnd_reg = (Q8_CRB_WINDOW_PF0 | (ha->pci_func << 2)); 71 72 WRITE_REG32(ha, wnd_reg, addr); 73 74 while (count--) { 75 if (READ_REG32(ha, wnd_reg) == addr) 76 break; 77 qla_mdelay(__func__, 1); 78 } 79 if (!count || QL_ERR_INJECT(ha, INJCT_RDWR_INDREG_FAILURE)) { 80 device_printf(ha->pci_dev, "%s: [0x%08x, 0x%08x, %d] failed\n", 81 __func__, addr, *val, rd); 82 QL_INITIATE_RECOVERY(ha); 83 return -1; 84 } 85 86 if (rd) { 87 *val = READ_REG32(ha, Q8_WILD_CARD); 88 } else { 89 WRITE_REG32(ha, Q8_WILD_CARD, *val); 90 } 91 92 return 0; 93 } 94 95 /* 96 * Name: ql_rdwr_offchip_mem 97 * Function: Read/Write OffChip Memory 98 */ 99 int 100 ql_rdwr_offchip_mem(qla_host_t *ha, uint64_t addr, q80_offchip_mem_val_t *val, 101 uint32_t rd) 102 { 103 uint32_t count = 100; 104 uint32_t data, step = 0; 105 106 if (QL_ERR_INJECT(ha, INJCT_RDWR_OFFCHIPMEM_FAILURE)) 107 goto exit_ql_rdwr_offchip_mem; 108 109 data = (uint32_t)addr; 110 if (ql_rdwr_indreg32(ha, Q8_MS_ADDR_LO, &data, 0)) { 111 step = 1; 112 goto exit_ql_rdwr_offchip_mem; 113 } 114 115 data = (uint32_t)(addr >> 32); 116 if (ql_rdwr_indreg32(ha, Q8_MS_ADDR_HI, &data, 0)) { 117 step = 2; 118 goto exit_ql_rdwr_offchip_mem; 119 } 120 121 data = BIT_1; 122 if (ql_rdwr_indreg32(ha, Q8_MS_CNTRL, &data, 0)) { 123 step = 3; 124 goto exit_ql_rdwr_offchip_mem; 125 } 126 127 if (!rd) { 128 data = val->data_lo; 129 if (ql_rdwr_indreg32(ha, Q8_MS_WR_DATA_0_31, &data, 0)) { 130 step = 4; 131 goto exit_ql_rdwr_offchip_mem; 132 } 133 134 data = val->data_hi; 135 if (ql_rdwr_indreg32(ha, Q8_MS_WR_DATA_32_63, &data, 0)) { 136 step = 5; 137 goto exit_ql_rdwr_offchip_mem; 138 } 139 140 data = val->data_ulo; 141 if (ql_rdwr_indreg32(ha, Q8_MS_WR_DATA_64_95, &data, 0)) { 142 step = 6; 143 goto exit_ql_rdwr_offchip_mem; 144 } 145 146 data = val->data_uhi; 147 if (ql_rdwr_indreg32(ha, Q8_MS_WR_DATA_96_127, &data, 0)) { 148 step = 7; 149 goto exit_ql_rdwr_offchip_mem; 150 } 151 152 data = (BIT_2|BIT_1|BIT_0); 153 if (ql_rdwr_indreg32(ha, Q8_MS_CNTRL, &data, 0)) { 154 step = 7; 155 goto exit_ql_rdwr_offchip_mem; 156 } 157 } else { 158 data = (BIT_1|BIT_0); 159 if (ql_rdwr_indreg32(ha, Q8_MS_CNTRL, &data, 0)) { 160 step = 8; 161 goto exit_ql_rdwr_offchip_mem; 162 } 163 } 164 165 while (count--) { 166 if (ql_rdwr_indreg32(ha, Q8_MS_CNTRL, &data, 1)) { 167 step = 9; 168 goto exit_ql_rdwr_offchip_mem; 169 } 170 171 if (!(data & BIT_3)) { 172 if (rd) { 173 if (ql_rdwr_indreg32(ha, Q8_MS_RD_DATA_0_31, 174 &data, 1)) { 175 step = 10; 176 goto exit_ql_rdwr_offchip_mem; 177 } 178 val->data_lo = data; 179 180 if (ql_rdwr_indreg32(ha, Q8_MS_RD_DATA_32_63, 181 &data, 1)) { 182 step = 11; 183 goto exit_ql_rdwr_offchip_mem; 184 } 185 val->data_hi = data; 186 187 if (ql_rdwr_indreg32(ha, Q8_MS_RD_DATA_64_95, 188 &data, 1)) { 189 step = 12; 190 goto exit_ql_rdwr_offchip_mem; 191 } 192 val->data_ulo = data; 193 194 if (ql_rdwr_indreg32(ha, Q8_MS_RD_DATA_96_127, 195 &data, 1)) { 196 step = 13; 197 goto exit_ql_rdwr_offchip_mem; 198 } 199 val->data_uhi = data; 200 } 201 return 0; 202 } else 203 qla_mdelay(__func__, 1); 204 } 205 206 exit_ql_rdwr_offchip_mem: 207 208 device_printf(ha->pci_dev, 209 "%s: [0x%08x 0x%08x : 0x%08x 0x%08x 0x%08x 0x%08x]" 210 " [%d] [%d] failed\n", __func__, (uint32_t)(addr >> 32), 211 (uint32_t)(addr), val->data_lo, val->data_hi, val->data_ulo, 212 val->data_uhi, rd, step); 213 214 QL_INITIATE_RECOVERY(ha); 215 216 return (-1); 217 } 218 219 /* 220 * Name: ql_rd_flash32 221 * Function: Read Flash Memory 222 */ 223 int 224 ql_rd_flash32(qla_host_t *ha, uint32_t addr, uint32_t *data) 225 { 226 uint32_t data32; 227 228 if (qla_sem_lock(ha, Q8_FLASH_LOCK, Q8_FLASH_LOCK_ID, 0xABCDABCD)) { 229 device_printf(ha->pci_dev, "%s: Q8_FLASH_LOCK failed\n", 230 __func__); 231 return (-1); 232 } 233 234 data32 = addr; 235 if (ql_rdwr_indreg32(ha, Q8_FLASH_DIRECT_WINDOW, &data32, 0)) { 236 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 237 device_printf(ha->pci_dev, 238 "%s: Q8_FLASH_DIRECT_WINDOW[0x%08x] failed\n", 239 __func__, data32); 240 return (-1); 241 } 242 243 data32 = Q8_FLASH_DIRECT_DATA | (addr & 0xFFFF); 244 if (ql_rdwr_indreg32(ha, data32, data, 1)) { 245 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 246 device_printf(ha->pci_dev, 247 "%s: data32:data [0x%08x] failed\n", 248 __func__, data32); 249 return (-1); 250 } 251 252 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 253 return 0; 254 } 255 256 static int 257 qla_get_fdt(qla_host_t *ha) 258 { 259 uint32_t data32; 260 int count; 261 qla_hw_t *hw; 262 263 hw = &ha->hw; 264 265 for (count = 0; count < sizeof(qla_flash_desc_table_t); count+=4) { 266 if (ql_rd_flash32(ha, QL_FDT_OFFSET + count, 267 (uint32_t *)&hw->fdt + (count >> 2))) { 268 device_printf(ha->pci_dev, 269 "%s: Read QL_FDT_OFFSET + %d failed\n", 270 __func__, count); 271 return (-1); 272 } 273 } 274 275 if (qla_sem_lock(ha, Q8_FLASH_LOCK, Q8_FLASH_LOCK_ID, 276 Q8_FDT_LOCK_MAGIC_ID)) { 277 device_printf(ha->pci_dev, "%s: Q8_FLASH_LOCK failed\n", 278 __func__); 279 return (-1); 280 } 281 282 data32 = Q8_FDT_FLASH_ADDR_VAL; 283 if (ql_rdwr_indreg32(ha, Q8_FLASH_ADDRESS, &data32, 0)) { 284 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 285 device_printf(ha->pci_dev, 286 "%s: Write to Q8_FLASH_ADDRESS failed\n", 287 __func__); 288 return (-1); 289 } 290 291 data32 = Q8_FDT_FLASH_CTRL_VAL; 292 if (ql_rdwr_indreg32(ha, Q8_FLASH_CONTROL, &data32, 0)) { 293 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 294 device_printf(ha->pci_dev, 295 "%s: Write to Q8_FLASH_CONTROL failed\n", 296 __func__); 297 return (-1); 298 } 299 300 count = 0; 301 302 do { 303 if (count < 1000) { 304 QLA_USEC_DELAY(10); 305 count += 10; 306 } else { 307 qla_mdelay(__func__, 1); 308 count += 1000; 309 } 310 311 data32 = 0; 312 313 if (ql_rdwr_indreg32(ha, Q8_FLASH_STATUS, &data32, 1)) { 314 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 315 device_printf(ha->pci_dev, 316 "%s: Read Q8_FLASH_STATUS failed\n", 317 __func__); 318 return (-1); 319 } 320 321 data32 &= 0x6; 322 323 } while ((count < 10000) && (data32 != 0x6)); 324 325 if (data32 != 0x6) { 326 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 327 device_printf(ha->pci_dev, 328 "%s: Poll Q8_FLASH_STATUS failed\n", 329 __func__); 330 return (-1); 331 } 332 333 if (ql_rdwr_indreg32(ha, Q8_FLASH_RD_DATA, &data32, 1)) { 334 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 335 device_printf(ha->pci_dev, 336 "%s: Read Q8_FLASH_RD_DATA failed\n", 337 __func__); 338 return (-1); 339 } 340 341 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 342 343 data32 &= Q8_FDT_MASK_VAL; 344 if (hw->fdt.flash_manuf == data32) 345 return (0); 346 else 347 return (-1); 348 } 349 350 static int 351 qla_flash_write_enable(qla_host_t *ha, int enable) 352 { 353 uint32_t data32; 354 int count = 0; 355 356 data32 = Q8_WR_ENABLE_FL_ADDR | ha->hw.fdt.write_statusreg_cmd; 357 if (ql_rdwr_indreg32(ha, Q8_FLASH_ADDRESS, &data32, 0)) { 358 device_printf(ha->pci_dev, 359 "%s: Write to Q8_FLASH_ADDRESS failed\n", 360 __func__); 361 return (-1); 362 } 363 364 if (enable) 365 data32 = ha->hw.fdt.write_enable_bits; 366 else 367 data32 = ha->hw.fdt.write_disable_bits; 368 369 if (ql_rdwr_indreg32(ha, Q8_FLASH_WR_DATA, &data32, 0)) { 370 device_printf(ha->pci_dev, 371 "%s: Write to Q8_FLASH_WR_DATA failed\n", 372 __func__); 373 return (-1); 374 } 375 376 data32 = Q8_WR_ENABLE_FL_CTRL; 377 if (ql_rdwr_indreg32(ha, Q8_FLASH_CONTROL, &data32, 0)) { 378 device_printf(ha->pci_dev, 379 "%s: Write to Q8_FLASH_CONTROL failed\n", 380 __func__); 381 return (-1); 382 } 383 384 do { 385 if (count < 1000) { 386 QLA_USEC_DELAY(10); 387 count += 10; 388 } else { 389 qla_mdelay(__func__, 1); 390 count += 1000; 391 } 392 393 data32 = 0; 394 if (ql_rdwr_indreg32(ha, Q8_FLASH_STATUS, &data32, 1)) { 395 device_printf(ha->pci_dev, 396 "%s: Read Q8_FLASH_STATUS failed\n", 397 __func__); 398 return (-1); 399 } 400 401 data32 &= 0x6; 402 403 } while ((count < 10000) && (data32 != 0x6)); 404 405 if (data32 != 0x6) { 406 device_printf(ha->pci_dev, 407 "%s: Poll Q8_FLASH_STATUS failed\n", 408 __func__); 409 return (-1); 410 } 411 412 return 0; 413 } 414 415 static int 416 qla_erase_flash_sector(qla_host_t *ha, uint32_t start) 417 { 418 uint32_t data32; 419 int count = 0; 420 421 do { 422 qla_mdelay(__func__, 1); 423 424 data32 = 0; 425 if (ql_rdwr_indreg32(ha, Q8_FLASH_STATUS, &data32, 1)) { 426 device_printf(ha->pci_dev, 427 "%s: Read Q8_FLASH_STATUS failed\n", 428 __func__); 429 return (-1); 430 } 431 432 data32 &= 0x6; 433 434 } while (((count++) < 1000) && (data32 != 0x6)); 435 436 if (data32 != 0x6) { 437 device_printf(ha->pci_dev, 438 "%s: Poll Q8_FLASH_STATUS failed\n", 439 __func__); 440 return (-1); 441 } 442 443 data32 = (start >> 16) & 0xFF; 444 if (ql_rdwr_indreg32(ha, Q8_FLASH_WR_DATA, &data32, 0)) { 445 device_printf(ha->pci_dev, 446 "%s: Write to Q8_FLASH_WR_DATA failed\n", 447 __func__); 448 return (-1); 449 } 450 451 data32 = Q8_ERASE_FL_ADDR_MASK | ha->hw.fdt.erase_cmd; 452 if (ql_rdwr_indreg32(ha, Q8_FLASH_ADDRESS, &data32, 0)) { 453 device_printf(ha->pci_dev, 454 "%s: Write to Q8_FLASH_ADDRESS failed\n", 455 __func__); 456 return (-1); 457 } 458 459 data32 = Q8_ERASE_FL_CTRL_MASK; 460 if (ql_rdwr_indreg32(ha, Q8_FLASH_CONTROL, &data32, 0)) { 461 device_printf(ha->pci_dev, 462 "%s: Write to Q8_FLASH_CONTROL failed\n", 463 __func__); 464 return (-1); 465 } 466 467 count = 0; 468 do { 469 qla_mdelay(__func__, 1); 470 471 data32 = 0; 472 if (ql_rdwr_indreg32(ha, Q8_FLASH_STATUS, &data32, 1)) { 473 device_printf(ha->pci_dev, 474 "%s: Read Q8_FLASH_STATUS failed\n", 475 __func__); 476 return (-1); 477 } 478 479 data32 &= 0x6; 480 481 } while (((count++) < 1000) && (data32 != 0x6)); 482 483 if (data32 != 0x6) { 484 device_printf(ha->pci_dev, 485 "%s: Poll Q8_FLASH_STATUS failed\n", 486 __func__); 487 return (-1); 488 } 489 490 return 0; 491 } 492 493 int 494 ql_erase_flash(qla_host_t *ha, uint32_t off, uint32_t size) 495 { 496 int rval = 0; 497 uint32_t start; 498 499 if (off & (Q8_FLASH_SECTOR_SIZE -1)) 500 return (-1); 501 502 if (qla_sem_lock(ha, Q8_FLASH_LOCK, Q8_FLASH_LOCK_ID, 503 Q8_ERASE_LOCK_MAGIC_ID)) { 504 device_printf(ha->pci_dev, "%s: Q8_FLASH_LOCK failed\n", 505 __func__); 506 return (-1); 507 } 508 509 if (qla_flash_write_enable(ha, 1) != 0) { 510 rval = -1; 511 goto ql_erase_flash_exit; 512 } 513 514 for (start = off; start < (off + size); start = start + 515 Q8_FLASH_SECTOR_SIZE) { 516 if (qla_erase_flash_sector(ha, start)) { 517 rval = -1; 518 break; 519 } 520 } 521 522 rval = qla_flash_write_enable(ha, 0); 523 524 ql_erase_flash_exit: 525 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 526 return (rval); 527 } 528 529 static int 530 qla_wr_flash32(qla_host_t *ha, uint32_t off, uint32_t *data) 531 { 532 uint32_t data32; 533 int count = 0; 534 535 data32 = Q8_WR_FL_ADDR_MASK | (off >> 2); 536 if (ql_rdwr_indreg32(ha, Q8_FLASH_ADDRESS, &data32, 0)) { 537 device_printf(ha->pci_dev, 538 "%s: Write to Q8_FLASH_ADDRESS failed\n", 539 __func__); 540 return (-1); 541 } 542 543 if (ql_rdwr_indreg32(ha, Q8_FLASH_WR_DATA, data, 0)) { 544 device_printf(ha->pci_dev, 545 "%s: Write to Q8_FLASH_WR_DATA failed\n", 546 __func__); 547 return (-1); 548 } 549 550 data32 = Q8_WR_FL_CTRL_MASK; 551 if (ql_rdwr_indreg32(ha, Q8_FLASH_CONTROL, &data32, 0)) { 552 device_printf(ha->pci_dev, 553 "%s: Write to Q8_FLASH_CONTROL failed\n", 554 __func__); 555 return (-1); 556 } 557 558 do { 559 if (count < 1000) { 560 QLA_USEC_DELAY(10); 561 count += 10; 562 } else { 563 qla_mdelay(__func__, 1); 564 count += 1000; 565 } 566 567 data32 = 0; 568 if (ql_rdwr_indreg32(ha, Q8_FLASH_STATUS, &data32, 1)) { 569 device_printf(ha->pci_dev, 570 "%s: Read Q8_FLASH_STATUS failed\n", 571 __func__); 572 return (-1); 573 } 574 575 data32 &= 0x6; 576 577 } while ((count < 10000) && (data32 != 0x6)); 578 579 if (data32 != 0x6) { 580 device_printf(ha->pci_dev, 581 "%s: Poll Q8_FLASH_STATUS failed\n", 582 __func__); 583 return (-1); 584 } 585 586 return 0; 587 } 588 589 static int 590 qla_flash_write_data(qla_host_t *ha, uint32_t off, uint32_t size, 591 void *data) 592 { 593 int rval = 0; 594 uint32_t start; 595 uint32_t *data32 = data; 596 597 if (qla_sem_lock(ha, Q8_FLASH_LOCK, Q8_FLASH_LOCK_ID, 598 Q8_WR_FL_LOCK_MAGIC_ID)) { 599 device_printf(ha->pci_dev, "%s: Q8_FLASH_LOCK failed\n", 600 __func__); 601 rval = -1; 602 goto qla_flash_write_data_exit; 603 } 604 605 if ((qla_flash_write_enable(ha, 1) != 0)) { 606 device_printf(ha->pci_dev, "%s: failed\n", 607 __func__); 608 rval = -1; 609 goto qla_flash_write_data_unlock_exit; 610 } 611 612 for (start = off; start < (off + size); start = start + 4) { 613 if (*data32 != 0xFFFFFFFF) { 614 if (qla_wr_flash32(ha, start, data32)) { 615 rval = -1; 616 break; 617 } 618 } 619 data32++; 620 } 621 622 rval = qla_flash_write_enable(ha, 0); 623 624 qla_flash_write_data_unlock_exit: 625 qla_sem_unlock(ha, Q8_FLASH_UNLOCK); 626 627 qla_flash_write_data_exit: 628 return (rval); 629 } 630 631 int 632 ql_wr_flash_buffer(qla_host_t *ha, uint32_t off, uint32_t size, void *buf) 633 { 634 int rval = 0; 635 void *data; 636 637 if (size == 0) 638 return 0; 639 640 size = size << 2; 641 642 if (buf == NULL) 643 return -1; 644 645 if ((data = malloc(size, M_QLA83XXBUF, M_NOWAIT)) == NULL) { 646 device_printf(ha->pci_dev, "%s: malloc failed \n", __func__); 647 rval = -1; 648 goto ql_wr_flash_buffer_exit; 649 } 650 651 if ((rval = copyin(buf, data, size))) { 652 device_printf(ha->pci_dev, "%s copyin failed\n", __func__); 653 goto ql_wr_flash_buffer_free_exit; 654 } 655 656 rval = qla_flash_write_data(ha, off, size, data); 657 658 ql_wr_flash_buffer_free_exit: 659 free(data, M_QLA83XXBUF); 660 661 ql_wr_flash_buffer_exit: 662 return (rval); 663 } 664 665 #ifdef QL_LDFLASH_FW 666 /* 667 * Name: qla_load_fw_from_flash 668 * Function: Reads the Bootloader from Flash and Loads into Offchip Memory 669 */ 670 static void 671 qla_load_fw_from_flash(qla_host_t *ha) 672 { 673 uint32_t flash_off = 0x10000; 674 uint64_t mem_off; 675 uint32_t count, mem_size; 676 q80_offchip_mem_val_t val; 677 678 mem_off = (uint64_t)(READ_REG32(ha, Q8_BOOTLD_ADDR)); 679 mem_size = READ_REG32(ha, Q8_BOOTLD_SIZE); 680 681 device_printf(ha->pci_dev, "%s: [0x%08x][0x%08x]\n", 682 __func__, (uint32_t)mem_off, mem_size); 683 684 /* only bootloader needs to be loaded into memory */ 685 for (count = 0; count < mem_size ; ) { 686 ql_rd_flash32(ha, flash_off, &val.data_lo); 687 count = count + 4; 688 flash_off = flash_off + 4; 689 690 ql_rd_flash32(ha, flash_off, &val.data_hi); 691 count = count + 4; 692 flash_off = flash_off + 4; 693 694 ql_rd_flash32(ha, flash_off, &val.data_ulo); 695 count = count + 4; 696 flash_off = flash_off + 4; 697 698 ql_rd_flash32(ha, flash_off, &val.data_uhi); 699 count = count + 4; 700 flash_off = flash_off + 4; 701 702 ql_rdwr_offchip_mem(ha, mem_off, &val, 0); 703 704 mem_off = mem_off + 16; 705 } 706 707 return; 708 } 709 #endif /* #ifdef QL_LDFLASH_FW */ 710 711 /* 712 * Name: qla_init_from_flash 713 * Function: Performs Initialization which consists of the following sequence 714 * - reset 715 * - CRB Init 716 * - Peg Init 717 * - Read the Bootloader from Flash and Load into Offchip Memory 718 * - Kick start the bootloader which loads the rest of the firmware 719 * and performs the remaining steps in the initialization process. 720 */ 721 static int 722 qla_init_from_flash(qla_host_t *ha) 723 { 724 uint32_t delay = 300; 725 uint32_t data; 726 727 qla_ld_fw_init(ha); 728 729 do { 730 data = READ_REG32(ha, Q8_CMDPEG_STATE); 731 732 QL_DPRINT2(ha, 733 (ha->pci_dev, "%s: func[%d] cmdpegstate 0x%08x\n", 734 __func__, ha->pci_func, data)); 735 if (data == 0xFF01) { 736 QL_DPRINT2(ha, (ha->pci_dev, 737 "%s: func[%d] init complete\n", 738 __func__, ha->pci_func)); 739 return(0); 740 } 741 qla_mdelay(__func__, 100); 742 } while (delay--); 743 744 return (-1); 745 } 746 747 /* 748 * Name: ql_init_hw 749 * Function: Initializes P3+ hardware. 750 */ 751 int 752 ql_init_hw(qla_host_t *ha) 753 { 754 device_t dev; 755 int ret = 0; 756 uint32_t val, delay = 300; 757 758 dev = ha->pci_dev; 759 760 QL_DPRINT1(ha, (dev, "%s: enter\n", __func__)); 761 762 if (ha->pci_func & 0x1) { 763 while ((ha->pci_func & 0x1) && delay--) { 764 val = READ_REG32(ha, Q8_CMDPEG_STATE); 765 766 if (val == 0xFF01) { 767 QL_DPRINT2(ha, (dev, 768 "%s: func = %d init complete\n", 769 __func__, ha->pci_func)); 770 qla_mdelay(__func__, 100); 771 goto qla_init_exit; 772 } 773 qla_mdelay(__func__, 100); 774 } 775 ret = -1; 776 goto ql_init_hw_exit; 777 } 778 779 val = READ_REG32(ha, Q8_CMDPEG_STATE); 780 if (!cold || (val != 0xFF01) || ha->qla_initiate_recovery) { 781 ret = qla_init_from_flash(ha); 782 qla_mdelay(__func__, 100); 783 } 784 785 qla_init_exit: 786 ha->fw_ver_major = READ_REG32(ha, Q8_FW_VER_MAJOR); 787 ha->fw_ver_minor = READ_REG32(ha, Q8_FW_VER_MINOR); 788 ha->fw_ver_sub = READ_REG32(ha, Q8_FW_VER_SUB); 789 790 if (qla_get_fdt(ha) != 0) { 791 device_printf(dev, "%s: qla_get_fdt failed\n", __func__); 792 } else { 793 ha->hw.flags.fdt_valid = 1; 794 } 795 796 ql_init_hw_exit: 797 798 if (ret) { 799 if (ha->hw.sp_log_stop_events & Q8_SP_LOG_STOP_HW_INIT_FAILURE) 800 ha->hw.sp_log_stop = -1; 801 } 802 803 return (ret); 804 } 805 806 void 807 ql_read_mac_addr(qla_host_t *ha) 808 { 809 uint8_t *macp; 810 uint32_t mac_lo; 811 uint32_t mac_hi; 812 uint32_t flash_off; 813 814 flash_off = Q8_BOARD_CONFIG_OFFSET + Q8_BOARD_CONFIG_MAC0_LO + 815 (ha->pci_func << 3); 816 ql_rd_flash32(ha, flash_off, &mac_lo); 817 818 flash_off += 4; 819 ql_rd_flash32(ha, flash_off, &mac_hi); 820 821 macp = (uint8_t *)&mac_lo; 822 ha->hw.mac_addr[5] = macp[0]; 823 ha->hw.mac_addr[4] = macp[1]; 824 ha->hw.mac_addr[3] = macp[2]; 825 ha->hw.mac_addr[2] = macp[3]; 826 827 macp = (uint8_t *)&mac_hi; 828 ha->hw.mac_addr[1] = macp[0]; 829 ha->hw.mac_addr[0] = macp[1]; 830 831 //device_printf(ha->pci_dev, "%s: %02x:%02x:%02x:%02x:%02x:%02x\n", 832 // __func__, ha->hw.mac_addr[0], ha->hw.mac_addr[1], 833 // ha->hw.mac_addr[2], ha->hw.mac_addr[3], 834 // ha->hw.mac_addr[4], ha->hw.mac_addr[5]); 835 836 return; 837 } 838 839 /* 840 * Stop/Start/Initialization Handling 841 */ 842 843 static uint16_t 844 qla_tmplt_16bit_checksum(qla_host_t *ha, uint16_t *buf, uint32_t size) 845 { 846 uint32_t sum = 0; 847 uint32_t count = size >> 1; /* size in 16 bit words */ 848 849 while (count-- > 0) 850 sum += *buf++; 851 852 while (sum >> 16) 853 sum = (sum & 0xFFFF) + (sum >> 16); 854 855 return (~sum); 856 } 857 858 static int 859 qla_wr_list(qla_host_t *ha, q8_ce_hdr_t *ce_hdr) 860 { 861 q8_wrl_e_t *wr_l; 862 int i; 863 864 wr_l = (q8_wrl_e_t *)((uint8_t *)ce_hdr + sizeof (q8_ce_hdr_t)); 865 866 for (i = 0; i < ce_hdr->opcount; i++, wr_l++) { 867 if (ql_rdwr_indreg32(ha, wr_l->addr, &wr_l->value, 0)) { 868 device_printf(ha->pci_dev, 869 "%s: [0x%08x 0x%08x] error\n", __func__, 870 wr_l->addr, wr_l->value); 871 return -1; 872 } 873 if (ce_hdr->delay_to) { 874 DELAY(ce_hdr->delay_to); 875 } 876 } 877 return 0; 878 } 879 880 static int 881 qla_rd_wr_list(qla_host_t *ha, q8_ce_hdr_t *ce_hdr) 882 { 883 q8_rdwrl_e_t *rd_wr_l; 884 uint32_t data; 885 int i; 886 887 rd_wr_l = (q8_rdwrl_e_t *)((uint8_t *)ce_hdr + sizeof (q8_ce_hdr_t)); 888 889 for (i = 0; i < ce_hdr->opcount; i++, rd_wr_l++) { 890 if (ql_rdwr_indreg32(ha, rd_wr_l->rd_addr, &data, 1)) { 891 device_printf(ha->pci_dev, "%s: [0x%08x] error\n", 892 __func__, rd_wr_l->rd_addr); 893 894 return -1; 895 } 896 897 if (ql_rdwr_indreg32(ha, rd_wr_l->wr_addr, &data, 0)) { 898 device_printf(ha->pci_dev, 899 "%s: [0x%08x 0x%08x] error\n", __func__, 900 rd_wr_l->wr_addr, data); 901 return -1; 902 } 903 if (ce_hdr->delay_to) { 904 DELAY(ce_hdr->delay_to); 905 } 906 } 907 return 0; 908 } 909 910 static int 911 qla_poll_reg(qla_host_t *ha, uint32_t addr, uint32_t ms_to, uint32_t tmask, 912 uint32_t tvalue) 913 { 914 uint32_t data; 915 916 while (ms_to) { 917 if (ql_rdwr_indreg32(ha, addr, &data, 1)) { 918 device_printf(ha->pci_dev, "%s: [0x%08x] error\n", 919 __func__, addr); 920 return -1; 921 } 922 923 if ((data & tmask) != tvalue) { 924 ms_to--; 925 } else 926 break; 927 928 qla_mdelay(__func__, 1); 929 } 930 return ((ms_to ? 0: -1)); 931 } 932 933 static int 934 qla_poll_list(qla_host_t *ha, q8_ce_hdr_t *ce_hdr) 935 { 936 int i; 937 q8_poll_hdr_t *phdr; 938 q8_poll_e_t *pe; 939 uint32_t data; 940 941 phdr = (q8_poll_hdr_t *)((uint8_t *)ce_hdr + sizeof (q8_ce_hdr_t)); 942 pe = (q8_poll_e_t *)((uint8_t *)phdr + sizeof(q8_poll_hdr_t)); 943 944 for (i = 0; i < ce_hdr->opcount; i++, pe++) { 945 if (ql_rdwr_indreg32(ha, pe->addr, &data, 1)) { 946 device_printf(ha->pci_dev, "%s: [0x%08x] error\n", 947 __func__, pe->addr); 948 return -1; 949 } 950 951 if (ce_hdr->delay_to) { 952 if ((data & phdr->tmask) == phdr->tvalue) 953 break; 954 if (qla_poll_reg(ha, pe->addr, ce_hdr->delay_to, 955 phdr->tmask, phdr->tvalue)) { 956 if (ql_rdwr_indreg32(ha, pe->to_addr, &data, 957 1)) { 958 device_printf(ha->pci_dev, 959 "%s: [0x%08x] error\n", 960 __func__, pe->to_addr); 961 return -1; 962 } 963 964 if (ql_rdwr_indreg32(ha, pe->addr, &data, 1)) { 965 device_printf(ha->pci_dev, 966 "%s: [0x%08x] error\n", 967 __func__, pe->addr); 968 return -1; 969 } 970 } 971 } 972 } 973 return 0; 974 } 975 976 static int 977 qla_poll_write_list(qla_host_t *ha, q8_ce_hdr_t *ce_hdr) 978 { 979 int i; 980 q8_poll_hdr_t *phdr; 981 q8_poll_wr_e_t *wr_e; 982 983 phdr = (q8_poll_hdr_t *)((uint8_t *)ce_hdr + sizeof (q8_ce_hdr_t)); 984 wr_e = (q8_poll_wr_e_t *)((uint8_t *)phdr + sizeof(q8_poll_hdr_t)); 985 986 for (i = 0; i < ce_hdr->opcount; i++, wr_e++) { 987 if (ql_rdwr_indreg32(ha, wr_e->dr_addr, &wr_e->dr_value, 0)) { 988 device_printf(ha->pci_dev, 989 "%s: [0x%08x 0x%08x] error\n", __func__, 990 wr_e->dr_addr, wr_e->dr_value); 991 return -1; 992 } 993 if (ql_rdwr_indreg32(ha, wr_e->ar_addr, &wr_e->ar_value, 0)) { 994 device_printf(ha->pci_dev, 995 "%s: [0x%08x 0x%08x] error\n", __func__, 996 wr_e->ar_addr, wr_e->ar_value); 997 return -1; 998 } 999 if (ce_hdr->delay_to) { 1000 if (qla_poll_reg(ha, wr_e->ar_addr, ce_hdr->delay_to, 1001 phdr->tmask, phdr->tvalue)) 1002 device_printf(ha->pci_dev, "%s: " 1003 "[ar_addr, ar_value, delay, tmask," 1004 "tvalue] [0x%08x 0x%08x 0x%08x 0x%08x" 1005 " 0x%08x]\n", 1006 __func__, wr_e->ar_addr, wr_e->ar_value, 1007 ce_hdr->delay_to, phdr->tmask, 1008 phdr->tvalue); 1009 } 1010 } 1011 return 0; 1012 } 1013 1014 static int 1015 qla_poll_read_list(qla_host_t *ha, q8_ce_hdr_t *ce_hdr) 1016 { 1017 int i; 1018 q8_poll_hdr_t *phdr; 1019 q8_poll_rd_e_t *rd_e; 1020 uint32_t value; 1021 1022 phdr = (q8_poll_hdr_t *)((uint8_t *)ce_hdr + sizeof (q8_ce_hdr_t)); 1023 rd_e = (q8_poll_rd_e_t *)((uint8_t *)phdr + sizeof(q8_poll_hdr_t)); 1024 1025 for (i = 0; i < ce_hdr->opcount; i++, rd_e++) { 1026 if (ql_rdwr_indreg32(ha, rd_e->ar_addr, &rd_e->ar_value, 0)) { 1027 device_printf(ha->pci_dev, 1028 "%s: [0x%08x 0x%08x] error\n", __func__, 1029 rd_e->ar_addr, rd_e->ar_value); 1030 return -1; 1031 } 1032 1033 if (ce_hdr->delay_to) { 1034 if (qla_poll_reg(ha, rd_e->ar_addr, ce_hdr->delay_to, 1035 phdr->tmask, phdr->tvalue)) { 1036 return (-1); 1037 } else { 1038 if (ql_rdwr_indreg32(ha, rd_e->dr_addr, 1039 &value, 1)) { 1040 device_printf(ha->pci_dev, 1041 "%s: [0x%08x] error\n", 1042 __func__, rd_e->ar_addr); 1043 return -1; 1044 } 1045 1046 ha->hw.rst_seq[ha->hw.rst_seq_idx++] = value; 1047 if (ha->hw.rst_seq_idx == Q8_MAX_RESET_SEQ_IDX) 1048 ha->hw.rst_seq_idx = 1; 1049 } 1050 } 1051 } 1052 return 0; 1053 } 1054 1055 static int 1056 qla_rdmwr(qla_host_t *ha, uint32_t raddr, uint32_t waddr, q8_rdmwr_hdr_t *hdr) 1057 { 1058 uint32_t value; 1059 1060 if (hdr->index_a >= Q8_MAX_RESET_SEQ_IDX) { 1061 device_printf(ha->pci_dev, "%s: [0x%08x] error\n", __func__, 1062 hdr->index_a); 1063 return -1; 1064 } 1065 1066 if (hdr->index_a) { 1067 value = ha->hw.rst_seq[hdr->index_a]; 1068 } else { 1069 if (ql_rdwr_indreg32(ha, raddr, &value, 1)) { 1070 device_printf(ha->pci_dev, "%s: [0x%08x] error\n", 1071 __func__, raddr); 1072 return -1; 1073 } 1074 } 1075 1076 value &= hdr->and_value; 1077 value <<= hdr->shl; 1078 value >>= hdr->shr; 1079 value |= hdr->or_value; 1080 value ^= hdr->xor_value; 1081 1082 if (ql_rdwr_indreg32(ha, waddr, &value, 0)) { 1083 device_printf(ha->pci_dev, "%s: [0x%08x] error\n", __func__, 1084 raddr); 1085 return -1; 1086 } 1087 return 0; 1088 } 1089 1090 static int 1091 qla_read_modify_write_list(qla_host_t *ha, q8_ce_hdr_t *ce_hdr) 1092 { 1093 int i; 1094 q8_rdmwr_hdr_t *rdmwr_hdr; 1095 q8_rdmwr_e_t *rdmwr_e; 1096 1097 rdmwr_hdr = (q8_rdmwr_hdr_t *)((uint8_t *)ce_hdr + 1098 sizeof (q8_ce_hdr_t)); 1099 rdmwr_e = (q8_rdmwr_e_t *)((uint8_t *)rdmwr_hdr + 1100 sizeof(q8_rdmwr_hdr_t)); 1101 1102 for (i = 0; i < ce_hdr->opcount; i++, rdmwr_e++) { 1103 if (qla_rdmwr(ha, rdmwr_e->rd_addr, rdmwr_e->wr_addr, 1104 rdmwr_hdr)) { 1105 return -1; 1106 } 1107 if (ce_hdr->delay_to) { 1108 DELAY(ce_hdr->delay_to); 1109 } 1110 } 1111 return 0; 1112 } 1113 1114 static int 1115 qla_tmplt_execute(qla_host_t *ha, uint8_t *buf, int start_idx, int *end_idx, 1116 uint32_t nentries) 1117 { 1118 int i, ret = 0, proc_end = 0; 1119 q8_ce_hdr_t *ce_hdr; 1120 1121 for (i = start_idx; ((i < nentries) && (!proc_end)); i++) { 1122 ce_hdr = (q8_ce_hdr_t *)buf; 1123 ret = 0; 1124 1125 switch (ce_hdr->opcode) { 1126 case Q8_CE_OPCODE_NOP: 1127 break; 1128 1129 case Q8_CE_OPCODE_WRITE_LIST: 1130 ret = qla_wr_list(ha, ce_hdr); 1131 //printf("qla_wr_list %d\n", ret); 1132 break; 1133 1134 case Q8_CE_OPCODE_READ_WRITE_LIST: 1135 ret = qla_rd_wr_list(ha, ce_hdr); 1136 //printf("qla_rd_wr_list %d\n", ret); 1137 break; 1138 1139 case Q8_CE_OPCODE_POLL_LIST: 1140 ret = qla_poll_list(ha, ce_hdr); 1141 //printf("qla_poll_list %d\n", ret); 1142 break; 1143 1144 case Q8_CE_OPCODE_POLL_WRITE_LIST: 1145 ret = qla_poll_write_list(ha, ce_hdr); 1146 //printf("qla_poll_write_list %d\n", ret); 1147 break; 1148 1149 case Q8_CE_OPCODE_POLL_RD_LIST: 1150 ret = qla_poll_read_list(ha, ce_hdr); 1151 //printf("qla_poll_read_list %d\n", ret); 1152 break; 1153 1154 case Q8_CE_OPCODE_READ_MODIFY_WRITE: 1155 ret = qla_read_modify_write_list(ha, ce_hdr); 1156 //printf("qla_read_modify_write_list %d\n", ret); 1157 break; 1158 1159 case Q8_CE_OPCODE_SEQ_PAUSE: 1160 if (ce_hdr->delay_to) { 1161 qla_mdelay(__func__, ce_hdr->delay_to); 1162 } 1163 break; 1164 1165 case Q8_CE_OPCODE_SEQ_END: 1166 proc_end = 1; 1167 break; 1168 1169 case Q8_CE_OPCODE_TMPLT_END: 1170 *end_idx = i; 1171 return 0; 1172 } 1173 1174 if (ret) 1175 break; 1176 1177 buf += ce_hdr->size; 1178 } 1179 *end_idx = i; 1180 1181 return (ret); 1182 } 1183 1184 #ifndef QL_LDFLASH_FW 1185 static int 1186 qla_load_offchip_mem(qla_host_t *ha, uint64_t addr, uint32_t *data32, 1187 uint32_t len32) 1188 { 1189 q80_offchip_mem_val_t val; 1190 int ret = 0; 1191 1192 while (len32) { 1193 if (len32 > 4) { 1194 val.data_lo = *data32++; 1195 val.data_hi = *data32++; 1196 val.data_ulo = *data32++; 1197 val.data_uhi = *data32++; 1198 len32 -= 4; 1199 if (ql_rdwr_offchip_mem(ha, addr, &val, 0)) 1200 return -1; 1201 1202 addr += (uint64_t)16; 1203 } else { 1204 break; 1205 } 1206 } 1207 1208 bzero(&val, sizeof(q80_offchip_mem_val_t)); 1209 1210 switch (len32) { 1211 case 3: 1212 val.data_lo = *data32++; 1213 val.data_hi = *data32++; 1214 val.data_ulo = *data32++; 1215 ret = ql_rdwr_offchip_mem(ha, addr, &val, 0); 1216 break; 1217 1218 case 2: 1219 val.data_lo = *data32++; 1220 val.data_hi = *data32++; 1221 ret = ql_rdwr_offchip_mem(ha, addr, &val, 0); 1222 break; 1223 1224 case 1: 1225 val.data_lo = *data32++; 1226 ret = ql_rdwr_offchip_mem(ha, addr, &val, 0); 1227 break; 1228 1229 default: 1230 break; 1231 } 1232 return ret; 1233 } 1234 1235 static int 1236 qla_load_bootldr(qla_host_t *ha) 1237 { 1238 uint64_t addr; 1239 uint32_t *data32; 1240 uint32_t len32; 1241 int ret; 1242 1243 addr = (uint64_t)(READ_REG32(ha, Q8_BOOTLD_ADDR)); 1244 data32 = (uint32_t *)ql83xx_bootloader; 1245 len32 = ql83xx_bootloader_len >> 2; 1246 1247 ret = qla_load_offchip_mem(ha, addr, data32, len32); 1248 1249 return (ret); 1250 } 1251 1252 static int 1253 qla_load_fwimage(qla_host_t *ha) 1254 { 1255 uint64_t addr; 1256 uint32_t *data32; 1257 uint32_t len32; 1258 int ret; 1259 1260 addr = (uint64_t)(READ_REG32(ha, Q8_FW_IMAGE_ADDR)); 1261 data32 = (uint32_t *)ql83xx_firmware; 1262 len32 = ql83xx_firmware_len >> 2; 1263 1264 ret = qla_load_offchip_mem(ha, addr, data32, len32); 1265 1266 return (ret); 1267 } 1268 #endif /* #ifndef QL_LDFLASH_FW */ 1269 1270 static int 1271 qla_ld_fw_init(qla_host_t *ha) 1272 { 1273 uint8_t *buf; 1274 uint32_t index = 0, end_idx; 1275 q8_tmplt_hdr_t *hdr; 1276 1277 bzero(ha->hw.rst_seq, sizeof (ha->hw.rst_seq)); 1278 1279 hdr = (q8_tmplt_hdr_t *)ql83xx_resetseq; 1280 1281 device_printf(ha->pci_dev, "%s: reset sequence\n", __func__); 1282 if (qla_tmplt_16bit_checksum(ha, (uint16_t *)ql83xx_resetseq, 1283 (uint32_t)hdr->size)) { 1284 device_printf(ha->pci_dev, "%s: reset seq checksum failed\n", 1285 __func__); 1286 return -1; 1287 } 1288 1289 buf = ql83xx_resetseq + hdr->stop_seq_off; 1290 1291 device_printf(ha->pci_dev, "%s: stop sequence\n", __func__); 1292 if (qla_tmplt_execute(ha, buf, index , &end_idx, hdr->nentries)) { 1293 device_printf(ha->pci_dev, "%s: stop seq failed\n", __func__); 1294 return -1; 1295 } 1296 1297 index = end_idx; 1298 1299 buf = ql83xx_resetseq + hdr->init_seq_off; 1300 1301 device_printf(ha->pci_dev, "%s: init sequence\n", __func__); 1302 if (qla_tmplt_execute(ha, buf, index , &end_idx, hdr->nentries)) { 1303 device_printf(ha->pci_dev, "%s: init seq failed\n", __func__); 1304 return -1; 1305 } 1306 1307 #ifdef QL_LDFLASH_FW 1308 qla_load_fw_from_flash(ha); 1309 WRITE_REG32(ha, Q8_FW_IMAGE_VALID, 0); 1310 #else 1311 if (qla_load_bootldr(ha)) 1312 return -1; 1313 1314 if (qla_load_fwimage(ha)) 1315 return -1; 1316 1317 WRITE_REG32(ha, Q8_FW_IMAGE_VALID, 0x12345678); 1318 #endif /* #ifdef QL_LDFLASH_FW */ 1319 1320 index = end_idx; 1321 buf = ql83xx_resetseq + hdr->start_seq_off; 1322 1323 device_printf(ha->pci_dev, "%s: start sequence\n", __func__); 1324 if (qla_tmplt_execute(ha, buf, index , &end_idx, hdr->nentries)) { 1325 device_printf(ha->pci_dev, "%s: init seq failed\n", __func__); 1326 return -1; 1327 } 1328 1329 return 0; 1330 } 1331 1332 int 1333 ql_stop_sequence(qla_host_t *ha) 1334 { 1335 uint8_t *buf; 1336 uint32_t index = 0, end_idx; 1337 q8_tmplt_hdr_t *hdr; 1338 1339 bzero(ha->hw.rst_seq, sizeof (ha->hw.rst_seq)); 1340 1341 hdr = (q8_tmplt_hdr_t *)ql83xx_resetseq; 1342 1343 if (qla_tmplt_16bit_checksum(ha, (uint16_t *)ql83xx_resetseq, 1344 (uint32_t)hdr->size)) { 1345 device_printf(ha->pci_dev, "%s: reset seq checksum failed\n", 1346 __func__); 1347 return (-1); 1348 } 1349 1350 buf = ql83xx_resetseq + hdr->stop_seq_off; 1351 1352 device_printf(ha->pci_dev, "%s: stop sequence\n", __func__); 1353 if (qla_tmplt_execute(ha, buf, index , &end_idx, hdr->nentries)) { 1354 device_printf(ha->pci_dev, "%s: stop seq failed\n", __func__); 1355 return (-1); 1356 } 1357 1358 return end_idx; 1359 } 1360 1361 int 1362 ql_start_sequence(qla_host_t *ha, uint16_t index) 1363 { 1364 uint8_t *buf; 1365 uint32_t end_idx; 1366 q8_tmplt_hdr_t *hdr; 1367 1368 bzero(ha->hw.rst_seq, sizeof (ha->hw.rst_seq)); 1369 1370 hdr = (q8_tmplt_hdr_t *)ql83xx_resetseq; 1371 1372 if (qla_tmplt_16bit_checksum(ha, (uint16_t *)ql83xx_resetseq, 1373 (uint32_t)hdr->size)) { 1374 device_printf(ha->pci_dev, "%s: reset seq checksum failed\n", 1375 __func__); 1376 return (-1); 1377 } 1378 1379 buf = ql83xx_resetseq + hdr->init_seq_off; 1380 1381 device_printf(ha->pci_dev, "%s: init sequence\n", __func__); 1382 if (qla_tmplt_execute(ha, buf, index , &end_idx, hdr->nentries)) { 1383 device_printf(ha->pci_dev, "%s: init seq failed\n", __func__); 1384 return (-1); 1385 } 1386 1387 #ifdef QL_LDFLASH_FW 1388 qla_load_fw_from_flash(ha); 1389 WRITE_REG32(ha, Q8_FW_IMAGE_VALID, 0); 1390 #else 1391 if (qla_load_bootldr(ha)) 1392 return -1; 1393 1394 if (qla_load_fwimage(ha)) 1395 return -1; 1396 1397 WRITE_REG32(ha, Q8_FW_IMAGE_VALID, 0x12345678); 1398 #endif /* #ifdef QL_LDFLASH_FW */ 1399 1400 index = end_idx; 1401 buf = ql83xx_resetseq + hdr->start_seq_off; 1402 1403 device_printf(ha->pci_dev, "%s: start sequence\n", __func__); 1404 if (qla_tmplt_execute(ha, buf, index , &end_idx, hdr->nentries)) { 1405 device_printf(ha->pci_dev, "%s: init seq failed\n", __func__); 1406 return -1; 1407 } 1408 1409 return (0); 1410 } 1411