1 files changed, 61 insertions, 0 deletions

diff --git a/drivers/scsi/qla2xxx/qla_init.c b/drivers/scsi/qla2xxx/qla_init.c
index 13e2aaf56769..dadc91bd0ea9 100644
--- a/drivers/scsi/qla2xxx/qla_init.c
+++ b/drivers/scsi/qla2xxx/qla_init.c
@@ -3550,6 +3550,67 @@ qla2x00_load_risc(scsi_qla_host_t *ha, uint32_t *srisc_addr)
 }
 
 int
+qla24xx_load_risc(scsi_qla_host_t *ha, uint32_t *srisc_addr)
+{
+        int     rval, num, i;
+        uint32_t cnt;
+        uint32_t *risc_code;
+        uint32_t risc_addr, risc_size;
+        uint32_t *req_ring;
+        struct qla_fw_info *fw_iter;
+
+        rval = QLA_SUCCESS;
+
+        /* Load firmware sequences */
+        fw_iter = ha->brd_info->fw_info;
+        *srisc_addr = *((uint32_t *)fw_iter->lfwstart);
+        while (fw_iter->addressing != FW_INFO_ADDR_NOMORE) {
+                risc_code = (uint32_t *)fw_iter->fwcode;
+                risc_size = *((uint32_t *)fw_iter->fwlen);
+                risc_addr = *((uint32_t *)fw_iter->lfwstart);
+
+                num = 0;
+                rval = 0;
+                while (risc_size > 0 && !rval) {
+                        cnt = (uint32_t)(ha->fw_transfer_size >> 2);
+                        if (cnt > risc_size)
+                                cnt = risc_size;
+
+                        DEBUG7(printk("scsi(%ld): Loading risc segment@ "
+                            "addr %p, number of bytes 0x%x, offset 0x%lx.\n",
+                            ha->host_no, risc_code, cnt, risc_addr));
+
+                        req_ring = (uint32_t *)ha->request_ring;
+                        for (i = 0; i < cnt; i++)
+                                req_ring[i] = cpu_to_le32(risc_code[i]);
+
+                        rval = qla2x00_load_ram(ha, ha->request_dma, risc_addr,
+                            cnt);
+                        if (rval) {
+                                DEBUG(printk("scsi(%ld): [ERROR] Failed to "
+                                    "load segment %d of firmware\n",
+                                    ha->host_no, num));
+                                qla_printk(KERN_WARNING, ha,
+                                    "[ERROR] Failed to load segment %d of "
+                                    "firmware\n", num);
+
+                                qla2x00_dump_regs(ha);
+                                break;
+                        }
+
+                        risc_code += cnt;
+                        risc_addr += cnt;
+                        risc_size -= cnt;
+                        num++;
+                }
+
+                /* Next firmware sequence */
+                fw_iter++;
+        }
+        return rval;
+}
+
+int
 qla24xx_load_risc_flash(scsi_qla_host_t *ha, uint32_t *srisc_addr)
 {
         int     rval;