linux/drivers/scsi/qla2xxx/qla_tmpl.c
<<
>>
Prefs
   1/*
   2 * QLogic Fibre Channel HBA Driver
   3 * Copyright (c)  2003-2014 QLogic Corporation
   4 *
   5 * See LICENSE.qla2xxx for copyright and licensing details.
   6 */
   7#include "qla_def.h"
   8#include "qla_tmpl.h"
   9
  10/* note default template is in big endian */
  11static const uint32_t ql27xx_fwdt_default_template[] = {
  12        0x63000000, 0xa4000000, 0x7c050000, 0x00000000,
  13        0x30000000, 0x01000000, 0x00000000, 0xc0406eb4,
  14        0x00000000, 0x00000000, 0x00000000, 0x00000000,
  15        0x00000000, 0x00000000, 0x00000000, 0x00000000,
  16        0x00000000, 0x00000000, 0x00000000, 0x00000000,
  17        0x00000000, 0x00000000, 0x00000000, 0x00000000,
  18        0x00000000, 0x00000000, 0x00000000, 0x00000000,
  19        0x00000000, 0x00000000, 0x00000000, 0x00000000,
  20        0x00000000, 0x00000000, 0x00000000, 0x00000000,
  21        0x00000000, 0x00000000, 0x00000000, 0x00000000,
  22        0x00000000, 0x04010000, 0x14000000, 0x00000000,
  23        0x02000000, 0x44000000, 0x09010000, 0x10000000,
  24        0x00000000, 0x02000000, 0x01010000, 0x1c000000,
  25        0x00000000, 0x02000000, 0x00600000, 0x00000000,
  26        0xc0000000, 0x01010000, 0x1c000000, 0x00000000,
  27        0x02000000, 0x00600000, 0x00000000, 0xcc000000,
  28        0x01010000, 0x1c000000, 0x00000000, 0x02000000,
  29        0x10600000, 0x00000000, 0xd4000000, 0x01010000,
  30        0x1c000000, 0x00000000, 0x02000000, 0x700f0000,
  31        0x00000060, 0xf0000000, 0x00010000, 0x18000000,
  32        0x00000000, 0x02000000, 0x00700000, 0x041000c0,
  33        0x00010000, 0x18000000, 0x00000000, 0x02000000,
  34        0x10700000, 0x041000c0, 0x00010000, 0x18000000,
  35        0x00000000, 0x02000000, 0x40700000, 0x041000c0,
  36        0x01010000, 0x1c000000, 0x00000000, 0x02000000,
  37        0x007c0000, 0x01000000, 0xc0000000, 0x00010000,
  38        0x18000000, 0x00000000, 0x02000000, 0x007c0000,
  39        0x040300c4, 0x00010000, 0x18000000, 0x00000000,
  40        0x02000000, 0x007c0000, 0x040100c0, 0x01010000,
  41        0x1c000000, 0x00000000, 0x02000000, 0x007c0000,
  42        0x00000000, 0xc0000000, 0x00010000, 0x18000000,
  43        0x00000000, 0x02000000, 0x007c0000, 0x04200000,
  44        0x0b010000, 0x18000000, 0x00000000, 0x02000000,
  45        0x0c000000, 0x00000000, 0x02010000, 0x20000000,
  46        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  47        0xf0000000, 0x000000b0, 0x02010000, 0x20000000,
  48        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  49        0xf0000000, 0x000010b0, 0x02010000, 0x20000000,
  50        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  51        0xf0000000, 0x000020b0, 0x02010000, 0x20000000,
  52        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  53        0xf0000000, 0x000030b0, 0x02010000, 0x20000000,
  54        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  55        0xf0000000, 0x000040b0, 0x02010000, 0x20000000,
  56        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  57        0xf0000000, 0x000050b0, 0x02010000, 0x20000000,
  58        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  59        0xf0000000, 0x000060b0, 0x02010000, 0x20000000,
  60        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  61        0xf0000000, 0x000070b0, 0x02010000, 0x20000000,
  62        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  63        0xf0000000, 0x000080b0, 0x02010000, 0x20000000,
  64        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  65        0xf0000000, 0x000090b0, 0x02010000, 0x20000000,
  66        0x00000000, 0x02000000, 0x700f0000, 0x040100fc,
  67        0xf0000000, 0x0000a0b0, 0x00010000, 0x18000000,
  68        0x00000000, 0x02000000, 0x0a000000, 0x040100c0,
  69        0x00010000, 0x18000000, 0x00000000, 0x02000000,
  70        0x0a000000, 0x04200080, 0x00010000, 0x18000000,
  71        0x00000000, 0x02000000, 0x00be0000, 0x041000c0,
  72        0x00010000, 0x18000000, 0x00000000, 0x02000000,
  73        0x10be0000, 0x041000c0, 0x00010000, 0x18000000,
  74        0x00000000, 0x02000000, 0x20be0000, 0x041000c0,
  75        0x00010000, 0x18000000, 0x00000000, 0x02000000,
  76        0x30be0000, 0x041000c0, 0x00010000, 0x18000000,
  77        0x00000000, 0x02000000, 0x00b00000, 0x041000c0,
  78        0x00010000, 0x18000000, 0x00000000, 0x02000000,
  79        0x10b00000, 0x041000c0, 0x00010000, 0x18000000,
  80        0x00000000, 0x02000000, 0x20b00000, 0x041000c0,
  81        0x00010000, 0x18000000, 0x00000000, 0x02000000,
  82        0x30b00000, 0x041000c0, 0x00010000, 0x18000000,
  83        0x00000000, 0x02000000, 0x00300000, 0x041000c0,
  84        0x00010000, 0x18000000, 0x00000000, 0x02000000,
  85        0x10300000, 0x041000c0, 0x00010000, 0x18000000,
  86        0x00000000, 0x02000000, 0x20300000, 0x041000c0,
  87        0x00010000, 0x18000000, 0x00000000, 0x02000000,
  88        0x30300000, 0x041000c0, 0x0a010000, 0x10000000,
  89        0x00000000, 0x02000000, 0x06010000, 0x1c000000,
  90        0x00000000, 0x02000000, 0x01000000, 0x00000200,
  91        0xff230200, 0x06010000, 0x1c000000, 0x00000000,
  92        0x02000000, 0x02000000, 0x00001000, 0x00000000,
  93        0x07010000, 0x18000000, 0x00000000, 0x02000000,
  94        0x00000000, 0x01000000, 0x07010000, 0x18000000,
  95        0x00000000, 0x02000000, 0x00000000, 0x02000000,
  96        0x07010000, 0x18000000, 0x00000000, 0x02000000,
  97        0x00000000, 0x03000000, 0x0d010000, 0x14000000,
  98        0x00000000, 0x02000000, 0x00000000, 0xff000000,
  99        0x10000000, 0x00000000, 0x00000080,
 100};
 101
 102static inline void __iomem *
 103qla27xx_isp_reg(struct scsi_qla_host *vha)
 104{
 105        return &vha->hw->iobase->isp24;
 106}
 107
 108static inline void
 109qla27xx_insert16(uint16_t value, void *buf, ulong *len)
 110{
 111        if (buf) {
 112                buf += *len;
 113                *(__le16 *)buf = cpu_to_le16(value);
 114        }
 115        *len += sizeof(value);
 116}
 117
 118static inline void
 119qla27xx_insert32(uint32_t value, void *buf, ulong *len)
 120{
 121        if (buf) {
 122                buf += *len;
 123                *(__le32 *)buf = cpu_to_le32(value);
 124        }
 125        *len += sizeof(value);
 126}
 127
 128static inline void
 129qla27xx_insertbuf(void *mem, ulong size, void *buf, ulong *len)
 130{
 131
 132        if (buf && mem && size) {
 133                buf += *len;
 134                memcpy(buf, mem, size);
 135        }
 136        *len += size;
 137}
 138
 139static inline void
 140qla27xx_read8(void __iomem *window, void *buf, ulong *len)
 141{
 142        uint8_t value = ~0;
 143
 144        if (buf) {
 145                value = RD_REG_BYTE(window);
 146        }
 147        qla27xx_insert32(value, buf, len);
 148}
 149
 150static inline void
 151qla27xx_read16(void __iomem *window, void *buf, ulong *len)
 152{
 153        uint16_t value = ~0;
 154
 155        if (buf) {
 156                value = RD_REG_WORD(window);
 157        }
 158        qla27xx_insert32(value, buf, len);
 159}
 160
 161static inline void
 162qla27xx_read32(void __iomem *window, void *buf, ulong *len)
 163{
 164        uint32_t value = ~0;
 165
 166        if (buf) {
 167                value = RD_REG_DWORD(window);
 168        }
 169        qla27xx_insert32(value, buf, len);
 170}
 171
 172static inline void (*qla27xx_read_vector(uint width))(void __iomem*, void *, ulong *)
 173{
 174        return
 175            (width == 1) ? qla27xx_read8 :
 176            (width == 2) ? qla27xx_read16 :
 177                           qla27xx_read32;
 178}
 179
 180static inline void
 181qla27xx_read_reg(__iomem struct device_reg_24xx *reg,
 182        uint offset, void *buf, ulong *len)
 183{
 184        void __iomem *window = (void __iomem *)reg + offset;
 185
 186        qla27xx_read32(window, buf, len);
 187}
 188
 189static inline void
 190qla27xx_write_reg(__iomem struct device_reg_24xx *reg,
 191        uint offset, uint32_t data, void *buf)
 192{
 193        __iomem void *window = (void __iomem *)reg + offset;
 194
 195        if (buf) {
 196                WRT_REG_DWORD(window, data);
 197        }
 198}
 199
 200static inline void
 201qla27xx_read_window(__iomem struct device_reg_24xx *reg,
 202        uint32_t addr, uint offset, uint count, uint width, void *buf,
 203        ulong *len)
 204{
 205        void __iomem *window = (void __iomem *)reg + offset;
 206        void (*readn)(void __iomem*, void *, ulong *) = qla27xx_read_vector(width);
 207
 208        qla27xx_write_reg(reg, IOBASE_ADDR, addr, buf);
 209        while (count--) {
 210                qla27xx_insert32(addr, buf, len);
 211                readn(window, buf, len);
 212                window += width;
 213                addr++;
 214        }
 215}
 216
 217static inline void
 218qla27xx_skip_entry(struct qla27xx_fwdt_entry *ent, void *buf)
 219{
 220        if (buf)
 221                ent->hdr.driver_flags |= DRIVER_FLAG_SKIP_ENTRY;
 222}
 223
 224static int
 225qla27xx_fwdt_entry_t0(struct scsi_qla_host *vha,
 226        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 227{
 228        ql_dbg(ql_dbg_misc, vha, 0xd100,
 229            "%s: nop [%lx]\n", __func__, *len);
 230        qla27xx_skip_entry(ent, buf);
 231
 232        return false;
 233}
 234
 235static int
 236qla27xx_fwdt_entry_t255(struct scsi_qla_host *vha,
 237        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 238{
 239        ql_dbg(ql_dbg_misc, vha, 0xd1ff,
 240            "%s: end [%lx]\n", __func__, *len);
 241        qla27xx_skip_entry(ent, buf);
 242
 243        /* terminate */
 244        return true;
 245}
 246
 247static int
 248qla27xx_fwdt_entry_t256(struct scsi_qla_host *vha,
 249        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 250{
 251        struct device_reg_24xx __iomem *reg = qla27xx_isp_reg(vha);
 252
 253        ql_dbg(ql_dbg_misc, vha, 0xd200,
 254            "%s: rdio t1 [%lx]\n", __func__, *len);
 255        qla27xx_read_window(reg, ent->t256.base_addr, ent->t256.pci_offset,
 256            ent->t256.reg_count, ent->t256.reg_width, buf, len);
 257
 258        return false;
 259}
 260
 261static int
 262qla27xx_fwdt_entry_t257(struct scsi_qla_host *vha,
 263        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 264{
 265        struct device_reg_24xx __iomem *reg = qla27xx_isp_reg(vha);
 266
 267        ql_dbg(ql_dbg_misc, vha, 0xd201,
 268            "%s: wrio t1 [%lx]\n", __func__, *len);
 269        qla27xx_write_reg(reg, IOBASE_ADDR, ent->t257.base_addr, buf);
 270        qla27xx_write_reg(reg, ent->t257.pci_offset, ent->t257.write_data, buf);
 271
 272        return false;
 273}
 274
 275static int
 276qla27xx_fwdt_entry_t258(struct scsi_qla_host *vha,
 277        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 278{
 279        struct device_reg_24xx __iomem *reg = qla27xx_isp_reg(vha);
 280
 281        ql_dbg(ql_dbg_misc, vha, 0xd202,
 282            "%s: rdio t2 [%lx]\n", __func__, *len);
 283        qla27xx_write_reg(reg, ent->t258.banksel_offset, ent->t258.bank, buf);
 284        qla27xx_read_window(reg, ent->t258.base_addr, ent->t258.pci_offset,
 285            ent->t258.reg_count, ent->t258.reg_width, buf, len);
 286
 287        return false;
 288}
 289
 290static int
 291qla27xx_fwdt_entry_t259(struct scsi_qla_host *vha,
 292        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 293{
 294        struct device_reg_24xx __iomem *reg = qla27xx_isp_reg(vha);
 295
 296        ql_dbg(ql_dbg_misc, vha, 0xd203,
 297            "%s: wrio t2 [%lx]\n", __func__, *len);
 298        qla27xx_write_reg(reg, IOBASE_ADDR, ent->t259.base_addr, buf);
 299        qla27xx_write_reg(reg, ent->t259.banksel_offset, ent->t259.bank, buf);
 300        qla27xx_write_reg(reg, ent->t259.pci_offset, ent->t259.write_data, buf);
 301
 302        return false;
 303}
 304
 305static int
 306qla27xx_fwdt_entry_t260(struct scsi_qla_host *vha,
 307        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 308{
 309        struct device_reg_24xx __iomem *reg = qla27xx_isp_reg(vha);
 310
 311        ql_dbg(ql_dbg_misc, vha, 0xd204,
 312            "%s: rdpci [%lx]\n", __func__, *len);
 313        qla27xx_insert32(ent->t260.pci_offset, buf, len);
 314        qla27xx_read_reg(reg, ent->t260.pci_offset, buf, len);
 315
 316        return false;
 317}
 318
 319static int
 320qla27xx_fwdt_entry_t261(struct scsi_qla_host *vha,
 321        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 322{
 323        struct device_reg_24xx __iomem *reg = qla27xx_isp_reg(vha);
 324
 325        ql_dbg(ql_dbg_misc, vha, 0xd205,
 326            "%s: wrpci [%lx]\n", __func__, *len);
 327        qla27xx_write_reg(reg, ent->t261.pci_offset, ent->t261.write_data, buf);
 328
 329        return false;
 330}
 331
 332static int
 333qla27xx_fwdt_entry_t262(struct scsi_qla_host *vha,
 334        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 335{
 336        ulong dwords;
 337        ulong start;
 338        ulong end;
 339
 340        ql_dbg(ql_dbg_misc, vha, 0xd206,
 341            "%s: rdram(%x) [%lx]\n", __func__, ent->t262.ram_area, *len);
 342        start = ent->t262.start_addr;
 343        end = ent->t262.end_addr;
 344
 345        if (ent->t262.ram_area == T262_RAM_AREA_CRITICAL_RAM) {
 346                ;
 347        } else if (ent->t262.ram_area == T262_RAM_AREA_EXTERNAL_RAM) {
 348                end = vha->hw->fw_memory_size;
 349                if (buf)
 350                        ent->t262.end_addr = end;
 351        } else if (ent->t262.ram_area == T262_RAM_AREA_SHARED_RAM) {
 352                start = vha->hw->fw_shared_ram_start;
 353                end = vha->hw->fw_shared_ram_end;
 354                if (buf) {
 355                        ent->t262.start_addr = start;
 356                        ent->t262.end_addr = end;
 357                }
 358        } else if (ent->t262.ram_area == T262_RAM_AREA_DDR_RAM) {
 359                start = vha->hw->fw_ddr_ram_start;
 360                end = vha->hw->fw_ddr_ram_end;
 361                if (buf) {
 362                        ent->t262.start_addr = start;
 363                        ent->t262.end_addr = end;
 364                }
 365        } else {
 366                ql_dbg(ql_dbg_misc, vha, 0xd022,
 367                    "%s: unknown area %x\n", __func__, ent->t262.ram_area);
 368                qla27xx_skip_entry(ent, buf);
 369                goto done;
 370        }
 371
 372        if (end < start || start == 0 || end == 0) {
 373                ql_dbg(ql_dbg_misc, vha, 0xd023,
 374                    "%s: unusable range (start=%x end=%x)\n", __func__,
 375                    ent->t262.end_addr, ent->t262.start_addr);
 376                qla27xx_skip_entry(ent, buf);
 377                goto done;
 378        }
 379
 380        dwords = end - start + 1;
 381        if (buf) {
 382                buf += *len;
 383                qla24xx_dump_ram(vha->hw, start, buf, dwords, &buf);
 384        }
 385        *len += dwords * sizeof(uint32_t);
 386done:
 387        return false;
 388}
 389
 390static int
 391qla27xx_fwdt_entry_t263(struct scsi_qla_host *vha,
 392        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 393{
 394        uint count = 0;
 395        uint i;
 396        uint length;
 397
 398        ql_dbg(ql_dbg_misc, vha, 0xd207,
 399            "%s: getq(%x) [%lx]\n", __func__, ent->t263.queue_type, *len);
 400        if (ent->t263.queue_type == T263_QUEUE_TYPE_REQ) {
 401                for (i = 0; i < vha->hw->max_req_queues; i++) {
 402                        struct req_que *req = vha->hw->req_q_map[i];
 403
 404                        if (req || !buf) {
 405                                length = req ?
 406                                    req->length : REQUEST_ENTRY_CNT_24XX;
 407                                qla27xx_insert16(i, buf, len);
 408                                qla27xx_insert16(length, buf, len);
 409                                qla27xx_insertbuf(req ? req->ring : NULL,
 410                                    length * sizeof(*req->ring), buf, len);
 411                                count++;
 412                        }
 413                }
 414        } else if (ent->t263.queue_type == T263_QUEUE_TYPE_RSP) {
 415                for (i = 0; i < vha->hw->max_rsp_queues; i++) {
 416                        struct rsp_que *rsp = vha->hw->rsp_q_map[i];
 417
 418                        if (rsp || !buf) {
 419                                length = rsp ?
 420                                    rsp->length : RESPONSE_ENTRY_CNT_MQ;
 421                                qla27xx_insert16(i, buf, len);
 422                                qla27xx_insert16(length, buf, len);
 423                                qla27xx_insertbuf(rsp ? rsp->ring : NULL,
 424                                    length * sizeof(*rsp->ring), buf, len);
 425                                count++;
 426                        }
 427                }
 428        } else if (QLA_TGT_MODE_ENABLED() &&
 429            ent->t263.queue_type == T263_QUEUE_TYPE_ATIO) {
 430                struct qla_hw_data *ha = vha->hw;
 431                struct atio *atr = ha->tgt.atio_ring;
 432
 433                if (atr || !buf) {
 434                        length = ha->tgt.atio_q_length;
 435                        qla27xx_insert16(0, buf, len);
 436                        qla27xx_insert16(length, buf, len);
 437                        qla27xx_insertbuf(atr, length * sizeof(*atr), buf, len);
 438                        count++;
 439                }
 440        } else {
 441                ql_dbg(ql_dbg_misc, vha, 0xd026,
 442                    "%s: unknown queue %x\n", __func__, ent->t263.queue_type);
 443                qla27xx_skip_entry(ent, buf);
 444        }
 445
 446        if (buf) {
 447                if (count)
 448                        ent->t263.num_queues = count;
 449                else
 450                        qla27xx_skip_entry(ent, buf);
 451        }
 452
 453        return false;
 454}
 455
 456static int
 457qla27xx_fwdt_entry_t264(struct scsi_qla_host *vha,
 458        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 459{
 460        ql_dbg(ql_dbg_misc, vha, 0xd208,
 461            "%s: getfce [%lx]\n", __func__, *len);
 462        if (vha->hw->fce) {
 463                if (buf) {
 464                        ent->t264.fce_trace_size = FCE_SIZE;
 465                        ent->t264.write_pointer = vha->hw->fce_wr;
 466                        ent->t264.base_pointer = vha->hw->fce_dma;
 467                        ent->t264.fce_enable_mb0 = vha->hw->fce_mb[0];
 468                        ent->t264.fce_enable_mb2 = vha->hw->fce_mb[2];
 469                        ent->t264.fce_enable_mb3 = vha->hw->fce_mb[3];
 470                        ent->t264.fce_enable_mb4 = vha->hw->fce_mb[4];
 471                        ent->t264.fce_enable_mb5 = vha->hw->fce_mb[5];
 472                        ent->t264.fce_enable_mb6 = vha->hw->fce_mb[6];
 473                }
 474                qla27xx_insertbuf(vha->hw->fce, FCE_SIZE, buf, len);
 475        } else {
 476                ql_dbg(ql_dbg_misc, vha, 0xd027,
 477                    "%s: missing fce\n", __func__);
 478                qla27xx_skip_entry(ent, buf);
 479        }
 480
 481        return false;
 482}
 483
 484static int
 485qla27xx_fwdt_entry_t265(struct scsi_qla_host *vha,
 486        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 487{
 488        struct device_reg_24xx __iomem *reg = qla27xx_isp_reg(vha);
 489
 490        ql_dbg(ql_dbg_misc, vha, 0xd209,
 491            "%s: pause risc [%lx]\n", __func__, *len);
 492        if (buf)
 493                qla24xx_pause_risc(reg, vha->hw);
 494
 495        return false;
 496}
 497
 498static int
 499qla27xx_fwdt_entry_t266(struct scsi_qla_host *vha,
 500        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 501{
 502        ql_dbg(ql_dbg_misc, vha, 0xd20a,
 503            "%s: reset risc [%lx]\n", __func__, *len);
 504        if (buf)
 505                qla24xx_soft_reset(vha->hw);
 506
 507        return false;
 508}
 509
 510static int
 511qla27xx_fwdt_entry_t267(struct scsi_qla_host *vha,
 512        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 513{
 514        struct device_reg_24xx __iomem *reg = qla27xx_isp_reg(vha);
 515
 516        ql_dbg(ql_dbg_misc, vha, 0xd20b,
 517            "%s: dis intr [%lx]\n", __func__, *len);
 518        qla27xx_write_reg(reg, ent->t267.pci_offset, ent->t267.data, buf);
 519
 520        return false;
 521}
 522
 523static int
 524qla27xx_fwdt_entry_t268(struct scsi_qla_host *vha,
 525        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 526{
 527        ql_dbg(ql_dbg_misc, vha, 0xd20c,
 528            "%s: gethb(%x) [%lx]\n", __func__, ent->t268.buf_type, *len);
 529        switch (ent->t268.buf_type) {
 530        case T268_BUF_TYPE_EXTD_TRACE:
 531                if (vha->hw->eft) {
 532                        if (buf) {
 533                                ent->t268.buf_size = EFT_SIZE;
 534                                ent->t268.start_addr = vha->hw->eft_dma;
 535                        }
 536                        qla27xx_insertbuf(vha->hw->eft, EFT_SIZE, buf, len);
 537                } else {
 538                        ql_dbg(ql_dbg_misc, vha, 0xd028,
 539                            "%s: missing eft\n", __func__);
 540                        qla27xx_skip_entry(ent, buf);
 541                }
 542                break;
 543        case T268_BUF_TYPE_EXCH_BUFOFF:
 544                if (vha->hw->exchoffld_buf) {
 545                        if (buf) {
 546                                ent->t268.buf_size = vha->hw->exchoffld_size;
 547                                ent->t268.start_addr =
 548                                        vha->hw->exchoffld_buf_dma;
 549                        }
 550                        qla27xx_insertbuf(vha->hw->exchoffld_buf,
 551                            vha->hw->exchoffld_size, buf, len);
 552                } else {
 553                        ql_dbg(ql_dbg_misc, vha, 0xd028,
 554                            "%s: missing exch offld\n", __func__);
 555                        qla27xx_skip_entry(ent, buf);
 556                }
 557                break;
 558        case T268_BUF_TYPE_EXTD_LOGIN:
 559                if (vha->hw->exlogin_buf) {
 560                        if (buf) {
 561                                ent->t268.buf_size = vha->hw->exlogin_size;
 562                                ent->t268.start_addr =
 563                                        vha->hw->exlogin_buf_dma;
 564                        }
 565                        qla27xx_insertbuf(vha->hw->exlogin_buf,
 566                            vha->hw->exlogin_size, buf, len);
 567                } else {
 568                        ql_dbg(ql_dbg_misc, vha, 0xd028,
 569                            "%s: missing ext login\n", __func__);
 570                        qla27xx_skip_entry(ent, buf);
 571                }
 572                break;
 573
 574        case T268_BUF_TYPE_REQ_MIRROR:
 575        case T268_BUF_TYPE_RSP_MIRROR:
 576                /*
 577                 * Mirror pointers are not implemented in the
 578                 * driver, instead shadow pointers are used by
 579                 * the drier. Skip these entries.
 580                 */
 581                qla27xx_skip_entry(ent, buf);
 582                break;
 583        default:
 584                ql_dbg(ql_dbg_async, vha, 0xd02b,
 585                    "%s: unknown buffer %x\n", __func__, ent->t268.buf_type);
 586                qla27xx_skip_entry(ent, buf);
 587                break;
 588        }
 589
 590        return false;
 591}
 592
 593static int
 594qla27xx_fwdt_entry_t269(struct scsi_qla_host *vha,
 595        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 596{
 597        ql_dbg(ql_dbg_misc, vha, 0xd20d,
 598            "%s: scratch [%lx]\n", __func__, *len);
 599        qla27xx_insert32(0xaaaaaaaa, buf, len);
 600        qla27xx_insert32(0xbbbbbbbb, buf, len);
 601        qla27xx_insert32(0xcccccccc, buf, len);
 602        qla27xx_insert32(0xdddddddd, buf, len);
 603        qla27xx_insert32(*len + sizeof(uint32_t), buf, len);
 604        if (buf)
 605                ent->t269.scratch_size = 5 * sizeof(uint32_t);
 606
 607        return false;
 608}
 609
 610static int
 611qla27xx_fwdt_entry_t270(struct scsi_qla_host *vha,
 612        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 613{
 614        struct device_reg_24xx __iomem *reg = qla27xx_isp_reg(vha);
 615        ulong dwords = ent->t270.count;
 616        ulong addr = ent->t270.addr;
 617
 618        ql_dbg(ql_dbg_misc, vha, 0xd20e,
 619            "%s: rdremreg [%lx]\n", __func__, *len);
 620        qla27xx_write_reg(reg, IOBASE_ADDR, 0x40, buf);
 621        while (dwords--) {
 622                qla27xx_write_reg(reg, 0xc0, addr|0x80000000, buf);
 623                qla27xx_insert32(addr, buf, len);
 624                qla27xx_read_reg(reg, 0xc4, buf, len);
 625                addr += sizeof(uint32_t);
 626        }
 627
 628        return false;
 629}
 630
 631static int
 632qla27xx_fwdt_entry_t271(struct scsi_qla_host *vha,
 633        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 634{
 635        struct device_reg_24xx __iomem *reg = qla27xx_isp_reg(vha);
 636        ulong addr = ent->t271.addr;
 637        ulong data = ent->t271.data;
 638
 639        ql_dbg(ql_dbg_misc, vha, 0xd20f,
 640            "%s: wrremreg [%lx]\n", __func__, *len);
 641        qla27xx_write_reg(reg, IOBASE_ADDR, 0x40, buf);
 642        qla27xx_write_reg(reg, 0xc4, data, buf);
 643        qla27xx_write_reg(reg, 0xc0, addr, buf);
 644
 645        return false;
 646}
 647
 648static int
 649qla27xx_fwdt_entry_t272(struct scsi_qla_host *vha,
 650        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 651{
 652        ulong dwords = ent->t272.count;
 653        ulong start = ent->t272.addr;
 654
 655        ql_dbg(ql_dbg_misc, vha, 0xd210,
 656            "%s: rdremram [%lx]\n", __func__, *len);
 657        if (buf) {
 658                ql_dbg(ql_dbg_misc, vha, 0xd02c,
 659                    "%s: @%lx -> (%lx dwords)\n", __func__, start, dwords);
 660                buf += *len;
 661                qla27xx_dump_mpi_ram(vha->hw, start, buf, dwords, &buf);
 662        }
 663        *len += dwords * sizeof(uint32_t);
 664
 665        return false;
 666}
 667
 668static int
 669qla27xx_fwdt_entry_t273(struct scsi_qla_host *vha,
 670        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 671{
 672        ulong dwords = ent->t273.count;
 673        ulong addr = ent->t273.addr;
 674        uint32_t value;
 675
 676        ql_dbg(ql_dbg_misc, vha, 0xd211,
 677            "%s: pcicfg [%lx]\n", __func__, *len);
 678        while (dwords--) {
 679                value = ~0;
 680                if (pci_read_config_dword(vha->hw->pdev, addr, &value))
 681                        ql_dbg(ql_dbg_misc, vha, 0xd02d,
 682                            "%s: failed pcicfg read at %lx\n", __func__, addr);
 683                qla27xx_insert32(addr, buf, len);
 684                qla27xx_insert32(value, buf, len);
 685                addr += sizeof(uint32_t);
 686        }
 687
 688        return false;
 689}
 690
 691static int
 692qla27xx_fwdt_entry_t274(struct scsi_qla_host *vha,
 693        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 694{
 695        uint count = 0;
 696        uint i;
 697
 698        ql_dbg(ql_dbg_misc, vha, 0xd212,
 699            "%s: getqsh(%x) [%lx]\n", __func__, ent->t274.queue_type, *len);
 700        if (ent->t274.queue_type == T274_QUEUE_TYPE_REQ_SHAD) {
 701                for (i = 0; i < vha->hw->max_req_queues; i++) {
 702                        struct req_que *req = vha->hw->req_q_map[i];
 703
 704                        if (req || !buf) {
 705                                qla27xx_insert16(i, buf, len);
 706                                qla27xx_insert16(1, buf, len);
 707                                qla27xx_insert32(req && req->out_ptr ?
 708                                    *req->out_ptr : 0, buf, len);
 709                                count++;
 710                        }
 711                }
 712        } else if (ent->t274.queue_type == T274_QUEUE_TYPE_RSP_SHAD) {
 713                for (i = 0; i < vha->hw->max_rsp_queues; i++) {
 714                        struct rsp_que *rsp = vha->hw->rsp_q_map[i];
 715
 716                        if (rsp || !buf) {
 717                                qla27xx_insert16(i, buf, len);
 718                                qla27xx_insert16(1, buf, len);
 719                                qla27xx_insert32(rsp && rsp->in_ptr ?
 720                                    *rsp->in_ptr : 0, buf, len);
 721                                count++;
 722                        }
 723                }
 724        } else if (QLA_TGT_MODE_ENABLED() &&
 725            ent->t274.queue_type == T274_QUEUE_TYPE_ATIO_SHAD) {
 726                struct qla_hw_data *ha = vha->hw;
 727                struct atio *atr = ha->tgt.atio_ring_ptr;
 728
 729                if (atr || !buf) {
 730                        qla27xx_insert16(0, buf, len);
 731                        qla27xx_insert16(1, buf, len);
 732                        qla27xx_insert32(ha->tgt.atio_q_in ?
 733                            readl(ha->tgt.atio_q_in) : 0, buf, len);
 734                        count++;
 735                }
 736        } else {
 737                ql_dbg(ql_dbg_misc, vha, 0xd02f,
 738                    "%s: unknown queue %x\n", __func__, ent->t274.queue_type);
 739                qla27xx_skip_entry(ent, buf);
 740        }
 741
 742        if (buf) {
 743                if (count)
 744                        ent->t274.num_queues = count;
 745                else
 746                        qla27xx_skip_entry(ent, buf);
 747        }
 748
 749        return false;
 750}
 751
 752static int
 753qla27xx_fwdt_entry_t275(struct scsi_qla_host *vha,
 754        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 755{
 756        ulong offset = offsetof(typeof(*ent), t275.buffer);
 757
 758        ql_dbg(ql_dbg_misc, vha, 0xd213,
 759            "%s: buffer(%x) [%lx]\n", __func__, ent->t275.length, *len);
 760        if (!ent->t275.length) {
 761                ql_dbg(ql_dbg_misc, vha, 0xd020,
 762                    "%s: buffer zero length\n", __func__);
 763                qla27xx_skip_entry(ent, buf);
 764                goto done;
 765        }
 766        if (offset + ent->t275.length > ent->hdr.entry_size) {
 767                ql_dbg(ql_dbg_misc, vha, 0xd030,
 768                    "%s: buffer overflow\n", __func__);
 769                qla27xx_skip_entry(ent, buf);
 770                goto done;
 771        }
 772
 773        qla27xx_insertbuf(ent->t275.buffer, ent->t275.length, buf, len);
 774done:
 775        return false;
 776}
 777
 778static int
 779qla27xx_fwdt_entry_other(struct scsi_qla_host *vha,
 780        struct qla27xx_fwdt_entry *ent, void *buf, ulong *len)
 781{
 782        ql_dbg(ql_dbg_misc, vha, 0xd2ff,
 783            "%s: type %x [%lx]\n", __func__, ent->hdr.entry_type, *len);
 784        qla27xx_skip_entry(ent, buf);
 785
 786        return false;
 787}
 788
 789struct qla27xx_fwdt_entry_call {
 790        uint type;
 791        int (*call)(
 792            struct scsi_qla_host *,
 793            struct qla27xx_fwdt_entry *,
 794            void *,
 795            ulong *);
 796};
 797
 798static struct qla27xx_fwdt_entry_call ql27xx_fwdt_entry_call_list[] = {
 799        { ENTRY_TYPE_NOP                , qla27xx_fwdt_entry_t0    } ,
 800        { ENTRY_TYPE_TMP_END            , qla27xx_fwdt_entry_t255  } ,
 801        { ENTRY_TYPE_RD_IOB_T1          , qla27xx_fwdt_entry_t256  } ,
 802        { ENTRY_TYPE_WR_IOB_T1          , qla27xx_fwdt_entry_t257  } ,
 803        { ENTRY_TYPE_RD_IOB_T2          , qla27xx_fwdt_entry_t258  } ,
 804        { ENTRY_TYPE_WR_IOB_T2          , qla27xx_fwdt_entry_t259  } ,
 805        { ENTRY_TYPE_RD_PCI             , qla27xx_fwdt_entry_t260  } ,
 806        { ENTRY_TYPE_WR_PCI             , qla27xx_fwdt_entry_t261  } ,
 807        { ENTRY_TYPE_RD_RAM             , qla27xx_fwdt_entry_t262  } ,
 808        { ENTRY_TYPE_GET_QUEUE          , qla27xx_fwdt_entry_t263  } ,
 809        { ENTRY_TYPE_GET_FCE            , qla27xx_fwdt_entry_t264  } ,
 810        { ENTRY_TYPE_PSE_RISC           , qla27xx_fwdt_entry_t265  } ,
 811        { ENTRY_TYPE_RST_RISC           , qla27xx_fwdt_entry_t266  } ,
 812        { ENTRY_TYPE_DIS_INTR           , qla27xx_fwdt_entry_t267  } ,
 813        { ENTRY_TYPE_GET_HBUF           , qla27xx_fwdt_entry_t268  } ,
 814        { ENTRY_TYPE_SCRATCH            , qla27xx_fwdt_entry_t269  } ,
 815        { ENTRY_TYPE_RDREMREG           , qla27xx_fwdt_entry_t270  } ,
 816        { ENTRY_TYPE_WRREMREG           , qla27xx_fwdt_entry_t271  } ,
 817        { ENTRY_TYPE_RDREMRAM           , qla27xx_fwdt_entry_t272  } ,
 818        { ENTRY_TYPE_PCICFG             , qla27xx_fwdt_entry_t273  } ,
 819        { ENTRY_TYPE_GET_SHADOW         , qla27xx_fwdt_entry_t274  } ,
 820        { ENTRY_TYPE_WRITE_BUF          , qla27xx_fwdt_entry_t275  } ,
 821        { -1                            , qla27xx_fwdt_entry_other }
 822};
 823
 824static inline int (*qla27xx_find_entry(uint type))
 825        (struct scsi_qla_host *, struct qla27xx_fwdt_entry *, void *, ulong *)
 826{
 827        struct qla27xx_fwdt_entry_call *list = ql27xx_fwdt_entry_call_list;
 828
 829        while (list->type < type)
 830                list++;
 831
 832        if (list->type == type)
 833                return list->call;
 834        return qla27xx_fwdt_entry_other;
 835}
 836
 837static inline void *
 838qla27xx_next_entry(void *p)
 839{
 840        struct qla27xx_fwdt_entry *ent = p;
 841
 842        return p + ent->hdr.entry_size;
 843}
 844
 845static void
 846qla27xx_walk_template(struct scsi_qla_host *vha,
 847        struct qla27xx_fwdt_template *tmp, void *buf, ulong *len)
 848{
 849        struct qla27xx_fwdt_entry *ent = (void *)tmp + tmp->entry_offset;
 850        ulong count = tmp->entry_count;
 851
 852        ql_dbg(ql_dbg_misc, vha, 0xd01a,
 853            "%s: entry count %lx\n", __func__, count);
 854        while (count--) {
 855                if (buf && *len >= vha->hw->fw_dump_len)
 856                        break;
 857                if (qla27xx_find_entry(ent->hdr.entry_type)(vha, ent, buf, len))
 858                        break;
 859                ent = qla27xx_next_entry(ent);
 860        }
 861
 862        if (count)
 863                ql_dbg(ql_dbg_misc, vha, 0xd018,
 864                    "%s: entry residual count (%lx)\n", __func__, count);
 865
 866        if (ent->hdr.entry_type != ENTRY_TYPE_TMP_END)
 867                ql_dbg(ql_dbg_misc, vha, 0xd019,
 868                    "%s: missing end entry (%lx)\n", __func__, count);
 869
 870        if (buf && *len != vha->hw->fw_dump_len)
 871                ql_dbg(ql_dbg_misc, vha, 0xd01b,
 872                    "%s: length=%#lx residual=%+ld\n",
 873                    __func__, *len, vha->hw->fw_dump_len - *len);
 874
 875        if (buf) {
 876                ql_log(ql_log_warn, vha, 0xd015,
 877                    "Firmware dump saved to temp buffer (%lu/%p)\n",
 878                    vha->host_no, vha->hw->fw_dump);
 879                qla2x00_post_uevent_work(vha, QLA_UEVENT_CODE_FW_DUMP);
 880        }
 881}
 882
 883static void
 884qla27xx_time_stamp(struct qla27xx_fwdt_template *tmp)
 885{
 886        tmp->capture_timestamp = jiffies;
 887}
 888
 889static void
 890qla27xx_driver_info(struct qla27xx_fwdt_template *tmp)
 891{
 892        uint8_t v[] = { 0, 0, 0, 0, 0, 0 };
 893
 894        sscanf(qla2x00_version_str, "%hhu.%hhu.%hhu.%hhu.%hhu.%hhu",
 895            v+0, v+1, v+2, v+3, v+4, v+5);
 896
 897        tmp->driver_info[0] = v[3] << 24 | v[2] << 16 | v[1] << 8 | v[0];
 898        tmp->driver_info[1] = v[5] << 8 | v[4];
 899        tmp->driver_info[2] = 0x12345678;
 900}
 901
 902static void
 903qla27xx_firmware_info(struct qla27xx_fwdt_template *tmp,
 904        struct scsi_qla_host *vha)
 905{
 906        tmp->firmware_version[0] = vha->hw->fw_major_version;
 907        tmp->firmware_version[1] = vha->hw->fw_minor_version;
 908        tmp->firmware_version[2] = vha->hw->fw_subminor_version;
 909        tmp->firmware_version[3] =
 910            vha->hw->fw_attributes_h << 16 | vha->hw->fw_attributes;
 911        tmp->firmware_version[4] =
 912            vha->hw->fw_attributes_ext[1] << 16 | vha->hw->fw_attributes_ext[0];
 913}
 914
 915static void
 916ql27xx_edit_template(struct scsi_qla_host *vha,
 917        struct qla27xx_fwdt_template *tmp)
 918{
 919        qla27xx_time_stamp(tmp);
 920        qla27xx_driver_info(tmp);
 921        qla27xx_firmware_info(tmp, vha);
 922}
 923
 924static inline uint32_t
 925qla27xx_template_checksum(void *p, ulong size)
 926{
 927        uint32_t *buf = p;
 928        uint64_t sum = 0;
 929
 930        size /= sizeof(*buf);
 931
 932        while (size--)
 933                sum += *buf++;
 934
 935        sum = (sum & 0xffffffff) + (sum >> 32);
 936
 937        return ~sum;
 938}
 939
 940static inline int
 941qla27xx_verify_template_checksum(struct qla27xx_fwdt_template *tmp)
 942{
 943        return qla27xx_template_checksum(tmp, tmp->template_size) == 0;
 944}
 945
 946static inline int
 947qla27xx_verify_template_header(struct qla27xx_fwdt_template *tmp)
 948{
 949        return tmp->template_type == TEMPLATE_TYPE_FWDUMP;
 950}
 951
 952static void
 953qla27xx_execute_fwdt_template(struct scsi_qla_host *vha)
 954{
 955        struct qla27xx_fwdt_template *tmp = vha->hw->fw_dump_template;
 956        ulong len;
 957
 958        if (qla27xx_fwdt_template_valid(tmp)) {
 959                len = tmp->template_size;
 960                tmp = memcpy(vha->hw->fw_dump, tmp, len);
 961                ql27xx_edit_template(vha, tmp);
 962                qla27xx_walk_template(vha, tmp, tmp, &len);
 963                vha->hw->fw_dump_len = len;
 964                vha->hw->fw_dumped = 1;
 965        }
 966}
 967
 968ulong
 969qla27xx_fwdt_calculate_dump_size(struct scsi_qla_host *vha)
 970{
 971        struct qla27xx_fwdt_template *tmp = vha->hw->fw_dump_template;
 972        ulong len = 0;
 973
 974        if (qla27xx_fwdt_template_valid(tmp)) {
 975                len = tmp->template_size;
 976                qla27xx_walk_template(vha, tmp, NULL, &len);
 977        }
 978
 979        return len;
 980}
 981
 982ulong
 983qla27xx_fwdt_template_size(void *p)
 984{
 985        struct qla27xx_fwdt_template *tmp = p;
 986
 987        return tmp->template_size;
 988}
 989
 990ulong
 991qla27xx_fwdt_template_default_size(void)
 992{
 993        return sizeof(ql27xx_fwdt_default_template);
 994}
 995
 996const void *
 997qla27xx_fwdt_template_default(void)
 998{
 999        return ql27xx_fwdt_default_template;
1000}
1001
1002int
1003qla27xx_fwdt_template_valid(void *p)
1004{
1005        struct qla27xx_fwdt_template *tmp = p;
1006
1007        if (!qla27xx_verify_template_header(tmp)) {
1008                ql_log(ql_log_warn, NULL, 0xd01c,
1009                    "%s: template type %x\n", __func__, tmp->template_type);
1010                return false;
1011        }
1012
1013        if (!qla27xx_verify_template_checksum(tmp)) {
1014                ql_log(ql_log_warn, NULL, 0xd01d,
1015                    "%s: failed template checksum\n", __func__);
1016                return false;
1017        }
1018
1019        return true;
1020}
1021
1022void
1023qla27xx_fwdump(scsi_qla_host_t *vha, int hardware_locked)
1024{
1025        ulong flags = 0;
1026
1027#ifndef __CHECKER__
1028        if (!hardware_locked)
1029                spin_lock_irqsave(&vha->hw->hardware_lock, flags);
1030#endif
1031
1032        if (!vha->hw->fw_dump)
1033                ql_log(ql_log_warn, vha, 0xd01e, "fwdump buffer missing.\n");
1034        else if (!vha->hw->fw_dump_template)
1035                ql_log(ql_log_warn, vha, 0xd01f, "fwdump template missing.\n");
1036        else if (vha->hw->fw_dumped)
1037                ql_log(ql_log_warn, vha, 0xd300,
1038                    "Firmware has been previously dumped (%p),"
1039                    " -- ignoring request\n", vha->hw->fw_dump);
1040        else {
1041                QLA_FW_STOPPED(vha->hw);
1042                qla27xx_execute_fwdt_template(vha);
1043        }
1044
1045#ifndef __CHECKER__
1046        if (!hardware_locked)
1047                spin_unlock_irqrestore(&vha->hw->hardware_lock, flags);
1048#endif
1049}
1050