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                 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, struct pt_regs *regs)
 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");