1 /* 2 * HighPoint RR3xxx controller driver for Linux 3 * Copyright (C) 2006 HighPoint Technologies, Inc. All Rights Reserved. 4 * 5 * This program is free software; you can redistribute it and/or modify 6 * it under the terms of the GNU General Public License as published by 7 * the Free Software Foundation; version 2 of the License. 8 * 9 * This program is distributed in the hope that it will be useful, 10 * but WITHOUT ANY WARRANTY; without even the implied warranty of 11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 12 * GNU General Public License for more details. 13 * 14 * Please report bugs/comments/suggestions to linux@highpoint-tech.com 15 * 16 * For more information, visit http://www.highpoint-tech.com 17 */ 18 #include <linux/module.h> 19 #include <linux/types.h> 20 #include <linux/string.h> 21 #include <linux/kernel.h> 22 #include <linux/pci.h> 23 #include <linux/interrupt.h> 24 #include <linux/errno.h> 25 #include <linux/delay.h> 26 #include <linux/timer.h> 27 #include <linux/spinlock.h> 28 #include <linux/hdreg.h> 29 #include <asm/uaccess.h> 30 #include <asm/io.h> 31 #include <asm/div64.h> 32 #include <scsi/scsi_cmnd.h> 33 #include <scsi/scsi_device.h> 34 #include <scsi/scsi.h> 35 #include <scsi/scsi_tcq.h> 36 #include <scsi/scsi_host.h> 37 38 #include "hptiop.h" 39 40 MODULE_AUTHOR("HighPoint Technologies, Inc."); 41 MODULE_DESCRIPTION("HighPoint RocketRAID 3xxx SATA Controller Driver"); 42 43 static char driver_name[] = "hptiop"; 44 static const char driver_name_long[] = "RocketRAID 3xxx SATA Controller driver"; 45 static const char driver_ver[] = "v1.0 (060426)"; 46 47 static void hptiop_host_request_callback(struct hptiop_hba *hba, u32 tag); 48 static void hptiop_iop_request_callback(struct hptiop_hba *hba, u32 tag); 49 static void hptiop_message_callback(struct hptiop_hba *hba, u32 msg); 50 51 static inline void hptiop_pci_posting_flush(struct hpt_iopmu __iomem *iop) 52 { 53 readl(&iop->outbound_intstatus); 54 } 55 56 static int iop_wait_ready(struct hpt_iopmu __iomem *iop, u32 millisec) 57 { 58 u32 req = 0; 59 int i; 60 61 for (i = 0; i < millisec; i++) { 62 req = readl(&iop->inbound_queue); 63 if (req != IOPMU_QUEUE_EMPTY) 64 break; 65 msleep(1); 66 } 67 68 if (req != IOPMU_QUEUE_EMPTY) { 69 writel(req, &iop->outbound_queue); 70 hptiop_pci_posting_flush(iop); 71 return 0; 72 } 73 74 return -1; 75 } 76 77 static void hptiop_request_callback(struct hptiop_hba *hba, u32 tag) 78 { 79 if ((tag & IOPMU_QUEUE_MASK_HOST_BITS) == IOPMU_QUEUE_ADDR_HOST_BIT) 80 return hptiop_host_request_callback(hba, 81 tag & ~IOPMU_QUEUE_ADDR_HOST_BIT); 82 else 83 return hptiop_iop_request_callback(hba, tag); 84 } 85 86 static inline void hptiop_drain_outbound_queue(struct hptiop_hba *hba) 87 { 88 u32 req; 89 90 while ((req = readl(&hba->iop->outbound_queue)) != IOPMU_QUEUE_EMPTY) { 91 92 if (req & IOPMU_QUEUE_MASK_HOST_BITS) 93 hptiop_request_callback(hba, req); 94 else { 95 struct hpt_iop_request_header __iomem * p; 96 97 p = (struct hpt_iop_request_header __iomem *) 98 ((char __iomem *)hba->iop + req); 99 100 if (readl(&p->flags) & IOP_REQUEST_FLAG_SYNC_REQUEST) { 101 if (readl(&p->context)) 102 hptiop_request_callback(hba, req); 103 else 104 writel(1, &p->context); 105 } 106 else 107 hptiop_request_callback(hba, req); 108 } 109 } 110 } 111 112 static int __iop_intr(struct hptiop_hba *hba) 113 { 114 struct hpt_iopmu __iomem *iop = hba->iop; 115 u32 status; 116 int ret = 0; 117 118 status = readl(&iop->outbound_intstatus); 119 120 if (status & IOPMU_OUTBOUND_INT_MSG0) { 121 u32 msg = readl(&iop->outbound_msgaddr0); 122 dprintk("received outbound msg %x\n", msg); 123 writel(IOPMU_OUTBOUND_INT_MSG0, &iop->outbound_intstatus); 124 hptiop_message_callback(hba, msg); 125 ret = 1; 126 } 127 128 if (status & IOPMU_OUTBOUND_INT_POSTQUEUE) { 129 hptiop_drain_outbound_queue(hba); 130 ret = 1; 131 } 132 133 return ret; 134 } 135 136 static int iop_send_sync_request(struct hptiop_hba *hba, 137 void __iomem *_req, u32 millisec) 138 { 139 struct hpt_iop_request_header __iomem *req = _req; 140 u32 i; 141 142 writel(readl(&req->flags) | IOP_REQUEST_FLAG_SYNC_REQUEST, 143 &req->flags); 144 145 writel(0, &req->context); 146 147 writel((unsigned long)req - (unsigned long)hba->iop, 148 &hba->iop->inbound_queue); 149 150 hptiop_pci_posting_flush(hba->iop); 151 152 for (i = 0; i < millisec; i++) { 153 __iop_intr(hba); 154 if (readl(&req->context)) 155 return 0; 156 msleep(1); 157 } 158 159 return -1; 160 } 161 162 static int iop_send_sync_msg(struct hptiop_hba *hba, u32 msg, u32 millisec) 163 { 164 u32 i; 165 166 hba->msg_done = 0; 167 168 writel(msg, &hba->iop->inbound_msgaddr0); 169 170 hptiop_pci_posting_flush(hba->iop); 171 172 for (i = 0; i < millisec; i++) { 173 spin_lock_irq(hba->host->host_lock); 174 __iop_intr(hba); 175 spin_unlock_irq(hba->host->host_lock); 176 if (hba->msg_done) 177 break; 178 msleep(1); 179 } 180 181 return hba->msg_done? 0 : -1; 182 } 183 184 static int iop_get_config(struct hptiop_hba *hba, 185 struct hpt_iop_request_get_config *config) 186 { 187 u32 req32; 188 struct hpt_iop_request_get_config __iomem *req; 189 190 req32 = readl(&hba->iop->inbound_queue); 191 if (req32 == IOPMU_QUEUE_EMPTY) 192 return -1; 193 194 req = (struct hpt_iop_request_get_config __iomem *) 195 ((unsigned long)hba->iop + req32); 196 197 writel(0, &req->header.flags); 198 writel(IOP_REQUEST_TYPE_GET_CONFIG, &req->header.type); 199 writel(sizeof(struct hpt_iop_request_get_config), &req->header.size); 200 writel(IOP_RESULT_PENDING, &req->header.result); 201 202 if (iop_send_sync_request(hba, req, 20000)) { 203 dprintk("Get config send cmd failed\n"); 204 return -1; 205 } 206 207 memcpy_fromio(config, req, sizeof(*config)); 208 writel(req32, &hba->iop->outbound_queue); 209 return 0; 210 } 211 212 static int iop_set_config(struct hptiop_hba *hba, 213 struct hpt_iop_request_set_config *config) 214 { 215 u32 req32; 216 struct hpt_iop_request_set_config __iomem *req; 217 218 req32 = readl(&hba->iop->inbound_queue); 219 if (req32 == IOPMU_QUEUE_EMPTY) 220 return -1; 221 222 req = (struct hpt_iop_request_set_config __iomem *) 223 ((unsigned long)hba->iop + req32); 224 225 memcpy_toio((u8 __iomem *)req + sizeof(struct hpt_iop_request_header), 226 (u8 *)config + sizeof(struct hpt_iop_request_header), 227 sizeof(struct hpt_iop_request_set_config) - 228 sizeof(struct hpt_iop_request_header)); 229 230 writel(0, &req->header.flags); 231 writel(IOP_REQUEST_TYPE_SET_CONFIG, &req->header.type); 232 writel(sizeof(struct hpt_iop_request_set_config), &req->header.size); 233 writel(IOP_RESULT_PENDING, &req->header.result); 234 235 if (iop_send_sync_request(hba, req, 20000)) { 236 dprintk("Set config send cmd failed\n"); 237 return -1; 238 } 239 240 writel(req32, &hba->iop->outbound_queue); 241 return 0; 242 } 243 244 static int hptiop_initialize_iop(struct hptiop_hba *hba) 245 { 246 struct hpt_iopmu __iomem *iop = hba->iop; 247 248 /* enable interrupts */ 249 writel(~(IOPMU_OUTBOUND_INT_POSTQUEUE | IOPMU_OUTBOUND_INT_MSG0), 250 &iop->outbound_intmask); 251 252 hba->initialized = 1; 253 254 /* start background tasks */ 255 if (iop_send_sync_msg(hba, 256 IOPMU_INBOUND_MSG0_START_BACKGROUND_TASK, 5000)) { 257 printk(KERN_ERR "scsi%d: fail to start background task\n", 258 hba->host->host_no); 259 return -1; 260 } 261 return 0; 262 } 263 264 static int hptiop_map_pci_bar(struct hptiop_hba *hba) 265 { 266 u32 mem_base_phy, length; 267 void __iomem *mem_base_virt; 268 struct pci_dev *pcidev = hba->pcidev; 269 270 if (!(pci_resource_flags(pcidev, 0) & IORESOURCE_MEM)) { 271 printk(KERN_ERR "scsi%d: pci resource invalid\n", 272 hba->host->host_no); 273 return -1; 274 } 275 276 mem_base_phy = pci_resource_start(pcidev, 0); 277 length = pci_resource_len(pcidev, 0); 278 mem_base_virt = ioremap(mem_base_phy, length); 279 280 if (!mem_base_virt) { 281 printk(KERN_ERR "scsi%d: Fail to ioremap memory space\n", 282 hba->host->host_no); 283 return -1; 284 } 285 286 hba->iop = mem_base_virt; 287 dprintk("hptiop_map_pci_bar: iop=%p\n", hba->iop); 288 return 0; 289 } 290 291 static void hptiop_message_callback(struct hptiop_hba *hba, u32 msg) 292 { 293 dprintk("iop message 0x%x\n", msg); 294 295 if (!hba->initialized) 296 return; 297 298 if (msg == IOPMU_INBOUND_MSG0_RESET) { 299 atomic_set(&hba->resetting, 0); 300 wake_up(&hba->reset_wq); 301 } 302 else if (msg <= IOPMU_INBOUND_MSG0_MAX) 303 hba->msg_done = 1; 304 } 305 306 static inline struct hptiop_request *get_req(struct hptiop_hba *hba) 307 { 308 struct hptiop_request *ret; 309 310 dprintk("get_req : req=%p\n", hba->req_list); 311 312 ret = hba->req_list; 313 if (ret) 314 hba->req_list = ret->next; 315 316 return ret; 317 } 318 319 static inline void free_req(struct hptiop_hba *hba, struct hptiop_request *req) 320 { 321 dprintk("free_req(%d, %p)\n", req->index, req); 322 req->next = hba->req_list; 323 hba->req_list = req; 324 } 325 326 static void hptiop_host_request_callback(struct hptiop_hba *hba, u32 tag) 327 { 328 struct hpt_iop_request_scsi_command *req; 329 struct scsi_cmnd *scp; 330 331 req = (struct hpt_iop_request_scsi_command *)hba->reqs[tag].req_virt; 332 dprintk("hptiop_host_request_callback: req=%p, type=%d, " 333 "result=%d, context=0x%x tag=%d\n", 334 req, req->header.type, req->header.result, 335 req->header.context, tag); 336 337 BUG_ON(!req->header.result); 338 BUG_ON(req->header.type != cpu_to_le32(IOP_REQUEST_TYPE_SCSI_COMMAND)); 339 340 scp = hba->reqs[tag].scp; 341 342 if (HPT_SCP(scp)->mapped) { 343 if (scp->use_sg) 344 pci_unmap_sg(hba->pcidev, 345 (struct scatterlist *)scp->request_buffer, 346 scp->use_sg, 347 scp->sc_data_direction 348 ); 349 else 350 pci_unmap_single(hba->pcidev, 351 HPT_SCP(scp)->dma_handle, 352 scp->request_bufflen, 353 scp->sc_data_direction 354 ); 355 } 356 357 switch (le32_to_cpu(req->header.result)) { 358 case IOP_RESULT_SUCCESS: 359 scp->result = (DID_OK<<16); 360 break; 361 case IOP_RESULT_BAD_TARGET: 362 scp->result = (DID_BAD_TARGET<<16); 363 break; 364 case IOP_RESULT_BUSY: 365 scp->result = (DID_BUS_BUSY<<16); 366 break; 367 case IOP_RESULT_RESET: 368 scp->result = (DID_RESET<<16); 369 break; 370 case IOP_RESULT_FAIL: 371 scp->result = (DID_ERROR<<16); 372 break; 373 case IOP_RESULT_INVALID_REQUEST: 374 scp->result = (DID_ABORT<<16); 375 break; 376 case IOP_RESULT_MODE_SENSE_CHECK_CONDITION: 377 scp->result = SAM_STAT_CHECK_CONDITION; 378 memset(&scp->sense_buffer, 379 0, sizeof(scp->sense_buffer)); 380 memcpy(&scp->sense_buffer, 381 &req->sg_list, le32_to_cpu(req->dataxfer_length)); 382 break; 383 384 default: 385 scp->result = ((DRIVER_INVALID|SUGGEST_ABORT)<<24) | 386 (DID_ABORT<<16); 387 break; 388 } 389 390 dprintk("scsi_done(%p)\n", scp); 391 scp->scsi_done(scp); 392 free_req(hba, &hba->reqs[tag]); 393 } 394 395 void hptiop_iop_request_callback(struct hptiop_hba *hba, u32 tag) 396 { 397 struct hpt_iop_request_header __iomem *req; 398 struct hpt_iop_request_ioctl_command __iomem *p; 399 struct hpt_ioctl_k *arg; 400 401 req = (struct hpt_iop_request_header __iomem *) 402 ((unsigned long)hba->iop + tag); 403 dprintk("hptiop_iop_request_callback: req=%p, type=%d, " 404 "result=%d, context=0x%x tag=%d\n", 405 req, readl(&req->type), readl(&req->result), 406 readl(&req->context), tag); 407 408 BUG_ON(!readl(&req->result)); 409 BUG_ON(readl(&req->type) != IOP_REQUEST_TYPE_IOCTL_COMMAND); 410 411 p = (struct hpt_iop_request_ioctl_command __iomem *)req; 412 arg = (struct hpt_ioctl_k *)(unsigned long) 413 (readl(&req->context) | 414 ((u64)readl(&req->context_hi32)<<32)); 415 416 if (readl(&req->result) == IOP_RESULT_SUCCESS) { 417 arg->result = HPT_IOCTL_RESULT_OK; 418 419 if (arg->outbuf_size) 420 memcpy_fromio(arg->outbuf, 421 &p->buf[(readl(&p->inbuf_size) + 3)& ~3], 422 arg->outbuf_size); 423 424 if (arg->bytes_returned) 425 *arg->bytes_returned = arg->outbuf_size; 426 } 427 else 428 arg->result = HPT_IOCTL_RESULT_FAILED; 429 430 arg->done(arg); 431 writel(tag, &hba->iop->outbound_queue); 432 } 433 434 static irqreturn_t hptiop_intr(int irq, void *dev_id) 435 { 436 struct hptiop_hba *hba = dev_id; 437 int handled; 438 unsigned long flags; 439 440 spin_lock_irqsave(hba->host->host_lock, flags); 441 handled = __iop_intr(hba); 442 spin_unlock_irqrestore(hba->host->host_lock, flags); 443 444 return handled; 445 } 446 447 static int hptiop_buildsgl(struct scsi_cmnd *scp, struct hpt_iopsg *psg) 448 { 449 struct Scsi_Host *host = scp->device->host; 450 struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata; 451 struct scatterlist *sglist = (struct scatterlist *)scp->request_buffer; 452 453 /* 454 * though we'll not get non-use_sg fields anymore, 455 * keep use_sg checking anyway 456 */ 457 if (scp->use_sg) { 458 int idx; 459 460 HPT_SCP(scp)->sgcnt = pci_map_sg(hba->pcidev, 461 sglist, scp->use_sg, 462 scp->sc_data_direction); 463 HPT_SCP(scp)->mapped = 1; 464 BUG_ON(HPT_SCP(scp)->sgcnt > hba->max_sg_descriptors); 465 466 for (idx = 0; idx < HPT_SCP(scp)->sgcnt; idx++) { 467 psg[idx].pci_address = 468 cpu_to_le64(sg_dma_address(&sglist[idx])); 469 psg[idx].size = cpu_to_le32(sg_dma_len(&sglist[idx])); 470 psg[idx].eot = (idx == HPT_SCP(scp)->sgcnt - 1) ? 471 cpu_to_le32(1) : 0; 472 } 473 474 return HPT_SCP(scp)->sgcnt; 475 } else { 476 HPT_SCP(scp)->dma_handle = pci_map_single( 477 hba->pcidev, 478 scp->request_buffer, 479 scp->request_bufflen, 480 scp->sc_data_direction 481 ); 482 HPT_SCP(scp)->mapped = 1; 483 psg->pci_address = cpu_to_le64(HPT_SCP(scp)->dma_handle); 484 psg->size = cpu_to_le32(scp->request_bufflen); 485 psg->eot = cpu_to_le32(1); 486 return 1; 487 } 488 } 489 490 static int hptiop_queuecommand(struct scsi_cmnd *scp, 491 void (*done)(struct scsi_cmnd *)) 492 { 493 struct Scsi_Host *host = scp->device->host; 494 struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata; 495 struct hpt_iop_request_scsi_command *req; 496 int sg_count = 0; 497 struct hptiop_request *_req; 498 499 BUG_ON(!done); 500 scp->scsi_done = done; 501 502 _req = get_req(hba); 503 if (_req == NULL) { 504 dprintk("hptiop_queuecmd : no free req\n"); 505 return SCSI_MLQUEUE_HOST_BUSY; 506 } 507 508 _req->scp = scp; 509 510 dprintk("hptiop_queuecmd(scp=%p) %d/%d/%d/%d cdb=(%x-%x-%x) " 511 "req_index=%d, req=%p\n", 512 scp, 513 host->host_no, scp->device->channel, 514 scp->device->id, scp->device->lun, 515 *((u32 *)&scp->cmnd), 516 *((u32 *)&scp->cmnd + 1), 517 *((u32 *)&scp->cmnd + 2), 518 _req->index, _req->req_virt); 519 520 scp->result = 0; 521 522 if (scp->device->channel || scp->device->lun || 523 scp->device->id > hba->max_devices) { 524 scp->result = DID_BAD_TARGET << 16; 525 free_req(hba, _req); 526 goto cmd_done; 527 } 528 529 req = (struct hpt_iop_request_scsi_command *)_req->req_virt; 530 531 /* build S/G table */ 532 if (scp->request_bufflen) 533 sg_count = hptiop_buildsgl(scp, req->sg_list); 534 else 535 HPT_SCP(scp)->mapped = 0; 536 537 req->header.flags = cpu_to_le32(IOP_REQUEST_FLAG_OUTPUT_CONTEXT); 538 req->header.type = cpu_to_le32(IOP_REQUEST_TYPE_SCSI_COMMAND); 539 req->header.result = cpu_to_le32(IOP_RESULT_PENDING); 540 req->header.context = cpu_to_le32(IOPMU_QUEUE_ADDR_HOST_BIT | 541 (u32)_req->index); 542 req->header.context_hi32 = 0; 543 req->dataxfer_length = cpu_to_le32(scp->request_bufflen); 544 req->channel = scp->device->channel; 545 req->target = scp->device->id; 546 req->lun = scp->device->lun; 547 req->header.size = cpu_to_le32( 548 sizeof(struct hpt_iop_request_scsi_command) 549 - sizeof(struct hpt_iopsg) 550 + sg_count * sizeof(struct hpt_iopsg)); 551 552 memcpy(req->cdb, scp->cmnd, sizeof(req->cdb)); 553 554 writel(IOPMU_QUEUE_ADDR_HOST_BIT | _req->req_shifted_phy, 555 &hba->iop->inbound_queue); 556 557 return 0; 558 559 cmd_done: 560 dprintk("scsi_done(scp=%p)\n", scp); 561 scp->scsi_done(scp); 562 return 0; 563 } 564 565 static const char *hptiop_info(struct Scsi_Host *host) 566 { 567 return driver_name_long; 568 } 569 570 static int hptiop_reset_hba(struct hptiop_hba *hba) 571 { 572 if (atomic_xchg(&hba->resetting, 1) == 0) { 573 atomic_inc(&hba->reset_count); 574 writel(IOPMU_INBOUND_MSG0_RESET, 575 &hba->iop->inbound_msgaddr0); 576 hptiop_pci_posting_flush(hba->iop); 577 } 578 579 wait_event_timeout(hba->reset_wq, 580 atomic_read(&hba->resetting) == 0, 60 * HZ); 581 582 if (atomic_read(&hba->resetting)) { 583 /* IOP is in unkown state, abort reset */ 584 printk(KERN_ERR "scsi%d: reset failed\n", hba->host->host_no); 585 return -1; 586 } 587 588 if (iop_send_sync_msg(hba, 589 IOPMU_INBOUND_MSG0_START_BACKGROUND_TASK, 5000)) { 590 dprintk("scsi%d: fail to start background task\n", 591 hba->host->host_no); 592 } 593 594 return 0; 595 } 596 597 static int hptiop_reset(struct scsi_cmnd *scp) 598 { 599 struct Scsi_Host * host = scp->device->host; 600 struct hptiop_hba * hba = (struct hptiop_hba *)host->hostdata; 601 602 printk(KERN_WARNING "hptiop_reset(%d/%d/%d) scp=%p\n", 603 scp->device->host->host_no, scp->device->channel, 604 scp->device->id, scp); 605 606 return hptiop_reset_hba(hba)? FAILED : SUCCESS; 607 } 608 609 static int hptiop_adjust_disk_queue_depth(struct scsi_device *sdev, 610 int queue_depth) 611 { 612 if(queue_depth > 256) 613 queue_depth = 256; 614 scsi_adjust_queue_depth(sdev, MSG_ORDERED_TAG, queue_depth); 615 return queue_depth; 616 } 617 618 static ssize_t hptiop_show_version(struct class_device *class_dev, char *buf) 619 { 620 return snprintf(buf, PAGE_SIZE, "%s\n", driver_ver); 621 } 622 623 static ssize_t hptiop_show_fw_version(struct class_device *class_dev, char *buf) 624 { 625 struct Scsi_Host *host = class_to_shost(class_dev); 626 struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata; 627 628 return snprintf(buf, PAGE_SIZE, "%d.%d.%d.%d\n", 629 hba->firmware_version >> 24, 630 (hba->firmware_version >> 16) & 0xff, 631 (hba->firmware_version >> 8) & 0xff, 632 hba->firmware_version & 0xff); 633 } 634 635 static struct class_device_attribute hptiop_attr_version = { 636 .attr = { 637 .name = "driver-version", 638 .mode = S_IRUGO, 639 }, 640 .show = hptiop_show_version, 641 }; 642 643 static struct class_device_attribute hptiop_attr_fw_version = { 644 .attr = { 645 .name = "firmware-version", 646 .mode = S_IRUGO, 647 }, 648 .show = hptiop_show_fw_version, 649 }; 650 651 static struct class_device_attribute *hptiop_attrs[] = { 652 &hptiop_attr_version, 653 &hptiop_attr_fw_version, 654 NULL 655 }; 656 657 static struct scsi_host_template driver_template = { 658 .module = THIS_MODULE, 659 .name = driver_name, 660 .queuecommand = hptiop_queuecommand, 661 .eh_device_reset_handler = hptiop_reset, 662 .eh_bus_reset_handler = hptiop_reset, 663 .info = hptiop_info, 664 .unchecked_isa_dma = 0, 665 .emulated = 0, 666 .use_clustering = ENABLE_CLUSTERING, 667 .proc_name = driver_name, 668 .shost_attrs = hptiop_attrs, 669 .this_id = -1, 670 .change_queue_depth = hptiop_adjust_disk_queue_depth, 671 }; 672 673 static int __devinit hptiop_probe(struct pci_dev *pcidev, 674 const struct pci_device_id *id) 675 { 676 struct Scsi_Host *host = NULL; 677 struct hptiop_hba *hba; 678 struct hpt_iop_request_get_config iop_config; 679 struct hpt_iop_request_set_config set_config; 680 dma_addr_t start_phy; 681 void *start_virt; 682 u32 offset, i, req_size; 683 684 dprintk("hptiop_probe(%p)\n", pcidev); 685 686 if (pci_enable_device(pcidev)) { 687 printk(KERN_ERR "hptiop: fail to enable pci device\n"); 688 return -ENODEV; 689 } 690 691 printk(KERN_INFO "adapter at PCI %d:%d:%d, IRQ %d\n", 692 pcidev->bus->number, pcidev->devfn >> 3, pcidev->devfn & 7, 693 pcidev->irq); 694 695 pci_set_master(pcidev); 696 697 /* Enable 64bit DMA if possible */ 698 if (pci_set_dma_mask(pcidev, DMA_64BIT_MASK)) { 699 if (pci_set_dma_mask(pcidev, DMA_32BIT_MASK)) { 700 printk(KERN_ERR "hptiop: fail to set dma_mask\n"); 701 goto disable_pci_device; 702 } 703 } 704 705 if (pci_request_regions(pcidev, driver_name)) { 706 printk(KERN_ERR "hptiop: pci_request_regions failed\n"); 707 goto disable_pci_device; 708 } 709 710 host = scsi_host_alloc(&driver_template, sizeof(struct hptiop_hba)); 711 if (!host) { 712 printk(KERN_ERR "hptiop: fail to alloc scsi host\n"); 713 goto free_pci_regions; 714 } 715 716 hba = (struct hptiop_hba *)host->hostdata; 717 718 hba->pcidev = pcidev; 719 hba->host = host; 720 hba->initialized = 0; 721 722 atomic_set(&hba->resetting, 0); 723 atomic_set(&hba->reset_count, 0); 724 725 init_waitqueue_head(&hba->reset_wq); 726 init_waitqueue_head(&hba->ioctl_wq); 727 728 host->max_lun = 1; 729 host->max_channel = 0; 730 host->io_port = 0; 731 host->n_io_port = 0; 732 host->irq = pcidev->irq; 733 734 if (hptiop_map_pci_bar(hba)) 735 goto free_scsi_host; 736 737 if (iop_wait_ready(hba->iop, 20000)) { 738 printk(KERN_ERR "scsi%d: firmware not ready\n", 739 hba->host->host_no); 740 goto unmap_pci_bar; 741 } 742 743 if (iop_get_config(hba, &iop_config)) { 744 printk(KERN_ERR "scsi%d: get config failed\n", 745 hba->host->host_no); 746 goto unmap_pci_bar; 747 } 748 749 hba->max_requests = min(le32_to_cpu(iop_config.max_requests), 750 HPTIOP_MAX_REQUESTS); 751 hba->max_devices = le32_to_cpu(iop_config.max_devices); 752 hba->max_request_size = le32_to_cpu(iop_config.request_size); 753 hba->max_sg_descriptors = le32_to_cpu(iop_config.max_sg_count); 754 hba->firmware_version = le32_to_cpu(iop_config.firmware_version); 755 hba->sdram_size = le32_to_cpu(iop_config.sdram_size); 756 757 host->max_sectors = le32_to_cpu(iop_config.data_transfer_length) >> 9; 758 host->max_id = le32_to_cpu(iop_config.max_devices); 759 host->sg_tablesize = le32_to_cpu(iop_config.max_sg_count); 760 host->can_queue = le32_to_cpu(iop_config.max_requests); 761 host->cmd_per_lun = le32_to_cpu(iop_config.max_requests); 762 host->max_cmd_len = 16; 763 764 set_config.vbus_id = cpu_to_le32(host->host_no); 765 set_config.iop_id = cpu_to_le32(host->host_no); 766 767 if (iop_set_config(hba, &set_config)) { 768 printk(KERN_ERR "scsi%d: set config failed\n", 769 hba->host->host_no); 770 goto unmap_pci_bar; 771 } 772 773 pci_set_drvdata(pcidev, host); 774 775 if (request_irq(pcidev->irq, hptiop_intr, IRQF_SHARED, 776 driver_name, hba)) { 777 printk(KERN_ERR "scsi%d: request irq %d failed\n", 778 hba->host->host_no, pcidev->irq); 779 goto unmap_pci_bar; 780 } 781 782 /* Allocate request mem */ 783 req_size = sizeof(struct hpt_iop_request_scsi_command) 784 + sizeof(struct hpt_iopsg) * (hba->max_sg_descriptors - 1); 785 if ((req_size& 0x1f) != 0) 786 req_size = (req_size + 0x1f) & ~0x1f; 787 788 dprintk("req_size=%d, max_requests=%d\n", req_size, hba->max_requests); 789 790 hba->req_size = req_size; 791 start_virt = dma_alloc_coherent(&pcidev->dev, 792 hba->req_size*hba->max_requests + 0x20, 793 &start_phy, GFP_KERNEL); 794 795 if (!start_virt) { 796 printk(KERN_ERR "scsi%d: fail to alloc request mem\n", 797 hba->host->host_no); 798 goto free_request_irq; 799 } 800 801 hba->dma_coherent = start_virt; 802 hba->dma_coherent_handle = start_phy; 803 804 if ((start_phy & 0x1f) != 0) 805 { 806 offset = ((start_phy + 0x1f) & ~0x1f) - start_phy; 807 start_phy += offset; 808 start_virt += offset; 809 } 810 811 hba->req_list = start_virt; 812 for (i = 0; i < hba->max_requests; i++) { 813 hba->reqs[i].next = NULL; 814 hba->reqs[i].req_virt = start_virt; 815 hba->reqs[i].req_shifted_phy = start_phy >> 5; 816 hba->reqs[i].index = i; 817 free_req(hba, &hba->reqs[i]); 818 start_virt = (char *)start_virt + hba->req_size; 819 start_phy = start_phy + hba->req_size; 820 } 821 822 /* Enable Interrupt and start background task */ 823 if (hptiop_initialize_iop(hba)) 824 goto free_request_mem; 825 826 if (scsi_add_host(host, &pcidev->dev)) { 827 printk(KERN_ERR "scsi%d: scsi_add_host failed\n", 828 hba->host->host_no); 829 goto free_request_mem; 830 } 831 832 833 scsi_scan_host(host); 834 835 dprintk("scsi%d: hptiop_probe successfully\n", hba->host->host_no); 836 return 0; 837 838 free_request_mem: 839 dma_free_coherent(&hba->pcidev->dev, 840 hba->req_size*hba->max_requests + 0x20, 841 hba->dma_coherent, hba->dma_coherent_handle); 842 843 free_request_irq: 844 free_irq(hba->pcidev->irq, hba); 845 846 unmap_pci_bar: 847 iounmap(hba->iop); 848 849 free_pci_regions: 850 pci_release_regions(pcidev) ; 851 852 free_scsi_host: 853 scsi_host_put(host); 854 855 disable_pci_device: 856 pci_disable_device(pcidev); 857 858 dprintk("scsi%d: hptiop_probe fail\n", host->host_no); 859 return -ENODEV; 860 } 861 862 static void hptiop_shutdown(struct pci_dev *pcidev) 863 { 864 struct Scsi_Host *host = pci_get_drvdata(pcidev); 865 struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata; 866 struct hpt_iopmu __iomem *iop = hba->iop; 867 u32 int_mask; 868 869 dprintk("hptiop_shutdown(%p)\n", hba); 870 871 /* stop the iop */ 872 if (iop_send_sync_msg(hba, IOPMU_INBOUND_MSG0_SHUTDOWN, 60000)) 873 printk(KERN_ERR "scsi%d: shutdown the iop timeout\n", 874 hba->host->host_no); 875 876 /* disable all outbound interrupts */ 877 int_mask = readl(&iop->outbound_intmask); 878 writel(int_mask | 879 IOPMU_OUTBOUND_INT_MSG0 | IOPMU_OUTBOUND_INT_POSTQUEUE, 880 &iop->outbound_intmask); 881 hptiop_pci_posting_flush(iop); 882 } 883 884 static void hptiop_remove(struct pci_dev *pcidev) 885 { 886 struct Scsi_Host *host = pci_get_drvdata(pcidev); 887 struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata; 888 889 dprintk("scsi%d: hptiop_remove\n", hba->host->host_no); 890 891 scsi_remove_host(host); 892 893 hptiop_shutdown(pcidev); 894 895 free_irq(hba->pcidev->irq, hba); 896 897 dma_free_coherent(&hba->pcidev->dev, 898 hba->req_size * hba->max_requests + 0x20, 899 hba->dma_coherent, 900 hba->dma_coherent_handle); 901 902 iounmap(hba->iop); 903 904 pci_release_regions(hba->pcidev); 905 pci_set_drvdata(hba->pcidev, NULL); 906 pci_disable_device(hba->pcidev); 907 908 scsi_host_put(host); 909 } 910 911 static struct pci_device_id hptiop_id_table[] = { 912 { PCI_DEVICE(0x1103, 0x3220) }, 913 { PCI_DEVICE(0x1103, 0x3320) }, 914 {}, 915 }; 916 917 MODULE_DEVICE_TABLE(pci, hptiop_id_table); 918 919 static struct pci_driver hptiop_pci_driver = { 920 .name = driver_name, 921 .id_table = hptiop_id_table, 922 .probe = hptiop_probe, 923 .remove = hptiop_remove, 924 .shutdown = hptiop_shutdown, 925 }; 926 927 static int __init hptiop_module_init(void) 928 { 929 printk(KERN_INFO "%s %s\n", driver_name_long, driver_ver); 930 return pci_register_driver(&hptiop_pci_driver); 931 } 932 933 static void __exit hptiop_module_exit(void) 934 { 935 pci_unregister_driver(&hptiop_pci_driver); 936 } 937 938 939 module_init(hptiop_module_init); 940 module_exit(hptiop_module_exit); 941 942 MODULE_LICENSE("GPL"); 943