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