1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * sata_sx4.c - Promise SATA 4 * 5 * Maintained by: Tejun Heo <tj@kernel.org> 6 * Please ALWAYS copy linux-ide@vger.kernel.org 7 * on emails. 8 * 9 * Copyright 2003-2004 Red Hat, Inc. 10 * 11 * libata documentation is available via 'make {ps|pdf}docs', 12 * as Documentation/driver-api/libata.rst 13 * 14 * Hardware documentation available under NDA. 15 */ 16 17 /* 18 Theory of operation 19 ------------------- 20 21 The SX4 (PDC20621) chip features a single Host DMA (HDMA) copy 22 engine, DIMM memory, and four ATA engines (one per SATA port). 23 Data is copied to/from DIMM memory by the HDMA engine, before 24 handing off to one (or more) of the ATA engines. The ATA 25 engines operate solely on DIMM memory. 26 27 The SX4 behaves like a PATA chip, with no SATA controls or 28 knowledge whatsoever, leading to the presumption that 29 PATA<->SATA bridges exist on SX4 boards, external to the 30 PDC20621 chip itself. 31 32 The chip is quite capable, supporting an XOR engine and linked 33 hardware commands (permits a string to transactions to be 34 submitted and waited-on as a single unit), and an optional 35 microprocessor. 36 37 The limiting factor is largely software. This Linux driver was 38 written to multiplex the single HDMA engine to copy disk 39 transactions into a fixed DIMM memory space, from where an ATA 40 engine takes over. As a result, each WRITE looks like this: 41 42 submit HDMA packet to hardware 43 hardware copies data from system memory to DIMM 44 hardware raises interrupt 45 46 submit ATA packet to hardware 47 hardware executes ATA WRITE command, w/ data in DIMM 48 hardware raises interrupt 49 50 and each READ looks like this: 51 52 submit ATA packet to hardware 53 hardware executes ATA READ command, w/ data in DIMM 54 hardware raises interrupt 55 56 submit HDMA packet to hardware 57 hardware copies data from DIMM to system memory 58 hardware raises interrupt 59 60 This is a very slow, lock-step way of doing things that can 61 certainly be improved by motivated kernel hackers. 62 63 */ 64 65 #include <linux/kernel.h> 66 #include <linux/module.h> 67 #include <linux/pci.h> 68 #include <linux/slab.h> 69 #include <linux/blkdev.h> 70 #include <linux/delay.h> 71 #include <linux/interrupt.h> 72 #include <linux/device.h> 73 #include <scsi/scsi_host.h> 74 #include <scsi/scsi_cmnd.h> 75 #include <linux/libata.h> 76 #include "sata_promise.h" 77 78 #define DRV_NAME "sata_sx4" 79 #define DRV_VERSION "0.12" 80 81 static int dimm_test; 82 module_param(dimm_test, int, 0644); 83 MODULE_PARM_DESC(dimm_test, "Enable DIMM test during startup (1 = enabled)"); 84 85 enum { 86 PDC_MMIO_BAR = 3, 87 PDC_DIMM_BAR = 4, 88 89 PDC_PRD_TBL = 0x44, /* Direct command DMA table addr */ 90 91 PDC_PKT_SUBMIT = 0x40, /* Command packet pointer addr */ 92 PDC_HDMA_PKT_SUBMIT = 0x100, /* Host DMA packet pointer addr */ 93 PDC_INT_SEQMASK = 0x40, /* Mask of asserted SEQ INTs */ 94 PDC_HDMA_CTLSTAT = 0x12C, /* Host DMA control / status */ 95 96 PDC_CTLSTAT = 0x60, /* IDEn control / status */ 97 98 PDC_20621_SEQCTL = 0x400, 99 PDC_20621_SEQMASK = 0x480, 100 PDC_20621_GENERAL_CTL = 0x484, 101 PDC_20621_PAGE_SIZE = (32 * 1024), 102 103 /* chosen, not constant, values; we design our own DIMM mem map */ 104 PDC_20621_DIMM_WINDOW = 0x0C, /* page# for 32K DIMM window */ 105 PDC_20621_DIMM_BASE = 0x00200000, 106 PDC_20621_DIMM_DATA = (64 * 1024), 107 PDC_DIMM_DATA_STEP = (256 * 1024), 108 PDC_DIMM_WINDOW_STEP = (8 * 1024), 109 PDC_DIMM_HOST_PRD = (6 * 1024), 110 PDC_DIMM_HOST_PKT = (128 * 0), 111 PDC_DIMM_HPKT_PRD = (128 * 1), 112 PDC_DIMM_ATA_PKT = (128 * 2), 113 PDC_DIMM_APKT_PRD = (128 * 3), 114 PDC_DIMM_HEADER_SZ = PDC_DIMM_APKT_PRD + 128, 115 PDC_PAGE_WINDOW = 0x40, 116 PDC_PAGE_DATA = PDC_PAGE_WINDOW + 117 (PDC_20621_DIMM_DATA / PDC_20621_PAGE_SIZE), 118 PDC_PAGE_SET = PDC_DIMM_DATA_STEP / PDC_20621_PAGE_SIZE, 119 120 PDC_CHIP0_OFS = 0xC0000, /* offset of chip #0 */ 121 122 PDC_20621_ERR_MASK = (1<<19) | (1<<20) | (1<<21) | (1<<22) | 123 (1<<23), 124 125 board_20621 = 0, /* FastTrak S150 SX4 */ 126 127 PDC_MASK_INT = (1 << 10), /* HDMA/ATA mask int */ 128 PDC_RESET = (1 << 11), /* HDMA/ATA reset */ 129 PDC_DMA_ENABLE = (1 << 7), /* DMA start/stop */ 130 131 PDC_MAX_HDMA = 32, 132 PDC_HDMA_Q_MASK = (PDC_MAX_HDMA - 1), 133 134 PDC_DIMM0_SPD_DEV_ADDRESS = 0x50, 135 PDC_DIMM1_SPD_DEV_ADDRESS = 0x51, 136 PDC_I2C_CONTROL = 0x48, 137 PDC_I2C_ADDR_DATA = 0x4C, 138 PDC_DIMM0_CONTROL = 0x80, 139 PDC_DIMM1_CONTROL = 0x84, 140 PDC_SDRAM_CONTROL = 0x88, 141 PDC_I2C_WRITE = 0, /* master -> slave */ 142 PDC_I2C_READ = (1 << 6), /* master <- slave */ 143 PDC_I2C_START = (1 << 7), /* start I2C proto */ 144 PDC_I2C_MASK_INT = (1 << 5), /* mask I2C interrupt */ 145 PDC_I2C_COMPLETE = (1 << 16), /* I2C normal compl. */ 146 PDC_I2C_NO_ACK = (1 << 20), /* slave no-ack addr */ 147 PDC_DIMM_SPD_SUBADDRESS_START = 0x00, 148 PDC_DIMM_SPD_SUBADDRESS_END = 0x7F, 149 PDC_DIMM_SPD_ROW_NUM = 3, 150 PDC_DIMM_SPD_COLUMN_NUM = 4, 151 PDC_DIMM_SPD_MODULE_ROW = 5, 152 PDC_DIMM_SPD_TYPE = 11, 153 PDC_DIMM_SPD_FRESH_RATE = 12, 154 PDC_DIMM_SPD_BANK_NUM = 17, 155 PDC_DIMM_SPD_CAS_LATENCY = 18, 156 PDC_DIMM_SPD_ATTRIBUTE = 21, 157 PDC_DIMM_SPD_ROW_PRE_CHARGE = 27, 158 PDC_DIMM_SPD_ROW_ACTIVE_DELAY = 28, 159 PDC_DIMM_SPD_RAS_CAS_DELAY = 29, 160 PDC_DIMM_SPD_ACTIVE_PRECHARGE = 30, 161 PDC_DIMM_SPD_SYSTEM_FREQ = 126, 162 PDC_CTL_STATUS = 0x08, 163 PDC_DIMM_WINDOW_CTLR = 0x0C, 164 PDC_TIME_CONTROL = 0x3C, 165 PDC_TIME_PERIOD = 0x40, 166 PDC_TIME_COUNTER = 0x44, 167 PDC_GENERAL_CTLR = 0x484, 168 PCI_PLL_INIT = 0x8A531824, 169 PCI_X_TCOUNT = 0xEE1E5CFF, 170 171 /* PDC_TIME_CONTROL bits */ 172 PDC_TIMER_BUZZER = (1 << 10), 173 PDC_TIMER_MODE_PERIODIC = 0, /* bits 9:8 == 00 */ 174 PDC_TIMER_MODE_ONCE = (1 << 8), /* bits 9:8 == 01 */ 175 PDC_TIMER_ENABLE = (1 << 7), 176 PDC_TIMER_MASK_INT = (1 << 5), 177 PDC_TIMER_SEQ_MASK = 0x1f, /* SEQ ID for timer */ 178 PDC_TIMER_DEFAULT = PDC_TIMER_MODE_ONCE | 179 PDC_TIMER_ENABLE | 180 PDC_TIMER_MASK_INT, 181 }; 182 183 #define ECC_ERASE_BUF_SZ (128 * 1024) 184 185 struct pdc_port_priv { 186 u8 dimm_buf[(ATA_PRD_SZ * ATA_MAX_PRD) + 512]; 187 u8 *pkt; 188 dma_addr_t pkt_dma; 189 }; 190 191 struct pdc_host_priv { 192 unsigned int doing_hdma; 193 unsigned int hdma_prod; 194 unsigned int hdma_cons; 195 struct { 196 struct ata_queued_cmd *qc; 197 unsigned int seq; 198 unsigned long pkt_ofs; 199 } hdma[32]; 200 }; 201 202 203 static int pdc_sata_init_one(struct pci_dev *pdev, const struct pci_device_id *ent); 204 static void pdc_error_handler(struct ata_port *ap); 205 static void pdc_freeze(struct ata_port *ap); 206 static void pdc_thaw(struct ata_port *ap); 207 static int pdc_port_start(struct ata_port *ap); 208 static enum ata_completion_errors pdc20621_qc_prep(struct ata_queued_cmd *qc); 209 static void pdc_tf_load_mmio(struct ata_port *ap, const struct ata_taskfile *tf); 210 static void pdc_exec_command_mmio(struct ata_port *ap, const struct ata_taskfile *tf); 211 static unsigned int pdc20621_dimm_init(struct ata_host *host); 212 static int pdc20621_detect_dimm(struct ata_host *host); 213 static unsigned int pdc20621_i2c_read(struct ata_host *host, 214 u32 device, u32 subaddr, u32 *pdata); 215 static int pdc20621_prog_dimm0(struct ata_host *host); 216 static unsigned int pdc20621_prog_dimm_global(struct ata_host *host); 217 static void pdc20621_get_from_dimm(struct ata_host *host, 218 void *psource, u32 offset, u32 size); 219 static void pdc20621_put_to_dimm(struct ata_host *host, 220 void *psource, u32 offset, u32 size); 221 static void pdc20621_irq_clear(struct ata_port *ap); 222 static unsigned int pdc20621_qc_issue(struct ata_queued_cmd *qc); 223 static int pdc_softreset(struct ata_link *link, unsigned int *class, 224 unsigned long deadline); 225 static void pdc_post_internal_cmd(struct ata_queued_cmd *qc); 226 static int pdc_check_atapi_dma(struct ata_queued_cmd *qc); 227 228 229 static struct scsi_host_template pdc_sata_sht = { 230 ATA_BASE_SHT(DRV_NAME), 231 .sg_tablesize = LIBATA_MAX_PRD, 232 .dma_boundary = ATA_DMA_BOUNDARY, 233 }; 234 235 /* TODO: inherit from base port_ops after converting to new EH */ 236 static struct ata_port_operations pdc_20621_ops = { 237 .inherits = &ata_sff_port_ops, 238 239 .check_atapi_dma = pdc_check_atapi_dma, 240 .qc_prep = pdc20621_qc_prep, 241 .qc_issue = pdc20621_qc_issue, 242 243 .freeze = pdc_freeze, 244 .thaw = pdc_thaw, 245 .softreset = pdc_softreset, 246 .error_handler = pdc_error_handler, 247 .lost_interrupt = ATA_OP_NULL, 248 .post_internal_cmd = pdc_post_internal_cmd, 249 250 .port_start = pdc_port_start, 251 252 .sff_tf_load = pdc_tf_load_mmio, 253 .sff_exec_command = pdc_exec_command_mmio, 254 .sff_irq_clear = pdc20621_irq_clear, 255 }; 256 257 static const struct ata_port_info pdc_port_info[] = { 258 /* board_20621 */ 259 { 260 .flags = ATA_FLAG_SATA | ATA_FLAG_NO_ATAPI | 261 ATA_FLAG_PIO_POLLING, 262 .pio_mask = ATA_PIO4, 263 .mwdma_mask = ATA_MWDMA2, 264 .udma_mask = ATA_UDMA6, 265 .port_ops = &pdc_20621_ops, 266 }, 267 268 }; 269 270 static const struct pci_device_id pdc_sata_pci_tbl[] = { 271 { PCI_VDEVICE(PROMISE, 0x6622), board_20621 }, 272 273 { } /* terminate list */ 274 }; 275 276 static struct pci_driver pdc_sata_pci_driver = { 277 .name = DRV_NAME, 278 .id_table = pdc_sata_pci_tbl, 279 .probe = pdc_sata_init_one, 280 .remove = ata_pci_remove_one, 281 }; 282 283 284 static int pdc_port_start(struct ata_port *ap) 285 { 286 struct device *dev = ap->host->dev; 287 struct pdc_port_priv *pp; 288 289 pp = devm_kzalloc(dev, sizeof(*pp), GFP_KERNEL); 290 if (!pp) 291 return -ENOMEM; 292 293 pp->pkt = dmam_alloc_coherent(dev, 128, &pp->pkt_dma, GFP_KERNEL); 294 if (!pp->pkt) 295 return -ENOMEM; 296 297 ap->private_data = pp; 298 299 return 0; 300 } 301 302 static inline void pdc20621_ata_sg(u8 *buf, unsigned int portno, 303 unsigned int total_len) 304 { 305 u32 addr; 306 unsigned int dw = PDC_DIMM_APKT_PRD >> 2; 307 __le32 *buf32 = (__le32 *) buf; 308 309 /* output ATA packet S/G table */ 310 addr = PDC_20621_DIMM_BASE + PDC_20621_DIMM_DATA + 311 (PDC_DIMM_DATA_STEP * portno); 312 313 buf32[dw] = cpu_to_le32(addr); 314 buf32[dw + 1] = cpu_to_le32(total_len | ATA_PRD_EOT); 315 } 316 317 static inline void pdc20621_host_sg(u8 *buf, unsigned int portno, 318 unsigned int total_len) 319 { 320 u32 addr; 321 unsigned int dw = PDC_DIMM_HPKT_PRD >> 2; 322 __le32 *buf32 = (__le32 *) buf; 323 324 /* output Host DMA packet S/G table */ 325 addr = PDC_20621_DIMM_BASE + PDC_20621_DIMM_DATA + 326 (PDC_DIMM_DATA_STEP * portno); 327 328 buf32[dw] = cpu_to_le32(addr); 329 buf32[dw + 1] = cpu_to_le32(total_len | ATA_PRD_EOT); 330 } 331 332 static inline unsigned int pdc20621_ata_pkt(struct ata_taskfile *tf, 333 unsigned int devno, u8 *buf, 334 unsigned int portno) 335 { 336 unsigned int i, dw; 337 __le32 *buf32 = (__le32 *) buf; 338 u8 dev_reg; 339 340 unsigned int dimm_sg = PDC_20621_DIMM_BASE + 341 (PDC_DIMM_WINDOW_STEP * portno) + 342 PDC_DIMM_APKT_PRD; 343 344 i = PDC_DIMM_ATA_PKT; 345 346 /* 347 * Set up ATA packet 348 */ 349 if ((tf->protocol == ATA_PROT_DMA) && (!(tf->flags & ATA_TFLAG_WRITE))) 350 buf[i++] = PDC_PKT_READ; 351 else if (tf->protocol == ATA_PROT_NODATA) 352 buf[i++] = PDC_PKT_NODATA; 353 else 354 buf[i++] = 0; 355 buf[i++] = 0; /* reserved */ 356 buf[i++] = portno + 1; /* seq. id */ 357 buf[i++] = 0xff; /* delay seq. id */ 358 359 /* dimm dma S/G, and next-pkt */ 360 dw = i >> 2; 361 if (tf->protocol == ATA_PROT_NODATA) 362 buf32[dw] = 0; 363 else 364 buf32[dw] = cpu_to_le32(dimm_sg); 365 buf32[dw + 1] = 0; 366 i += 8; 367 368 if (devno == 0) 369 dev_reg = ATA_DEVICE_OBS; 370 else 371 dev_reg = ATA_DEVICE_OBS | ATA_DEV1; 372 373 /* select device */ 374 buf[i++] = (1 << 5) | PDC_PKT_CLEAR_BSY | ATA_REG_DEVICE; 375 buf[i++] = dev_reg; 376 377 /* device control register */ 378 buf[i++] = (1 << 5) | PDC_REG_DEVCTL; 379 buf[i++] = tf->ctl; 380 381 return i; 382 } 383 384 static inline void pdc20621_host_pkt(struct ata_taskfile *tf, u8 *buf, 385 unsigned int portno) 386 { 387 unsigned int dw; 388 u32 tmp; 389 __le32 *buf32 = (__le32 *) buf; 390 391 unsigned int host_sg = PDC_20621_DIMM_BASE + 392 (PDC_DIMM_WINDOW_STEP * portno) + 393 PDC_DIMM_HOST_PRD; 394 unsigned int dimm_sg = PDC_20621_DIMM_BASE + 395 (PDC_DIMM_WINDOW_STEP * portno) + 396 PDC_DIMM_HPKT_PRD; 397 398 dw = PDC_DIMM_HOST_PKT >> 2; 399 400 /* 401 * Set up Host DMA packet 402 */ 403 if ((tf->protocol == ATA_PROT_DMA) && (!(tf->flags & ATA_TFLAG_WRITE))) 404 tmp = PDC_PKT_READ; 405 else 406 tmp = 0; 407 tmp |= ((portno + 1 + 4) << 16); /* seq. id */ 408 tmp |= (0xff << 24); /* delay seq. id */ 409 buf32[dw + 0] = cpu_to_le32(tmp); 410 buf32[dw + 1] = cpu_to_le32(host_sg); 411 buf32[dw + 2] = cpu_to_le32(dimm_sg); 412 buf32[dw + 3] = 0; 413 } 414 415 static void pdc20621_dma_prep(struct ata_queued_cmd *qc) 416 { 417 struct scatterlist *sg; 418 struct ata_port *ap = qc->ap; 419 struct pdc_port_priv *pp = ap->private_data; 420 void __iomem *mmio = ap->host->iomap[PDC_MMIO_BAR]; 421 void __iomem *dimm_mmio = ap->host->iomap[PDC_DIMM_BAR]; 422 unsigned int portno = ap->port_no; 423 unsigned int i, si, idx, total_len = 0, sgt_len; 424 __le32 *buf = (__le32 *) &pp->dimm_buf[PDC_DIMM_HEADER_SZ]; 425 426 WARN_ON(!(qc->flags & ATA_QCFLAG_DMAMAP)); 427 428 /* hard-code chip #0 */ 429 mmio += PDC_CHIP0_OFS; 430 431 /* 432 * Build S/G table 433 */ 434 idx = 0; 435 for_each_sg(qc->sg, sg, qc->n_elem, si) { 436 buf[idx++] = cpu_to_le32(sg_dma_address(sg)); 437 buf[idx++] = cpu_to_le32(sg_dma_len(sg)); 438 total_len += sg_dma_len(sg); 439 } 440 buf[idx - 1] |= cpu_to_le32(ATA_PRD_EOT); 441 sgt_len = idx * 4; 442 443 /* 444 * Build ATA, host DMA packets 445 */ 446 pdc20621_host_sg(&pp->dimm_buf[0], portno, total_len); 447 pdc20621_host_pkt(&qc->tf, &pp->dimm_buf[0], portno); 448 449 pdc20621_ata_sg(&pp->dimm_buf[0], portno, total_len); 450 i = pdc20621_ata_pkt(&qc->tf, qc->dev->devno, &pp->dimm_buf[0], portno); 451 452 if (qc->tf.flags & ATA_TFLAG_LBA48) 453 i = pdc_prep_lba48(&qc->tf, &pp->dimm_buf[0], i); 454 else 455 i = pdc_prep_lba28(&qc->tf, &pp->dimm_buf[0], i); 456 457 pdc_pkt_footer(&qc->tf, &pp->dimm_buf[0], i); 458 459 /* copy three S/G tables and two packets to DIMM MMIO window */ 460 memcpy_toio(dimm_mmio + (portno * PDC_DIMM_WINDOW_STEP), 461 &pp->dimm_buf, PDC_DIMM_HEADER_SZ); 462 memcpy_toio(dimm_mmio + (portno * PDC_DIMM_WINDOW_STEP) + 463 PDC_DIMM_HOST_PRD, 464 &pp->dimm_buf[PDC_DIMM_HEADER_SZ], sgt_len); 465 466 /* force host FIFO dump */ 467 writel(0x00000001, mmio + PDC_20621_GENERAL_CTL); 468 469 readl(dimm_mmio); /* MMIO PCI posting flush */ 470 471 ata_port_dbg(ap, "ata pkt buf ofs %u, prd size %u, mmio copied\n", 472 i, sgt_len); 473 } 474 475 static void pdc20621_nodata_prep(struct ata_queued_cmd *qc) 476 { 477 struct ata_port *ap = qc->ap; 478 struct pdc_port_priv *pp = ap->private_data; 479 void __iomem *mmio = ap->host->iomap[PDC_MMIO_BAR]; 480 void __iomem *dimm_mmio = ap->host->iomap[PDC_DIMM_BAR]; 481 unsigned int portno = ap->port_no; 482 unsigned int i; 483 484 /* hard-code chip #0 */ 485 mmio += PDC_CHIP0_OFS; 486 487 i = pdc20621_ata_pkt(&qc->tf, qc->dev->devno, &pp->dimm_buf[0], portno); 488 489 if (qc->tf.flags & ATA_TFLAG_LBA48) 490 i = pdc_prep_lba48(&qc->tf, &pp->dimm_buf[0], i); 491 else 492 i = pdc_prep_lba28(&qc->tf, &pp->dimm_buf[0], i); 493 494 pdc_pkt_footer(&qc->tf, &pp->dimm_buf[0], i); 495 496 /* copy three S/G tables and two packets to DIMM MMIO window */ 497 memcpy_toio(dimm_mmio + (portno * PDC_DIMM_WINDOW_STEP), 498 &pp->dimm_buf, PDC_DIMM_HEADER_SZ); 499 500 /* force host FIFO dump */ 501 writel(0x00000001, mmio + PDC_20621_GENERAL_CTL); 502 503 readl(dimm_mmio); /* MMIO PCI posting flush */ 504 505 ata_port_dbg(ap, "ata pkt buf ofs %u, mmio copied\n", i); 506 } 507 508 static enum ata_completion_errors pdc20621_qc_prep(struct ata_queued_cmd *qc) 509 { 510 switch (qc->tf.protocol) { 511 case ATA_PROT_DMA: 512 pdc20621_dma_prep(qc); 513 break; 514 case ATA_PROT_NODATA: 515 pdc20621_nodata_prep(qc); 516 break; 517 default: 518 break; 519 } 520 521 return AC_ERR_OK; 522 } 523 524 static void __pdc20621_push_hdma(struct ata_queued_cmd *qc, 525 unsigned int seq, 526 u32 pkt_ofs) 527 { 528 struct ata_port *ap = qc->ap; 529 struct ata_host *host = ap->host; 530 void __iomem *mmio = host->iomap[PDC_MMIO_BAR]; 531 532 /* hard-code chip #0 */ 533 mmio += PDC_CHIP0_OFS; 534 535 writel(0x00000001, mmio + PDC_20621_SEQCTL + (seq * 4)); 536 readl(mmio + PDC_20621_SEQCTL + (seq * 4)); /* flush */ 537 538 writel(pkt_ofs, mmio + PDC_HDMA_PKT_SUBMIT); 539 readl(mmio + PDC_HDMA_PKT_SUBMIT); /* flush */ 540 } 541 542 static void pdc20621_push_hdma(struct ata_queued_cmd *qc, 543 unsigned int seq, 544 u32 pkt_ofs) 545 { 546 struct ata_port *ap = qc->ap; 547 struct pdc_host_priv *pp = ap->host->private_data; 548 unsigned int idx = pp->hdma_prod & PDC_HDMA_Q_MASK; 549 550 if (!pp->doing_hdma) { 551 __pdc20621_push_hdma(qc, seq, pkt_ofs); 552 pp->doing_hdma = 1; 553 return; 554 } 555 556 pp->hdma[idx].qc = qc; 557 pp->hdma[idx].seq = seq; 558 pp->hdma[idx].pkt_ofs = pkt_ofs; 559 pp->hdma_prod++; 560 } 561 562 static void pdc20621_pop_hdma(struct ata_queued_cmd *qc) 563 { 564 struct ata_port *ap = qc->ap; 565 struct pdc_host_priv *pp = ap->host->private_data; 566 unsigned int idx = pp->hdma_cons & PDC_HDMA_Q_MASK; 567 568 /* if nothing on queue, we're done */ 569 if (pp->hdma_prod == pp->hdma_cons) { 570 pp->doing_hdma = 0; 571 return; 572 } 573 574 __pdc20621_push_hdma(pp->hdma[idx].qc, pp->hdma[idx].seq, 575 pp->hdma[idx].pkt_ofs); 576 pp->hdma_cons++; 577 } 578 579 static void pdc20621_dump_hdma(struct ata_queued_cmd *qc) 580 { 581 struct ata_port *ap = qc->ap; 582 unsigned int port_no = ap->port_no; 583 void __iomem *dimm_mmio = ap->host->iomap[PDC_DIMM_BAR]; 584 585 dimm_mmio += (port_no * PDC_DIMM_WINDOW_STEP); 586 dimm_mmio += PDC_DIMM_HOST_PKT; 587 588 ata_port_dbg(ap, "HDMA 0x%08X 0x%08X 0x%08X 0x%08X\n", 589 readl(dimm_mmio), readl(dimm_mmio + 4), 590 readl(dimm_mmio + 8), readl(dimm_mmio + 12)); 591 } 592 593 static void pdc20621_packet_start(struct ata_queued_cmd *qc) 594 { 595 struct ata_port *ap = qc->ap; 596 struct ata_host *host = ap->host; 597 unsigned int port_no = ap->port_no; 598 void __iomem *mmio = host->iomap[PDC_MMIO_BAR]; 599 unsigned int rw = (qc->tf.flags & ATA_TFLAG_WRITE); 600 u8 seq = (u8) (port_no + 1); 601 unsigned int port_ofs; 602 603 /* hard-code chip #0 */ 604 mmio += PDC_CHIP0_OFS; 605 606 wmb(); /* flush PRD, pkt writes */ 607 608 port_ofs = PDC_20621_DIMM_BASE + (PDC_DIMM_WINDOW_STEP * port_no); 609 610 /* if writing, we (1) DMA to DIMM, then (2) do ATA command */ 611 if (rw && qc->tf.protocol == ATA_PROT_DMA) { 612 seq += 4; 613 614 pdc20621_dump_hdma(qc); 615 pdc20621_push_hdma(qc, seq, port_ofs + PDC_DIMM_HOST_PKT); 616 ata_port_dbg(ap, "queued ofs 0x%x (%u), seq %u\n", 617 port_ofs + PDC_DIMM_HOST_PKT, 618 port_ofs + PDC_DIMM_HOST_PKT, 619 seq); 620 } else { 621 writel(0x00000001, mmio + PDC_20621_SEQCTL + (seq * 4)); 622 readl(mmio + PDC_20621_SEQCTL + (seq * 4)); /* flush */ 623 624 writel(port_ofs + PDC_DIMM_ATA_PKT, 625 ap->ioaddr.cmd_addr + PDC_PKT_SUBMIT); 626 readl(ap->ioaddr.cmd_addr + PDC_PKT_SUBMIT); 627 ata_port_dbg(ap, "submitted ofs 0x%x (%u), seq %u\n", 628 port_ofs + PDC_DIMM_ATA_PKT, 629 port_ofs + PDC_DIMM_ATA_PKT, 630 seq); 631 } 632 } 633 634 static unsigned int pdc20621_qc_issue(struct ata_queued_cmd *qc) 635 { 636 switch (qc->tf.protocol) { 637 case ATA_PROT_NODATA: 638 if (qc->tf.flags & ATA_TFLAG_POLLING) 639 break; 640 fallthrough; 641 case ATA_PROT_DMA: 642 pdc20621_packet_start(qc); 643 return 0; 644 645 case ATAPI_PROT_DMA: 646 BUG(); 647 break; 648 649 default: 650 break; 651 } 652 653 return ata_sff_qc_issue(qc); 654 } 655 656 static inline unsigned int pdc20621_host_intr(struct ata_port *ap, 657 struct ata_queued_cmd *qc, 658 unsigned int doing_hdma, 659 void __iomem *mmio) 660 { 661 unsigned int port_no = ap->port_no; 662 unsigned int port_ofs = 663 PDC_20621_DIMM_BASE + (PDC_DIMM_WINDOW_STEP * port_no); 664 u8 status; 665 unsigned int handled = 0; 666 667 if ((qc->tf.protocol == ATA_PROT_DMA) && /* read */ 668 (!(qc->tf.flags & ATA_TFLAG_WRITE))) { 669 670 /* step two - DMA from DIMM to host */ 671 if (doing_hdma) { 672 ata_port_dbg(ap, "read hdma, 0x%x 0x%x\n", 673 readl(mmio + 0x104), readl(mmio + PDC_HDMA_CTLSTAT)); 674 /* get drive status; clear intr; complete txn */ 675 qc->err_mask |= ac_err_mask(ata_wait_idle(ap)); 676 ata_qc_complete(qc); 677 pdc20621_pop_hdma(qc); 678 } 679 680 /* step one - exec ATA command */ 681 else { 682 u8 seq = (u8) (port_no + 1 + 4); 683 ata_port_dbg(ap, "read ata, 0x%x 0x%x\n", 684 readl(mmio + 0x104), readl(mmio + PDC_HDMA_CTLSTAT)); 685 686 /* submit hdma pkt */ 687 pdc20621_dump_hdma(qc); 688 pdc20621_push_hdma(qc, seq, 689 port_ofs + PDC_DIMM_HOST_PKT); 690 } 691 handled = 1; 692 693 } else if (qc->tf.protocol == ATA_PROT_DMA) { /* write */ 694 695 /* step one - DMA from host to DIMM */ 696 if (doing_hdma) { 697 u8 seq = (u8) (port_no + 1); 698 ata_port_dbg(ap, "write hdma, 0x%x 0x%x\n", 699 readl(mmio + 0x104), readl(mmio + PDC_HDMA_CTLSTAT)); 700 701 /* submit ata pkt */ 702 writel(0x00000001, mmio + PDC_20621_SEQCTL + (seq * 4)); 703 readl(mmio + PDC_20621_SEQCTL + (seq * 4)); 704 writel(port_ofs + PDC_DIMM_ATA_PKT, 705 ap->ioaddr.cmd_addr + PDC_PKT_SUBMIT); 706 readl(ap->ioaddr.cmd_addr + PDC_PKT_SUBMIT); 707 } 708 709 /* step two - execute ATA command */ 710 else { 711 ata_port_dbg(ap, "write ata, 0x%x 0x%x\n", 712 readl(mmio + 0x104), readl(mmio + PDC_HDMA_CTLSTAT)); 713 /* get drive status; clear intr; complete txn */ 714 qc->err_mask |= ac_err_mask(ata_wait_idle(ap)); 715 ata_qc_complete(qc); 716 pdc20621_pop_hdma(qc); 717 } 718 handled = 1; 719 720 /* command completion, but no data xfer */ 721 } else if (qc->tf.protocol == ATA_PROT_NODATA) { 722 723 status = ata_sff_busy_wait(ap, ATA_BUSY | ATA_DRQ, 1000); 724 ata_port_dbg(ap, "BUS_NODATA (drv_stat 0x%X)\n", status); 725 qc->err_mask |= ac_err_mask(status); 726 ata_qc_complete(qc); 727 handled = 1; 728 729 } else { 730 ap->stats.idle_irq++; 731 } 732 733 return handled; 734 } 735 736 static void pdc20621_irq_clear(struct ata_port *ap) 737 { 738 ioread8(ap->ioaddr.status_addr); 739 } 740 741 static irqreturn_t pdc20621_interrupt(int irq, void *dev_instance) 742 { 743 struct ata_host *host = dev_instance; 744 struct ata_port *ap; 745 u32 mask = 0; 746 unsigned int i, tmp, port_no; 747 unsigned int handled = 0; 748 void __iomem *mmio_base; 749 750 if (!host || !host->iomap[PDC_MMIO_BAR]) 751 return IRQ_NONE; 752 753 mmio_base = host->iomap[PDC_MMIO_BAR]; 754 755 /* reading should also clear interrupts */ 756 mmio_base += PDC_CHIP0_OFS; 757 mask = readl(mmio_base + PDC_20621_SEQMASK); 758 759 if (mask == 0xffffffff) 760 return IRQ_NONE; 761 762 mask &= 0xffff; /* only 16 tags possible */ 763 if (!mask) 764 return IRQ_NONE; 765 766 spin_lock(&host->lock); 767 768 for (i = 1; i < 9; i++) { 769 port_no = i - 1; 770 if (port_no > 3) 771 port_no -= 4; 772 if (port_no >= host->n_ports) 773 ap = NULL; 774 else 775 ap = host->ports[port_no]; 776 tmp = mask & (1 << i); 777 if (ap) 778 ata_port_dbg(ap, "seq %u, tmp %x\n", i, tmp); 779 if (tmp && ap) { 780 struct ata_queued_cmd *qc; 781 782 qc = ata_qc_from_tag(ap, ap->link.active_tag); 783 if (qc && (!(qc->tf.flags & ATA_TFLAG_POLLING))) 784 handled += pdc20621_host_intr(ap, qc, (i > 4), 785 mmio_base); 786 } 787 } 788 789 spin_unlock(&host->lock); 790 791 return IRQ_RETVAL(handled); 792 } 793 794 static void pdc_freeze(struct ata_port *ap) 795 { 796 void __iomem *mmio = ap->ioaddr.cmd_addr; 797 u32 tmp; 798 799 /* FIXME: if all 4 ATA engines are stopped, also stop HDMA engine */ 800 801 tmp = readl(mmio + PDC_CTLSTAT); 802 tmp |= PDC_MASK_INT; 803 tmp &= ~PDC_DMA_ENABLE; 804 writel(tmp, mmio + PDC_CTLSTAT); 805 readl(mmio + PDC_CTLSTAT); /* flush */ 806 } 807 808 static void pdc_thaw(struct ata_port *ap) 809 { 810 void __iomem *mmio = ap->ioaddr.cmd_addr; 811 u32 tmp; 812 813 /* FIXME: start HDMA engine, if zero ATA engines running */ 814 815 /* clear IRQ */ 816 ioread8(ap->ioaddr.status_addr); 817 818 /* turn IRQ back on */ 819 tmp = readl(mmio + PDC_CTLSTAT); 820 tmp &= ~PDC_MASK_INT; 821 writel(tmp, mmio + PDC_CTLSTAT); 822 readl(mmio + PDC_CTLSTAT); /* flush */ 823 } 824 825 static void pdc_reset_port(struct ata_port *ap) 826 { 827 void __iomem *mmio = ap->ioaddr.cmd_addr + PDC_CTLSTAT; 828 unsigned int i; 829 u32 tmp; 830 831 /* FIXME: handle HDMA copy engine */ 832 833 for (i = 11; i > 0; i--) { 834 tmp = readl(mmio); 835 if (tmp & PDC_RESET) 836 break; 837 838 udelay(100); 839 840 tmp |= PDC_RESET; 841 writel(tmp, mmio); 842 } 843 844 tmp &= ~PDC_RESET; 845 writel(tmp, mmio); 846 readl(mmio); /* flush */ 847 } 848 849 static int pdc_softreset(struct ata_link *link, unsigned int *class, 850 unsigned long deadline) 851 { 852 pdc_reset_port(link->ap); 853 return ata_sff_softreset(link, class, deadline); 854 } 855 856 static void pdc_error_handler(struct ata_port *ap) 857 { 858 if (!(ap->pflags & ATA_PFLAG_FROZEN)) 859 pdc_reset_port(ap); 860 861 ata_sff_error_handler(ap); 862 } 863 864 static void pdc_post_internal_cmd(struct ata_queued_cmd *qc) 865 { 866 struct ata_port *ap = qc->ap; 867 868 /* make DMA engine forget about the failed command */ 869 if (qc->flags & ATA_QCFLAG_FAILED) 870 pdc_reset_port(ap); 871 } 872 873 static int pdc_check_atapi_dma(struct ata_queued_cmd *qc) 874 { 875 u8 *scsicmd = qc->scsicmd->cmnd; 876 int pio = 1; /* atapi dma off by default */ 877 878 /* Whitelist commands that may use DMA. */ 879 switch (scsicmd[0]) { 880 case WRITE_12: 881 case WRITE_10: 882 case WRITE_6: 883 case READ_12: 884 case READ_10: 885 case READ_6: 886 case 0xad: /* READ_DVD_STRUCTURE */ 887 case 0xbe: /* READ_CD */ 888 pio = 0; 889 } 890 /* -45150 (FFFF4FA2) to -1 (FFFFFFFF) shall use PIO mode */ 891 if (scsicmd[0] == WRITE_10) { 892 unsigned int lba = 893 (scsicmd[2] << 24) | 894 (scsicmd[3] << 16) | 895 (scsicmd[4] << 8) | 896 scsicmd[5]; 897 if (lba >= 0xFFFF4FA2) 898 pio = 1; 899 } 900 return pio; 901 } 902 903 static void pdc_tf_load_mmio(struct ata_port *ap, const struct ata_taskfile *tf) 904 { 905 WARN_ON(tf->protocol == ATA_PROT_DMA || 906 tf->protocol == ATAPI_PROT_DMA); 907 ata_sff_tf_load(ap, tf); 908 } 909 910 911 static void pdc_exec_command_mmio(struct ata_port *ap, const struct ata_taskfile *tf) 912 { 913 WARN_ON(tf->protocol == ATA_PROT_DMA || 914 tf->protocol == ATAPI_PROT_DMA); 915 ata_sff_exec_command(ap, tf); 916 } 917 918 919 static void pdc_sata_setup_port(struct ata_ioports *port, void __iomem *base) 920 { 921 port->cmd_addr = base; 922 port->data_addr = base; 923 port->feature_addr = 924 port->error_addr = base + 0x4; 925 port->nsect_addr = base + 0x8; 926 port->lbal_addr = base + 0xc; 927 port->lbam_addr = base + 0x10; 928 port->lbah_addr = base + 0x14; 929 port->device_addr = base + 0x18; 930 port->command_addr = 931 port->status_addr = base + 0x1c; 932 port->altstatus_addr = 933 port->ctl_addr = base + 0x38; 934 } 935 936 937 static void pdc20621_get_from_dimm(struct ata_host *host, void *psource, 938 u32 offset, u32 size) 939 { 940 u32 window_size; 941 u16 idx; 942 u8 page_mask; 943 long dist; 944 void __iomem *mmio = host->iomap[PDC_MMIO_BAR]; 945 void __iomem *dimm_mmio = host->iomap[PDC_DIMM_BAR]; 946 947 /* hard-code chip #0 */ 948 mmio += PDC_CHIP0_OFS; 949 950 page_mask = 0x00; 951 window_size = 0x2000 * 4; /* 32K byte uchar size */ 952 idx = (u16) (offset / window_size); 953 954 writel(0x01, mmio + PDC_GENERAL_CTLR); 955 readl(mmio + PDC_GENERAL_CTLR); 956 writel(((idx) << page_mask), mmio + PDC_DIMM_WINDOW_CTLR); 957 readl(mmio + PDC_DIMM_WINDOW_CTLR); 958 959 offset -= (idx * window_size); 960 idx++; 961 dist = ((long) (window_size - (offset + size))) >= 0 ? size : 962 (long) (window_size - offset); 963 memcpy_fromio(psource, dimm_mmio + offset / 4, dist); 964 965 psource += dist; 966 size -= dist; 967 for (; (long) size >= (long) window_size ;) { 968 writel(0x01, mmio + PDC_GENERAL_CTLR); 969 readl(mmio + PDC_GENERAL_CTLR); 970 writel(((idx) << page_mask), mmio + PDC_DIMM_WINDOW_CTLR); 971 readl(mmio + PDC_DIMM_WINDOW_CTLR); 972 memcpy_fromio(psource, dimm_mmio, window_size / 4); 973 psource += window_size; 974 size -= window_size; 975 idx++; 976 } 977 978 if (size) { 979 writel(0x01, mmio + PDC_GENERAL_CTLR); 980 readl(mmio + PDC_GENERAL_CTLR); 981 writel(((idx) << page_mask), mmio + PDC_DIMM_WINDOW_CTLR); 982 readl(mmio + PDC_DIMM_WINDOW_CTLR); 983 memcpy_fromio(psource, dimm_mmio, size / 4); 984 } 985 } 986 987 988 static void pdc20621_put_to_dimm(struct ata_host *host, void *psource, 989 u32 offset, u32 size) 990 { 991 u32 window_size; 992 u16 idx; 993 u8 page_mask; 994 long dist; 995 void __iomem *mmio = host->iomap[PDC_MMIO_BAR]; 996 void __iomem *dimm_mmio = host->iomap[PDC_DIMM_BAR]; 997 998 /* hard-code chip #0 */ 999 mmio += PDC_CHIP0_OFS; 1000 1001 page_mask = 0x00; 1002 window_size = 0x2000 * 4; /* 32K byte uchar size */ 1003 idx = (u16) (offset / window_size); 1004 1005 writel(((idx) << page_mask), mmio + PDC_DIMM_WINDOW_CTLR); 1006 readl(mmio + PDC_DIMM_WINDOW_CTLR); 1007 offset -= (idx * window_size); 1008 idx++; 1009 dist = ((long)(s32)(window_size - (offset + size))) >= 0 ? size : 1010 (long) (window_size - offset); 1011 memcpy_toio(dimm_mmio + offset / 4, psource, dist); 1012 writel(0x01, mmio + PDC_GENERAL_CTLR); 1013 readl(mmio + PDC_GENERAL_CTLR); 1014 1015 psource += dist; 1016 size -= dist; 1017 for (; (long) size >= (long) window_size ;) { 1018 writel(((idx) << page_mask), mmio + PDC_DIMM_WINDOW_CTLR); 1019 readl(mmio + PDC_DIMM_WINDOW_CTLR); 1020 memcpy_toio(dimm_mmio, psource, window_size / 4); 1021 writel(0x01, mmio + PDC_GENERAL_CTLR); 1022 readl(mmio + PDC_GENERAL_CTLR); 1023 psource += window_size; 1024 size -= window_size; 1025 idx++; 1026 } 1027 1028 if (size) { 1029 writel(((idx) << page_mask), mmio + PDC_DIMM_WINDOW_CTLR); 1030 readl(mmio + PDC_DIMM_WINDOW_CTLR); 1031 memcpy_toio(dimm_mmio, psource, size / 4); 1032 writel(0x01, mmio + PDC_GENERAL_CTLR); 1033 readl(mmio + PDC_GENERAL_CTLR); 1034 } 1035 } 1036 1037 1038 static unsigned int pdc20621_i2c_read(struct ata_host *host, u32 device, 1039 u32 subaddr, u32 *pdata) 1040 { 1041 void __iomem *mmio = host->iomap[PDC_MMIO_BAR]; 1042 u32 i2creg = 0; 1043 u32 status; 1044 u32 count = 0; 1045 1046 /* hard-code chip #0 */ 1047 mmio += PDC_CHIP0_OFS; 1048 1049 i2creg |= device << 24; 1050 i2creg |= subaddr << 16; 1051 1052 /* Set the device and subaddress */ 1053 writel(i2creg, mmio + PDC_I2C_ADDR_DATA); 1054 readl(mmio + PDC_I2C_ADDR_DATA); 1055 1056 /* Write Control to perform read operation, mask int */ 1057 writel(PDC_I2C_READ | PDC_I2C_START | PDC_I2C_MASK_INT, 1058 mmio + PDC_I2C_CONTROL); 1059 1060 for (count = 0; count <= 1000; count ++) { 1061 status = readl(mmio + PDC_I2C_CONTROL); 1062 if (status & PDC_I2C_COMPLETE) { 1063 status = readl(mmio + PDC_I2C_ADDR_DATA); 1064 break; 1065 } else if (count == 1000) 1066 return 0; 1067 } 1068 1069 *pdata = (status >> 8) & 0x000000ff; 1070 return 1; 1071 } 1072 1073 1074 static int pdc20621_detect_dimm(struct ata_host *host) 1075 { 1076 u32 data = 0; 1077 if (pdc20621_i2c_read(host, PDC_DIMM0_SPD_DEV_ADDRESS, 1078 PDC_DIMM_SPD_SYSTEM_FREQ, &data)) { 1079 if (data == 100) 1080 return 100; 1081 } else 1082 return 0; 1083 1084 if (pdc20621_i2c_read(host, PDC_DIMM0_SPD_DEV_ADDRESS, 9, &data)) { 1085 if (data <= 0x75) 1086 return 133; 1087 } else 1088 return 0; 1089 1090 return 0; 1091 } 1092 1093 1094 static int pdc20621_prog_dimm0(struct ata_host *host) 1095 { 1096 u32 spd0[50]; 1097 u32 data = 0; 1098 int size, i; 1099 u8 bdimmsize; 1100 void __iomem *mmio = host->iomap[PDC_MMIO_BAR]; 1101 static const struct { 1102 unsigned int reg; 1103 unsigned int ofs; 1104 } pdc_i2c_read_data [] = { 1105 { PDC_DIMM_SPD_TYPE, 11 }, 1106 { PDC_DIMM_SPD_FRESH_RATE, 12 }, 1107 { PDC_DIMM_SPD_COLUMN_NUM, 4 }, 1108 { PDC_DIMM_SPD_ATTRIBUTE, 21 }, 1109 { PDC_DIMM_SPD_ROW_NUM, 3 }, 1110 { PDC_DIMM_SPD_BANK_NUM, 17 }, 1111 { PDC_DIMM_SPD_MODULE_ROW, 5 }, 1112 { PDC_DIMM_SPD_ROW_PRE_CHARGE, 27 }, 1113 { PDC_DIMM_SPD_ROW_ACTIVE_DELAY, 28 }, 1114 { PDC_DIMM_SPD_RAS_CAS_DELAY, 29 }, 1115 { PDC_DIMM_SPD_ACTIVE_PRECHARGE, 30 }, 1116 { PDC_DIMM_SPD_CAS_LATENCY, 18 }, 1117 }; 1118 1119 /* hard-code chip #0 */ 1120 mmio += PDC_CHIP0_OFS; 1121 1122 for (i = 0; i < ARRAY_SIZE(pdc_i2c_read_data); i++) 1123 pdc20621_i2c_read(host, PDC_DIMM0_SPD_DEV_ADDRESS, 1124 pdc_i2c_read_data[i].reg, 1125 &spd0[pdc_i2c_read_data[i].ofs]); 1126 1127 data |= (spd0[4] - 8) | ((spd0[21] != 0) << 3) | ((spd0[3]-11) << 4); 1128 data |= ((spd0[17] / 4) << 6) | ((spd0[5] / 2) << 7) | 1129 ((((spd0[27] + 9) / 10) - 1) << 8) ; 1130 data |= (((((spd0[29] > spd0[28]) 1131 ? spd0[29] : spd0[28]) + 9) / 10) - 1) << 10; 1132 data |= ((spd0[30] - spd0[29] + 9) / 10 - 2) << 12; 1133 1134 if (spd0[18] & 0x08) 1135 data |= ((0x03) << 14); 1136 else if (spd0[18] & 0x04) 1137 data |= ((0x02) << 14); 1138 else if (spd0[18] & 0x01) 1139 data |= ((0x01) << 14); 1140 else 1141 data |= (0 << 14); 1142 1143 /* 1144 Calculate the size of bDIMMSize (power of 2) and 1145 merge the DIMM size by program start/end address. 1146 */ 1147 1148 bdimmsize = spd0[4] + (spd0[5] / 2) + spd0[3] + (spd0[17] / 2) + 3; 1149 size = (1 << bdimmsize) >> 20; /* size = xxx(MB) */ 1150 data |= (((size / 16) - 1) << 16); 1151 data |= (0 << 23); 1152 data |= 8; 1153 writel(data, mmio + PDC_DIMM0_CONTROL); 1154 readl(mmio + PDC_DIMM0_CONTROL); 1155 return size; 1156 } 1157 1158 1159 static unsigned int pdc20621_prog_dimm_global(struct ata_host *host) 1160 { 1161 u32 data, spd0; 1162 int error, i; 1163 void __iomem *mmio = host->iomap[PDC_MMIO_BAR]; 1164 1165 /* hard-code chip #0 */ 1166 mmio += PDC_CHIP0_OFS; 1167 1168 /* 1169 Set To Default : DIMM Module Global Control Register (0x022259F1) 1170 DIMM Arbitration Disable (bit 20) 1171 DIMM Data/Control Output Driving Selection (bit12 - bit15) 1172 Refresh Enable (bit 17) 1173 */ 1174 1175 data = 0x022259F1; 1176 writel(data, mmio + PDC_SDRAM_CONTROL); 1177 readl(mmio + PDC_SDRAM_CONTROL); 1178 1179 /* Turn on for ECC */ 1180 if (!pdc20621_i2c_read(host, PDC_DIMM0_SPD_DEV_ADDRESS, 1181 PDC_DIMM_SPD_TYPE, &spd0)) { 1182 dev_err(host->dev, 1183 "Failed in i2c read: device=%#x, subaddr=%#x\n", 1184 PDC_DIMM0_SPD_DEV_ADDRESS, PDC_DIMM_SPD_TYPE); 1185 return 1; 1186 } 1187 if (spd0 == 0x02) { 1188 data |= (0x01 << 16); 1189 writel(data, mmio + PDC_SDRAM_CONTROL); 1190 readl(mmio + PDC_SDRAM_CONTROL); 1191 dev_err(host->dev, "Local DIMM ECC Enabled\n"); 1192 } 1193 1194 /* DIMM Initialization Select/Enable (bit 18/19) */ 1195 data &= (~(1<<18)); 1196 data |= (1<<19); 1197 writel(data, mmio + PDC_SDRAM_CONTROL); 1198 1199 error = 1; 1200 for (i = 1; i <= 10; i++) { /* polling ~5 secs */ 1201 data = readl(mmio + PDC_SDRAM_CONTROL); 1202 if (!(data & (1<<19))) { 1203 error = 0; 1204 break; 1205 } 1206 msleep(i*100); 1207 } 1208 return error; 1209 } 1210 1211 1212 static unsigned int pdc20621_dimm_init(struct ata_host *host) 1213 { 1214 int speed, size, length; 1215 u32 addr, spd0, pci_status; 1216 u32 time_period = 0; 1217 u32 tcount = 0; 1218 u32 ticks = 0; 1219 u32 clock = 0; 1220 u32 fparam = 0; 1221 void __iomem *mmio = host->iomap[PDC_MMIO_BAR]; 1222 1223 /* hard-code chip #0 */ 1224 mmio += PDC_CHIP0_OFS; 1225 1226 /* Initialize PLL based upon PCI Bus Frequency */ 1227 1228 /* Initialize Time Period Register */ 1229 writel(0xffffffff, mmio + PDC_TIME_PERIOD); 1230 time_period = readl(mmio + PDC_TIME_PERIOD); 1231 dev_dbg(host->dev, "Time Period Register (0x40): 0x%x\n", time_period); 1232 1233 /* Enable timer */ 1234 writel(PDC_TIMER_DEFAULT, mmio + PDC_TIME_CONTROL); 1235 readl(mmio + PDC_TIME_CONTROL); 1236 1237 /* Wait 3 seconds */ 1238 msleep(3000); 1239 1240 /* 1241 When timer is enabled, counter is decreased every internal 1242 clock cycle. 1243 */ 1244 1245 tcount = readl(mmio + PDC_TIME_COUNTER); 1246 dev_dbg(host->dev, "Time Counter Register (0x44): 0x%x\n", tcount); 1247 1248 /* 1249 If SX4 is on PCI-X bus, after 3 seconds, the timer counter 1250 register should be >= (0xffffffff - 3x10^8). 1251 */ 1252 if (tcount >= PCI_X_TCOUNT) { 1253 ticks = (time_period - tcount); 1254 dev_dbg(host->dev, "Num counters 0x%x (%d)\n", ticks, ticks); 1255 1256 clock = (ticks / 300000); 1257 dev_dbg(host->dev, "10 * Internal clk = 0x%x (%d)\n", 1258 clock, clock); 1259 1260 clock = (clock * 33); 1261 dev_dbg(host->dev, "10 * Internal clk * 33 = 0x%x (%d)\n", 1262 clock, clock); 1263 1264 /* PLL F Param (bit 22:16) */ 1265 fparam = (1400000 / clock) - 2; 1266 dev_dbg(host->dev, "PLL F Param: 0x%x (%d)\n", fparam, fparam); 1267 1268 /* OD param = 0x2 (bit 31:30), R param = 0x5 (bit 29:25) */ 1269 pci_status = (0x8a001824 | (fparam << 16)); 1270 } else 1271 pci_status = PCI_PLL_INIT; 1272 1273 /* Initialize PLL. */ 1274 dev_dbg(host->dev, "pci_status: 0x%x\n", pci_status); 1275 writel(pci_status, mmio + PDC_CTL_STATUS); 1276 readl(mmio + PDC_CTL_STATUS); 1277 1278 /* 1279 Read SPD of DIMM by I2C interface, 1280 and program the DIMM Module Controller. 1281 */ 1282 if (!(speed = pdc20621_detect_dimm(host))) { 1283 dev_err(host->dev, "Detect Local DIMM Fail\n"); 1284 return 1; /* DIMM error */ 1285 } 1286 dev_dbg(host->dev, "Local DIMM Speed = %d\n", speed); 1287 1288 /* Programming DIMM0 Module Control Register (index_CID0:80h) */ 1289 size = pdc20621_prog_dimm0(host); 1290 dev_dbg(host->dev, "Local DIMM Size = %dMB\n", size); 1291 1292 /* Programming DIMM Module Global Control Register (index_CID0:88h) */ 1293 if (pdc20621_prog_dimm_global(host)) { 1294 dev_err(host->dev, 1295 "Programming DIMM Module Global Control Register Fail\n"); 1296 return 1; 1297 } 1298 1299 if (dimm_test) { 1300 u8 test_parttern1[40] = 1301 {0x55,0xAA,'P','r','o','m','i','s','e',' ', 1302 'N','o','t',' ','Y','e','t',' ', 1303 'D','e','f','i','n','e','d',' ', 1304 '1','.','1','0', 1305 '9','8','0','3','1','6','1','2',0,0}; 1306 u8 test_parttern2[40] = {0}; 1307 1308 pdc20621_put_to_dimm(host, test_parttern2, 0x10040, 40); 1309 pdc20621_put_to_dimm(host, test_parttern2, 0x40, 40); 1310 1311 pdc20621_put_to_dimm(host, test_parttern1, 0x10040, 40); 1312 pdc20621_get_from_dimm(host, test_parttern2, 0x40, 40); 1313 dev_info(host->dev, "DIMM test pattern 1: %x, %x, %s\n", test_parttern2[0], 1314 test_parttern2[1], &(test_parttern2[2])); 1315 pdc20621_get_from_dimm(host, test_parttern2, 0x10040, 1316 40); 1317 dev_info(host->dev, "DIMM test pattern 2: %x, %x, %s\n", 1318 test_parttern2[0], 1319 test_parttern2[1], &(test_parttern2[2])); 1320 1321 pdc20621_put_to_dimm(host, test_parttern1, 0x40, 40); 1322 pdc20621_get_from_dimm(host, test_parttern2, 0x40, 40); 1323 dev_info(host->dev, "DIMM test pattern 3: %x, %x, %s\n", 1324 test_parttern2[0], 1325 test_parttern2[1], &(test_parttern2[2])); 1326 } 1327 1328 /* ECC initiliazation. */ 1329 1330 if (!pdc20621_i2c_read(host, PDC_DIMM0_SPD_DEV_ADDRESS, 1331 PDC_DIMM_SPD_TYPE, &spd0)) { 1332 dev_err(host->dev, 1333 "Failed in i2c read: device=%#x, subaddr=%#x\n", 1334 PDC_DIMM0_SPD_DEV_ADDRESS, PDC_DIMM_SPD_TYPE); 1335 return 1; 1336 } 1337 if (spd0 == 0x02) { 1338 void *buf; 1339 dev_dbg(host->dev, "Start ECC initialization\n"); 1340 addr = 0; 1341 length = size * 1024 * 1024; 1342 buf = kzalloc(ECC_ERASE_BUF_SZ, GFP_KERNEL); 1343 if (!buf) 1344 return 1; 1345 while (addr < length) { 1346 pdc20621_put_to_dimm(host, buf, addr, 1347 ECC_ERASE_BUF_SZ); 1348 addr += ECC_ERASE_BUF_SZ; 1349 } 1350 kfree(buf); 1351 dev_dbg(host->dev, "Finish ECC initialization\n"); 1352 } 1353 return 0; 1354 } 1355 1356 1357 static void pdc_20621_init(struct ata_host *host) 1358 { 1359 u32 tmp; 1360 void __iomem *mmio = host->iomap[PDC_MMIO_BAR]; 1361 1362 /* hard-code chip #0 */ 1363 mmio += PDC_CHIP0_OFS; 1364 1365 /* 1366 * Select page 0x40 for our 32k DIMM window 1367 */ 1368 tmp = readl(mmio + PDC_20621_DIMM_WINDOW) & 0xffff0000; 1369 tmp |= PDC_PAGE_WINDOW; /* page 40h; arbitrarily selected */ 1370 writel(tmp, mmio + PDC_20621_DIMM_WINDOW); 1371 1372 /* 1373 * Reset Host DMA 1374 */ 1375 tmp = readl(mmio + PDC_HDMA_CTLSTAT); 1376 tmp |= PDC_RESET; 1377 writel(tmp, mmio + PDC_HDMA_CTLSTAT); 1378 readl(mmio + PDC_HDMA_CTLSTAT); /* flush */ 1379 1380 udelay(10); 1381 1382 tmp = readl(mmio + PDC_HDMA_CTLSTAT); 1383 tmp &= ~PDC_RESET; 1384 writel(tmp, mmio + PDC_HDMA_CTLSTAT); 1385 readl(mmio + PDC_HDMA_CTLSTAT); /* flush */ 1386 } 1387 1388 static int pdc_sata_init_one(struct pci_dev *pdev, 1389 const struct pci_device_id *ent) 1390 { 1391 const struct ata_port_info *ppi[] = 1392 { &pdc_port_info[ent->driver_data], NULL }; 1393 struct ata_host *host; 1394 struct pdc_host_priv *hpriv; 1395 int i, rc; 1396 1397 ata_print_version_once(&pdev->dev, DRV_VERSION); 1398 1399 /* allocate host */ 1400 host = ata_host_alloc_pinfo(&pdev->dev, ppi, 4); 1401 hpriv = devm_kzalloc(&pdev->dev, sizeof(*hpriv), GFP_KERNEL); 1402 if (!host || !hpriv) 1403 return -ENOMEM; 1404 1405 host->private_data = hpriv; 1406 1407 /* acquire resources and fill host */ 1408 rc = pcim_enable_device(pdev); 1409 if (rc) 1410 return rc; 1411 1412 rc = pcim_iomap_regions(pdev, (1 << PDC_MMIO_BAR) | (1 << PDC_DIMM_BAR), 1413 DRV_NAME); 1414 if (rc == -EBUSY) 1415 pcim_pin_device(pdev); 1416 if (rc) 1417 return rc; 1418 host->iomap = pcim_iomap_table(pdev); 1419 1420 for (i = 0; i < 4; i++) { 1421 struct ata_port *ap = host->ports[i]; 1422 void __iomem *base = host->iomap[PDC_MMIO_BAR] + PDC_CHIP0_OFS; 1423 unsigned int offset = 0x200 + i * 0x80; 1424 1425 pdc_sata_setup_port(&ap->ioaddr, base + offset); 1426 1427 ata_port_pbar_desc(ap, PDC_MMIO_BAR, -1, "mmio"); 1428 ata_port_pbar_desc(ap, PDC_DIMM_BAR, -1, "dimm"); 1429 ata_port_pbar_desc(ap, PDC_MMIO_BAR, offset, "port"); 1430 } 1431 1432 /* configure and activate */ 1433 rc = dma_set_mask_and_coherent(&pdev->dev, ATA_DMA_MASK); 1434 if (rc) 1435 return rc; 1436 1437 if (pdc20621_dimm_init(host)) 1438 return -ENOMEM; 1439 pdc_20621_init(host); 1440 1441 pci_set_master(pdev); 1442 return ata_host_activate(host, pdev->irq, pdc20621_interrupt, 1443 IRQF_SHARED, &pdc_sata_sht); 1444 } 1445 1446 module_pci_driver(pdc_sata_pci_driver); 1447 1448 MODULE_AUTHOR("Jeff Garzik"); 1449 MODULE_DESCRIPTION("Promise SATA low-level driver"); 1450 MODULE_LICENSE("GPL"); 1451 MODULE_DEVICE_TABLE(pci, pdc_sata_pci_tbl); 1452 MODULE_VERSION(DRV_VERSION); 1453