drivers/scsi/hptiop.c

   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                 scsi_dma_unmap(scp);
 344
 345         switch (le32_to_cpu(req->header.result)) {
 346         case IOP_RESULT_SUCCESS:
 347                 scp->result = (DID_OK<<16);
 348                 break;
 349         case IOP_RESULT_BAD_TARGET:
 350                 scp->result = (DID_BAD_TARGET<<16);
 351                 break;
 352         case IOP_RESULT_BUSY:
 353                 scp->result = (DID_BUS_BUSY<<16);
 354                 break;
 355         case IOP_RESULT_RESET:
 356                 scp->result = (DID_RESET<<16);
 357                 break;
 358         case IOP_RESULT_FAIL:
 359                 scp->result = (DID_ERROR<<16);
 360                 break;
 361         case IOP_RESULT_INVALID_REQUEST:
 362                 scp->result = (DID_ABORT<<16);
 363                 break;
 364         case IOP_RESULT_MODE_SENSE_CHECK_CONDITION:
 365                 scp->result = SAM_STAT_CHECK_CONDITION;
 366                 memset(&scp->sense_buffer,
 367                                 0, sizeof(scp->sense_buffer));
 368                 memcpy(&scp->sense_buffer,
 369                         &req->sg_list, le32_to_cpu(req->dataxfer_length));
 370                 break;
 371
 372         default:
 373                 scp->result = ((DRIVER_INVALID|SUGGEST_ABORT)<<24) |
 374                                         (DID_ABORT<<16);
 375                 break;
 376         }
 377
 378         dprintk("scsi_done(%p)\n", scp);
 379         scp->scsi_done(scp);
 380         free_req(hba, &hba->reqs[tag]);
 381 }
 382
 383 void hptiop_iop_request_callback(struct hptiop_hba *hba, u32 tag)
 384 {
 385         struct hpt_iop_request_header __iomem *req;
 386         struct hpt_iop_request_ioctl_command __iomem *p;
 387         struct hpt_ioctl_k *arg;
 388
 389         req = (struct hpt_iop_request_header __iomem *)
 390                         ((unsigned long)hba->iop + tag);
 391         dprintk("hptiop_iop_request_callback: req=%p, type=%d, "
 392                         "result=%d, context=0x%x tag=%d\n",
 393                         req, readl(&req->type), readl(&req->result),
 394                         readl(&req->context), tag);
 395
 396         BUG_ON(!readl(&req->result));
 397         BUG_ON(readl(&req->type) != IOP_REQUEST_TYPE_IOCTL_COMMAND);
 398
 399         p = (struct hpt_iop_request_ioctl_command __iomem *)req;
 400         arg = (struct hpt_ioctl_k *)(unsigned long)
 401                 (readl(&req->context) |
 402                         ((u64)readl(&req->context_hi32)<<32));
 403
 404         if (readl(&req->result) == IOP_RESULT_SUCCESS) {
 405                 arg->result = HPT_IOCTL_RESULT_OK;
 406
 407                 if (arg->outbuf_size)
 408                         memcpy_fromio(arg->outbuf,
 409                                 &p->buf[(readl(&p->inbuf_size) + 3)& ~3],
 410                                 arg->outbuf_size);
 411
 412                 if (arg->bytes_returned)
 413                         *arg->bytes_returned = arg->outbuf_size;
 414         }
 415         else
 416                 arg->result = HPT_IOCTL_RESULT_FAILED;
 417
 418         arg->done(arg);
 419         writel(tag, &hba->iop->outbound_queue);
 420 }
 421
 422 static irqreturn_t hptiop_intr(int irq, void *dev_id)
 423 {
 424         struct hptiop_hba  *hba = dev_id;
 425         int  handled;
 426         unsigned long flags;
 427
 428         spin_lock_irqsave(hba->host->host_lock, flags);
 429         handled = __iop_intr(hba);
 430         spin_unlock_irqrestore(hba->host->host_lock, flags);
 431
 432         return handled;
 433 }
 434
 435 static int hptiop_buildsgl(struct scsi_cmnd *scp, struct hpt_iopsg *psg)
 436 {
 437         struct Scsi_Host *host = scp->device->host;
 438         struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata;
 439         struct scatterlist *sg;
 440         int idx, nseg;
 441
 442         nseg = scsi_dma_map(scp);
 443         BUG_ON(nseg < 0);
 444         if (!nseg)
 445                 return 0;
 446
 447         HPT_SCP(scp)->sgcnt = nseg;
 448         HPT_SCP(scp)->mapped = 1;
 449
 450         BUG_ON(HPT_SCP(scp)->sgcnt > hba->max_sg_descriptors);
 451
 452         scsi_for_each_sg(scp, sg, HPT_SCP(scp)->sgcnt, idx) {
 453                 psg[idx].pci_address = cpu_to_le64(sg_dma_address(sg));
 454                 psg[idx].size = cpu_to_le32(sg_dma_len(sg));
 455                 psg[idx].eot = (idx == HPT_SCP(scp)->sgcnt - 1) ?
 456                         cpu_to_le32(1) : 0;
 457         }
 458         return HPT_SCP(scp)->sgcnt;
 459 }
 460
 461 static int hptiop_queuecommand(struct scsi_cmnd *scp,
 462                                 void (*done)(struct scsi_cmnd *))
 463 {
 464         struct Scsi_Host *host = scp->device->host;
 465         struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata;
 466         struct hpt_iop_request_scsi_command *req;
 467         int sg_count = 0;
 468         struct hptiop_request *_req;
 469
 470         BUG_ON(!done);
 471         scp->scsi_done = done;
 472
 473         _req = get_req(hba);
 474         if (_req == NULL) {
 475                 dprintk("hptiop_queuecmd : no free req\n");
 476                 return SCSI_MLQUEUE_HOST_BUSY;
 477         }
 478
 479         _req->scp = scp;
 480
 481         dprintk("hptiop_queuecmd(scp=%p) %d/%d/%d/%d cdb=(%x-%x-%x) "
 482                         "req_index=%d, req=%p\n",
 483                         scp,
 484                         host->host_no, scp->device->channel,
 485                         scp->device->id, scp->device->lun,
 486                         *((u32 *)&scp->cmnd),
 487                         *((u32 *)&scp->cmnd + 1),
 488                         *((u32 *)&scp->cmnd + 2),
 489                         _req->index, _req->req_virt);
 490
 491         scp->result = 0;
 492
 493         if (scp->device->channel || scp->device->lun ||
 494                         scp->device->id > hba->max_devices) {
 495                 scp->result = DID_BAD_TARGET << 16;
 496                 free_req(hba, _req);
 497                 goto cmd_done;
 498         }
 499
 500         req = (struct hpt_iop_request_scsi_command *)_req->req_virt;
 501
 502         /* build S/G table */
 503         sg_count = hptiop_buildsgl(scp, req->sg_list);
 504         if (!sg_count)
 505                 HPT_SCP(scp)->mapped = 0;
 506
 507         req->header.flags = cpu_to_le32(IOP_REQUEST_FLAG_OUTPUT_CONTEXT);
 508         req->header.type = cpu_to_le32(IOP_REQUEST_TYPE_SCSI_COMMAND);
 509         req->header.result = cpu_to_le32(IOP_RESULT_PENDING);
 510         req->header.context = cpu_to_le32(IOPMU_QUEUE_ADDR_HOST_BIT |
 511                                                         (u32)_req->index);
 512         req->header.context_hi32 = 0;
 513         req->dataxfer_length = cpu_to_le32(scsi_bufflen(scp));
 514         req->channel = scp->device->channel;
 515         req->target = scp->device->id;
 516         req->lun = scp->device->lun;
 517         req->header.size = cpu_to_le32(
 518                                 sizeof(struct hpt_iop_request_scsi_command)
 519                                  - sizeof(struct hpt_iopsg)
 520                                  + sg_count * sizeof(struct hpt_iopsg));
 521
 522         memcpy(req->cdb, scp->cmnd, sizeof(req->cdb));
 523
 524         writel(IOPMU_QUEUE_ADDR_HOST_BIT | _req->req_shifted_phy,
 525                         &hba->iop->inbound_queue);
 526
 527         return 0;
 528
 529 cmd_done:
 530         dprintk("scsi_done(scp=%p)\n", scp);
 531         scp->scsi_done(scp);
 532         return 0;
 533 }
 534
 535 static const char *hptiop_info(struct Scsi_Host *host)
 536 {
 537         return driver_name_long;
 538 }
 539
 540 static int hptiop_reset_hba(struct hptiop_hba *hba)
 541 {
 542         if (atomic_xchg(&hba->resetting, 1) == 0) {
 543                 atomic_inc(&hba->reset_count);
 544                 writel(IOPMU_INBOUND_MSG0_RESET,
 545                                 &hba->iop->inbound_msgaddr0);
 546                 hptiop_pci_posting_flush(hba->iop);
 547         }
 548
 549         wait_event_timeout(hba->reset_wq,
 550                         atomic_read(&hba->resetting) == 0, 60 * HZ);
 551
 552         if (atomic_read(&hba->resetting)) {
 553                 /* IOP is in unkown state, abort reset */
 554                 printk(KERN_ERR "scsi%d: reset failed\n", hba->host->host_no);
 555                 return -1;
 556         }
 557
 558         if (iop_send_sync_msg(hba,
 559                 IOPMU_INBOUND_MSG0_START_BACKGROUND_TASK, 5000)) {
 560                 dprintk("scsi%d: fail to start background task\n",
 561                                 hba->host->host_no);
 562         }
 563
 564         return 0;
 565 }
 566
 567 static int hptiop_reset(struct scsi_cmnd *scp)
 568 {
 569         struct Scsi_Host * host = scp->device->host;
 570         struct hptiop_hba * hba = (struct hptiop_hba *)host->hostdata;
 571
 572         printk(KERN_WARNING "hptiop_reset(%d/%d/%d) scp=%p\n",
 573                         scp->device->host->host_no, scp->device->channel,
 574                         scp->device->id, scp);
 575
 576         return hptiop_reset_hba(hba)? FAILED : SUCCESS;
 577 }
 578
 579 static int hptiop_adjust_disk_queue_depth(struct scsi_device *sdev,
 580                                                 int queue_depth)
 581 {
 582         if(queue_depth > 256)
 583                 queue_depth = 256;
 584         scsi_adjust_queue_depth(sdev, MSG_ORDERED_TAG, queue_depth);
 585         return queue_depth;
 586 }
 587
 588 static ssize_t hptiop_show_version(struct class_device *class_dev, char *buf)
 589 {
 590         return snprintf(buf, PAGE_SIZE, "%s\n", driver_ver);
 591 }
 592
 593 static ssize_t hptiop_show_fw_version(struct class_device *class_dev, char *buf)
 594 {
 595         struct Scsi_Host *host = class_to_shost(class_dev);
 596         struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata;
 597
 598         return snprintf(buf, PAGE_SIZE, "%d.%d.%d.%d\n",
 599                                 hba->firmware_version >> 24,
 600                                 (hba->firmware_version >> 16) & 0xff,
 601                                 (hba->firmware_version >> 8) & 0xff,
 602                                 hba->firmware_version & 0xff);
 603 }
 604
 605 static struct class_device_attribute hptiop_attr_version = {
 606         .attr = {
 607                 .name = "driver-version",
 608                 .mode = S_IRUGO,
 609         },
 610         .show = hptiop_show_version,
 611 };
 612
 613 static struct class_device_attribute hptiop_attr_fw_version = {
 614         .attr = {
 615                 .name = "firmware-version",
 616                 .mode = S_IRUGO,
 617         },
 618         .show = hptiop_show_fw_version,
 619 };
 620
 621 static struct class_device_attribute *hptiop_attrs[] = {
 622         &hptiop_attr_version,
 623         &hptiop_attr_fw_version,
 624         NULL
 625 };
 626
 627 static struct scsi_host_template driver_template = {
 628         .module                     = THIS_MODULE,
 629         .name                       = driver_name,
 630         .queuecommand               = hptiop_queuecommand,
 631         .eh_device_reset_handler    = hptiop_reset,
 632         .eh_bus_reset_handler       = hptiop_reset,
 633         .info                       = hptiop_info,
 634         .unchecked_isa_dma          = 0,
 635         .emulated                   = 0,
 636         .use_clustering             = ENABLE_CLUSTERING,
 637         .proc_name                  = driver_name,
 638         .shost_attrs                = hptiop_attrs,
 639         .this_id                    = -1,
 640         .change_queue_depth         = hptiop_adjust_disk_queue_depth,
 641 };
 642
 643 static int __devinit hptiop_probe(struct pci_dev *pcidev,
 644                                         const struct pci_device_id *id)
 645 {
 646         struct Scsi_Host *host = NULL;
 647         struct hptiop_hba *hba;
 648         struct hpt_iop_request_get_config iop_config;
 649         struct hpt_iop_request_set_config set_config;
 650         dma_addr_t start_phy;
 651         void *start_virt;
 652         u32 offset, i, req_size;
 653
 654         dprintk("hptiop_probe(%p)\n", pcidev);
 655
 656         if (pci_enable_device(pcidev)) {
 657                 printk(KERN_ERR "hptiop: fail to enable pci device\n");
 658                 return -ENODEV;
 659         }
 660
 661         printk(KERN_INFO "adapter at PCI %d:%d:%d, IRQ %d\n",
 662                 pcidev->bus->number, pcidev->devfn >> 3, pcidev->devfn & 7,
 663                 pcidev->irq);
 664
 665         pci_set_master(pcidev);
 666
 667         /* Enable 64bit DMA if possible */
 668         if (pci_set_dma_mask(pcidev, DMA_64BIT_MASK)) {
 669                 if (pci_set_dma_mask(pcidev, DMA_32BIT_MASK)) {
 670                         printk(KERN_ERR "hptiop: fail to set dma_mask\n");
 671                         goto disable_pci_device;
 672                 }
 673         }
 674
 675         if (pci_request_regions(pcidev, driver_name)) {
 676                 printk(KERN_ERR "hptiop: pci_request_regions failed\n");
 677                 goto disable_pci_device;
 678         }
 679
 680         host = scsi_host_alloc(&driver_template, sizeof(struct hptiop_hba));
 681         if (!host) {
 682                 printk(KERN_ERR "hptiop: fail to alloc scsi host\n");
 683                 goto free_pci_regions;
 684         }
 685
 686         hba = (struct hptiop_hba *)host->hostdata;
 687
 688         hba->pcidev = pcidev;
 689         hba->host = host;
 690         hba->initialized = 0;
 691
 692         atomic_set(&hba->resetting, 0);
 693         atomic_set(&hba->reset_count, 0);
 694
 695         init_waitqueue_head(&hba->reset_wq);
 696         init_waitqueue_head(&hba->ioctl_wq);
 697
 698         host->max_lun = 1;
 699         host->max_channel = 0;
 700         host->io_port = 0;
 701         host->n_io_port = 0;
 702         host->irq = pcidev->irq;
 703
 704         if (hptiop_map_pci_bar(hba))
 705                 goto free_scsi_host;
 706
 707         if (iop_wait_ready(hba->iop, 20000)) {
 708                 printk(KERN_ERR "scsi%d: firmware not ready\n",
 709                                 hba->host->host_no);
 710                 goto unmap_pci_bar;
 711         }
 712
 713         if (iop_get_config(hba, &iop_config)) {
 714                 printk(KERN_ERR "scsi%d: get config failed\n",
 715                                 hba->host->host_no);
 716                 goto unmap_pci_bar;
 717         }
 718
 719         hba->max_requests = min(le32_to_cpu(iop_config.max_requests),
 720                                 HPTIOP_MAX_REQUESTS);
 721         hba->max_devices = le32_to_cpu(iop_config.max_devices);
 722         hba->max_request_size = le32_to_cpu(iop_config.request_size);
 723         hba->max_sg_descriptors = le32_to_cpu(iop_config.max_sg_count);
 724         hba->firmware_version = le32_to_cpu(iop_config.firmware_version);
 725         hba->sdram_size = le32_to_cpu(iop_config.sdram_size);
 726
 727         host->max_sectors = le32_to_cpu(iop_config.data_transfer_length) >> 9;
 728         host->max_id = le32_to_cpu(iop_config.max_devices);
 729         host->sg_tablesize = le32_to_cpu(iop_config.max_sg_count);
 730         host->can_queue = le32_to_cpu(iop_config.max_requests);
 731         host->cmd_per_lun = le32_to_cpu(iop_config.max_requests);
 732         host->max_cmd_len = 16;
 733
 734         set_config.vbus_id = cpu_to_le32(host->host_no);
 735         set_config.iop_id = cpu_to_le32(host->host_no);
 736
 737         if (iop_set_config(hba, &set_config)) {
 738                 printk(KERN_ERR "scsi%d: set config failed\n",
 739                                 hba->host->host_no);
 740                 goto unmap_pci_bar;
 741         }
 742
 743         pci_set_drvdata(pcidev, host);
 744
 745         if (request_irq(pcidev->irq, hptiop_intr, IRQF_SHARED,
 746                                         driver_name, hba)) {
 747                 printk(KERN_ERR "scsi%d: request irq %d failed\n",
 748                                         hba->host->host_no, pcidev->irq);
 749                 goto unmap_pci_bar;
 750         }
 751
 752         /* Allocate request mem */
 753         req_size = sizeof(struct hpt_iop_request_scsi_command)
 754                 + sizeof(struct hpt_iopsg) * (hba->max_sg_descriptors - 1);
 755         if ((req_size& 0x1f) != 0)
 756                 req_size = (req_size + 0x1f) & ~0x1f;
 757
 758         dprintk("req_size=%d, max_requests=%d\n", req_size, hba->max_requests);
 759
 760         hba->req_size = req_size;
 761         start_virt = dma_alloc_coherent(&pcidev->dev,
 762                                 hba->req_size*hba->max_requests + 0x20,
 763                                 &start_phy, GFP_KERNEL);
 764
 765         if (!start_virt) {
 766                 printk(KERN_ERR "scsi%d: fail to alloc request mem\n",
 767                                         hba->host->host_no);
 768                 goto free_request_irq;
 769         }
 770
 771         hba->dma_coherent = start_virt;
 772         hba->dma_coherent_handle = start_phy;
 773
 774         if ((start_phy & 0x1f) != 0)
 775         {
 776                 offset = ((start_phy + 0x1f) & ~0x1f) - start_phy;
 777                 start_phy += offset;
 778                 start_virt += offset;
 779         }
 780
 781         hba->req_list = start_virt;
 782         for (i = 0; i < hba->max_requests; i++) {
 783                 hba->reqs[i].next = NULL;
 784                 hba->reqs[i].req_virt = start_virt;
 785                 hba->reqs[i].req_shifted_phy = start_phy >> 5;
 786                 hba->reqs[i].index = i;
 787                 free_req(hba, &hba->reqs[i]);
 788                 start_virt = (char *)start_virt + hba->req_size;
 789                 start_phy = start_phy + hba->req_size;
 790         }
 791
 792         /* Enable Interrupt and start background task */
 793         if (hptiop_initialize_iop(hba))
 794                 goto free_request_mem;
 795
 796         if (scsi_add_host(host, &pcidev->dev)) {
 797                 printk(KERN_ERR "scsi%d: scsi_add_host failed\n",
 798                                         hba->host->host_no);
 799                 goto free_request_mem;
 800         }
 801
 802
 803         scsi_scan_host(host);
 804
 805         dprintk("scsi%d: hptiop_probe successfully\n", hba->host->host_no);
 806         return 0;
 807
 808 free_request_mem:
 809         dma_free_coherent(&hba->pcidev->dev,
 810                         hba->req_size*hba->max_requests + 0x20,
 811                         hba->dma_coherent, hba->dma_coherent_handle);
 812
 813 free_request_irq:
 814         free_irq(hba->pcidev->irq, hba);
 815
 816 unmap_pci_bar:
 817         iounmap(hba->iop);
 818
 819 free_pci_regions:
 820         pci_release_regions(pcidev) ;
 821
 822 free_scsi_host:
 823         scsi_host_put(host);
 824
 825 disable_pci_device:
 826         pci_disable_device(pcidev);
 827
 828         dprintk("scsi%d: hptiop_probe fail\n", host->host_no);
 829         return -ENODEV;
 830 }
 831
 832 static void hptiop_shutdown(struct pci_dev *pcidev)
 833 {
 834         struct Scsi_Host *host = pci_get_drvdata(pcidev);
 835         struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata;
 836         struct hpt_iopmu __iomem *iop = hba->iop;
 837         u32    int_mask;
 838
 839         dprintk("hptiop_shutdown(%p)\n", hba);
 840
 841         /* stop the iop */
 842         if (iop_send_sync_msg(hba, IOPMU_INBOUND_MSG0_SHUTDOWN, 60000))
 843                 printk(KERN_ERR "scsi%d: shutdown the iop timeout\n",
 844                                         hba->host->host_no);
 845
 846         /* disable all outbound interrupts */
 847         int_mask = readl(&iop->outbound_intmask);
 848         writel(int_mask |
 849                 IOPMU_OUTBOUND_INT_MSG0 | IOPMU_OUTBOUND_INT_POSTQUEUE,
 850                 &iop->outbound_intmask);
 851         hptiop_pci_posting_flush(iop);
 852 }
 853
 854 static void hptiop_remove(struct pci_dev *pcidev)
 855 {
 856         struct Scsi_Host *host = pci_get_drvdata(pcidev);
 857         struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata;
 858
 859         dprintk("scsi%d: hptiop_remove\n", hba->host->host_no);
 860
 861         scsi_remove_host(host);
 862
 863         hptiop_shutdown(pcidev);
 864
 865         free_irq(hba->pcidev->irq, hba);
 866
 867         dma_free_coherent(&hba->pcidev->dev,
 868                         hba->req_size * hba->max_requests + 0x20,
 869                         hba->dma_coherent,
 870                         hba->dma_coherent_handle);
 871
 872         iounmap(hba->iop);
 873
 874         pci_release_regions(hba->pcidev);
 875         pci_set_drvdata(hba->pcidev, NULL);
 876         pci_disable_device(hba->pcidev);
 877
 878         scsi_host_put(host);
 879 }
 880
 881 static struct pci_device_id hptiop_id_table[] = {
 882         { PCI_DEVICE(0x1103, 0x3220) },
 883         { PCI_DEVICE(0x1103, 0x3320) },
 884         {},
 885 };
 886
 887 MODULE_DEVICE_TABLE(pci, hptiop_id_table);
 888
 889 static struct pci_driver hptiop_pci_driver = {
 890         .name       = driver_name,
 891         .id_table   = hptiop_id_table,
 892         .probe      = hptiop_probe,
 893         .remove     = hptiop_remove,
 894         .shutdown   = hptiop_shutdown,
 895 };
 896
 897 static int __init hptiop_module_init(void)
 898 {
 899         printk(KERN_INFO "%s %s\n", driver_name_long, driver_ver);
 900         return pci_register_driver(&hptiop_pci_driver);
 901 }
 902
 903 static void __exit hptiop_module_exit(void)
 904 {
 905         pci_unregister_driver(&hptiop_pci_driver);
 906 }
 907
 908
 909 module_init(hptiop_module_init);
 910 module_exit(hptiop_module_exit);
 911
 912 MODULE_LICENSE("GPL");