SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/scsi/sata_nv.c

   1 /*
   2  *  sata_nv.c - NVIDIA nForce SATA
   3  *
   4  *  Copyright 2004 NVIDIA Corp.  All rights reserved.
   5  *  Copyright 2004 Andrew Chew
   6  *
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License as published by
  10  *  the Free Software Foundation; either version 2, or (at your option)
  11  *  any later version.
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; see the file COPYING.  If not, write to
  20  *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
  21  *
  22  *
  23  *  libata documentation is available via 'make {ps|pdf}docs',
  24  *  as Documentation/DocBook/libata.*
  25  *
  26  *  No hardware documentation available outside of NVIDIA.
  27  *  This driver programs the NVIDIA SATA controller in a similar
  28  *  fashion as with other PCI IDE BMDMA controllers, with a few
  29  *  NV-specific details such as register offsets, SATA phy location,
  30  *  hotplug info, etc.
  31  *
  32  *  0.09
  33  *     - Fixed bug introduced by 0.08's MCP51 and MCP55 support.
  34  *
  35  *  0.08
  36  *     - Added support for MCP51 and MCP55.
  37  *
  38  *  0.07
  39  *     - Added support for RAID class code.
  40  *
  41  *  0.06
  42  *     - Added generic SATA support by using a pci_device_id that filters on
  43  *       the IDE storage class code.
  44  *
  45  *  0.03
  46  *     - Fixed a bug where the hotplug handlers for non-CK804/MCP04 were using
  47  *       mmio_base, which is only set for the CK804/MCP04 case.
  48  *
  49  *  0.02
  50  *     - Added support for CK804 SATA controller.
  51  *
  52  *  0.01
  53  *     - Initial revision.
  54  */
  55
  56 #include <linux/config.h>
  57 #include <linux/kernel.h>
  58 #include <linux/module.h>
  59 #include <linux/pci.h>
  60 #include <linux/init.h>
  61 #include <linux/blkdev.h>
  62 #include <linux/delay.h>
  63 #include <linux/interrupt.h>
  64 #include <linux/device.h>
  65 #include "scsi.h"
  66 #include <scsi/scsi_host.h>
  67 #include <linux/libata.h>
  68
  69 #define DRV_NAME                        "sata_nv"
  70 #define DRV_VERSION                     "0.8"
  71
  72 #define NV_PORTS                        2
  73 #define NV_PIO_MASK                     0x1f
  74 #define NV_MWDMA_MASK                   0x07
  75 #define NV_UDMA_MASK                    0x7f
  76 #define NV_PORT0_SCR_REG_OFFSET         0x00
  77 #define NV_PORT1_SCR_REG_OFFSET         0x40
  78
  79 #define NV_INT_STATUS                   0x10
  80 #define NV_INT_STATUS_CK804             0x440
  81 #define NV_INT_STATUS_PDEV_INT          0x01
  82 #define NV_INT_STATUS_PDEV_PM           0x02
  83 #define NV_INT_STATUS_PDEV_ADDED        0x04
  84 #define NV_INT_STATUS_PDEV_REMOVED      0x08
  85 #define NV_INT_STATUS_SDEV_INT          0x10
  86 #define NV_INT_STATUS_SDEV_PM           0x20
  87 #define NV_INT_STATUS_SDEV_ADDED        0x40
  88 #define NV_INT_STATUS_SDEV_REMOVED      0x80
  89 #define NV_INT_STATUS_PDEV_HOTPLUG      (NV_INT_STATUS_PDEV_ADDED | \
  90                                         NV_INT_STATUS_PDEV_REMOVED)
  91 #define NV_INT_STATUS_SDEV_HOTPLUG      (NV_INT_STATUS_SDEV_ADDED | \
  92                                         NV_INT_STATUS_SDEV_REMOVED)
  93 #define NV_INT_STATUS_HOTPLUG           (NV_INT_STATUS_PDEV_HOTPLUG | \
  94                                         NV_INT_STATUS_SDEV_HOTPLUG)
  95
  96 #define NV_INT_ENABLE                   0x11
  97 #define NV_INT_ENABLE_CK804             0x441
  98 #define NV_INT_ENABLE_PDEV_MASK         0x01
  99 #define NV_INT_ENABLE_PDEV_PM           0x02
 100 #define NV_INT_ENABLE_PDEV_ADDED        0x04
 101 #define NV_INT_ENABLE_PDEV_REMOVED      0x08
 102 #define NV_INT_ENABLE_SDEV_MASK         0x10
 103 #define NV_INT_ENABLE_SDEV_PM           0x20
 104 #define NV_INT_ENABLE_SDEV_ADDED        0x40
 105 #define NV_INT_ENABLE_SDEV_REMOVED      0x80
 106 #define NV_INT_ENABLE_PDEV_HOTPLUG      (NV_INT_ENABLE_PDEV_ADDED | \
 107                                         NV_INT_ENABLE_PDEV_REMOVED)
 108 #define NV_INT_ENABLE_SDEV_HOTPLUG      (NV_INT_ENABLE_SDEV_ADDED | \
 109                                         NV_INT_ENABLE_SDEV_REMOVED)
 110 #define NV_INT_ENABLE_HOTPLUG           (NV_INT_ENABLE_PDEV_HOTPLUG | \
 111                                         NV_INT_ENABLE_SDEV_HOTPLUG)
 112
 113 #define NV_INT_CONFIG                   0x12
 114 #define NV_INT_CONFIG_METHD             0x01 // 0 = INT, 1 = SMI
 115
 116 // For PCI config register 20
 117 #define NV_MCP_SATA_CFG_20              0x50
 118 #define NV_MCP_SATA_CFG_20_SATA_SPACE_EN        0x04
 119
 120 static int nv_init_one (struct pci_dev *pdev, const struct pci_device_id *ent);
 121 static irqreturn_t nv_interrupt (int irq, void *dev_instance,
 122                                  struct pt_regs *regs);
 123 static u32 nv_scr_read (struct ata_port *ap, unsigned int sc_reg);
 124 static void nv_scr_write (struct ata_port *ap, unsigned int sc_reg, u32 val);
 125 static void nv_host_stop (struct ata_host_set *host_set);
 126 static void nv_enable_hotplug(struct ata_probe_ent *probe_ent);
 127 static void nv_disable_hotplug(struct ata_host_set *host_set);
 128 static void nv_check_hotplug(struct ata_host_set *host_set);
 129 static void nv_enable_hotplug_ck804(struct ata_probe_ent *probe_ent);
 130 static void nv_disable_hotplug_ck804(struct ata_host_set *host_set);
 131 static void nv_check_hotplug_ck804(struct ata_host_set *host_set);
 132
 133 enum nv_host_type
 134 {
 135         GENERIC,
 136         NFORCE2,
 137         NFORCE3,
 138         CK804
 139 };
 140
 141 static struct pci_device_id nv_pci_tbl[] = {
 142         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE2S_SATA,
 143                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, NFORCE2 },
 144         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE3S_SATA,
 145                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, NFORCE3 },
 146         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE3S_SATA2,
 147                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, NFORCE3 },
 148         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_SATA,
 149                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, CK804 },
 150         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_SATA2,
 151                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, CK804 },
 152         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_SATA,
 153                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, CK804 },
 154         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_SATA2,
 155                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, CK804 },
 156         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SATA,
 157                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, GENERIC },
 158         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SATA2,
 159                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, GENERIC },
 160         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SATA,
 161                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, GENERIC },
 162         { PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SATA2,
 163                 PCI_ANY_ID, PCI_ANY_ID, 0, 0, GENERIC },
 164         { PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID,
 165                 PCI_ANY_ID, PCI_ANY_ID,
 166                 PCI_CLASS_STORAGE_IDE<<8, 0xffff00, GENERIC },
 167         { PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID,
 168                 PCI_ANY_ID, PCI_ANY_ID,
 169                 PCI_CLASS_STORAGE_RAID<<8, 0xffff00, GENERIC },
 170         { 0, } /* terminate list */
 171 };
 172
 173 #define NV_HOST_FLAGS_SCR_MMIO  0x00000001
 174
 175 struct nv_host_desc
 176 {
 177         enum nv_host_type       host_type;
 178         void                    (*enable_hotplug)(struct ata_probe_ent *probe_ent);
 179         void                    (*disable_hotplug)(struct ata_host_set *host_set);
 180         void                    (*check_hotplug)(struct ata_host_set *host_set);
 181
 182 };
 183 static struct nv_host_desc nv_device_tbl[] = {
 184         {
 185                 .host_type      = GENERIC,
 186                 .enable_hotplug = NULL,
 187                 .disable_hotplug= NULL,
 188                 .check_hotplug  = NULL,
 189         },
 190         {
 191                 .host_type      = NFORCE2,
 192                 .enable_hotplug = nv_enable_hotplug,
 193                 .disable_hotplug= nv_disable_hotplug,
 194                 .check_hotplug  = nv_check_hotplug,
 195         },
 196         {
 197                 .host_type      = NFORCE3,
 198                 .enable_hotplug = nv_enable_hotplug,
 199                 .disable_hotplug= nv_disable_hotplug,
 200                 .check_hotplug  = nv_check_hotplug,
 201         },
 202         {       .host_type      = CK804,
 203                 .enable_hotplug = nv_enable_hotplug_ck804,
 204                 .disable_hotplug= nv_disable_hotplug_ck804,
 205                 .check_hotplug  = nv_check_hotplug_ck804,
 206         },
 207 };
 208
 209 struct nv_host
 210 {
 211         struct nv_host_desc     *host_desc;
 212         unsigned long           host_flags;
 213 };
 214
 215 static struct pci_driver nv_pci_driver = {
 216         .name                   = DRV_NAME,
 217         .id_table               = nv_pci_tbl,
 218         .probe                  = nv_init_one,
 219         .remove                 = ata_pci_remove_one,
 220 };
 221
 222 static Scsi_Host_Template nv_sht = {
 223         .module                 = THIS_MODULE,
 224         .name                   = DRV_NAME,
 225         .ioctl                  = ata_scsi_ioctl,
 226         .queuecommand           = ata_scsi_queuecmd,
 227         .eh_strategy_handler    = ata_scsi_error,
 228         .can_queue              = ATA_DEF_QUEUE,
 229         .this_id                = ATA_SHT_THIS_ID,
 230         .sg_tablesize           = LIBATA_MAX_PRD,
 231         .max_sectors            = ATA_MAX_SECTORS,
 232         .cmd_per_lun            = ATA_SHT_CMD_PER_LUN,
 233         .emulated               = ATA_SHT_EMULATED,
 234         .use_clustering         = ATA_SHT_USE_CLUSTERING,
 235         .proc_name              = DRV_NAME,
 236         .dma_boundary           = ATA_DMA_BOUNDARY,
 237         .slave_configure        = ata_scsi_slave_config,
 238         .bios_param             = ata_std_bios_param,
 239         .ordered_flush          = 1,
 240 };
 241
 242 static const struct ata_port_operations nv_ops = {
 243         .port_disable           = ata_port_disable,
 244         .tf_load                = ata_tf_load,
 245         .tf_read                = ata_tf_read,
 246         .exec_command           = ata_exec_command,
 247         .check_status           = ata_check_status,
 248         .dev_select             = ata_std_dev_select,
 249         .phy_reset              = sata_phy_reset,
 250         .bmdma_setup            = ata_bmdma_setup,
 251         .bmdma_start            = ata_bmdma_start,
 252         .bmdma_stop             = ata_bmdma_stop,
 253         .bmdma_status           = ata_bmdma_status,
 254         .qc_prep                = ata_qc_prep,
 255         .qc_issue               = ata_qc_issue_prot,
 256         .eng_timeout            = ata_eng_timeout,
 257         .irq_handler            = nv_interrupt,
 258         .irq_clear              = ata_bmdma_irq_clear,
 259         .scr_read               = nv_scr_read,
 260         .scr_write              = nv_scr_write,
 261         .port_start             = ata_port_start,
 262         .port_stop              = ata_port_stop,
 263         .host_stop              = nv_host_stop,
 264 };
 265
 266 /* FIXME: The hardware provides the necessary SATA PHY controls
 267  * to support ATA_FLAG_SATA_RESET.  However, it is currently
 268  * necessary to disable that flag, to solve misdetection problems.
 269  * See http://bugme.osdl.org/show_bug.cgi?id=3352 for more info.
 270  *
 271  * This problem really needs to be investigated further.  But in the
 272  * meantime, we avoid ATA_FLAG_SATA_RESET to get people working.
 273  */
 274 static struct ata_port_info nv_port_info = {
 275         .sht            = &nv_sht,
 276         .host_flags     = ATA_FLAG_SATA |
 277                           /* ATA_FLAG_SATA_RESET | */
 278                           ATA_FLAG_SRST |
 279                           ATA_FLAG_NO_LEGACY,
 280         .pio_mask       = NV_PIO_MASK,
 281         .mwdma_mask     = NV_MWDMA_MASK,
 282         .udma_mask      = NV_UDMA_MASK,
 283         .port_ops       = &nv_ops,
 284 };
 285
 286 MODULE_AUTHOR("NVIDIA");
 287 MODULE_DESCRIPTION("low-level driver for NVIDIA nForce SATA controller");
 288 MODULE_LICENSE("GPL");
 289 MODULE_DEVICE_TABLE(pci, nv_pci_tbl);
 290 MODULE_VERSION(DRV_VERSION);
 291
 292 static irqreturn_t nv_interrupt (int irq, void *dev_instance,
 293                                  struct pt_regs *regs)
 294 {
 295         struct ata_host_set *host_set = dev_instance;
 296         struct nv_host *host = host_set->private_data;
 297         unsigned int i;
 298         unsigned int handled = 0;
 299         unsigned long flags;
 300
 301         spin_lock_irqsave(&host_set->lock, flags);
 302
 303         for (i = 0; i < host_set->n_ports; i++) {
 304                 struct ata_port *ap;
 305
 306                 ap = host_set->ports[i];
 307                 if (ap &&
 308                     !(ap->flags & (ATA_FLAG_PORT_DISABLED | ATA_FLAG_NOINTR))) {
 309                         struct ata_queued_cmd *qc;
 310
 311                         qc = ata_qc_from_tag(ap, ap->active_tag);
 312                         if (qc && (!(qc->tf.ctl & ATA_NIEN)))
 313                                 handled += ata_host_intr(ap, qc);
 314                 }
 315
 316         }
 317
 318         if (host->host_desc->check_hotplug)
 319                 host->host_desc->check_hotplug(host_set);
 320
 321         spin_unlock_irqrestore(&host_set->lock, flags);
 322
 323         return IRQ_RETVAL(handled);
 324 }
 325
 326 static u32 nv_scr_read (struct ata_port *ap, unsigned int sc_reg)
 327 {
 328         struct ata_host_set *host_set = ap->host_set;
 329         struct nv_host *host = host_set->private_data;
 330
 331         if (sc_reg > SCR_CONTROL)
 332                 return 0xffffffffU;
 333
 334         if (host->host_flags & NV_HOST_FLAGS_SCR_MMIO)
 335                 return readl((void __iomem *)ap->ioaddr.scr_addr + (sc_reg * 4));
 336         else
 337                 return inl(ap->ioaddr.scr_addr + (sc_reg * 4));
 338 }
 339
 340 static void nv_scr_write (struct ata_port *ap, unsigned int sc_reg, u32 val)
 341 {
 342         struct ata_host_set *host_set = ap->host_set;
 343         struct nv_host *host = host_set->private_data;
 344
 345         if (sc_reg > SCR_CONTROL)
 346                 return;
 347
 348         if (host->host_flags & NV_HOST_FLAGS_SCR_MMIO)
 349                 writel(val, (void __iomem *)ap->ioaddr.scr_addr + (sc_reg * 4));
 350         else
 351                 outl(val, ap->ioaddr.scr_addr + (sc_reg * 4));
 352 }
 353
 354 static void nv_host_stop (struct ata_host_set *host_set)
 355 {
 356         struct nv_host *host = host_set->private_data;
 357         struct pci_dev *pdev = to_pci_dev(host_set->dev);
 358
 359         // Disable hotplug event interrupts.
 360         if (host->host_desc->disable_hotplug)
 361                 host->host_desc->disable_hotplug(host_set);
 362
 363         kfree(host);
 364
 365         if (host_set->mmio_base)
 366                 pci_iounmap(pdev, host_set->mmio_base);
 367 }
 368
 369 static int nv_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
 370 {
 371         static int printed_version = 0;
 372         struct nv_host *host;
 373         struct ata_port_info *ppi;
 374         struct ata_probe_ent *probe_ent;
 375         int pci_dev_busy = 0;
 376         int rc;
 377         u32 bar;
 378
 379         // Make sure this is a SATA controller by counting the number of bars
 380         // (NVIDIA SATA controllers will always have six bars).  Otherwise,
 381         // it's an IDE controller and we ignore it.
 382         for (bar=0; bar<6; bar++)
 383                 if (pci_resource_start(pdev, bar) == 0)
 384                         return -ENODEV;
 385
 386         if (!printed_version++)
 387                 dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
 388
 389         rc = pci_enable_device(pdev);
 390         if (rc)
 391                 goto err_out;
 392
 393         rc = pci_request_regions(pdev, DRV_NAME);
 394         if (rc) {
 395                 pci_dev_busy = 1;
 396                 goto err_out_disable;
 397         }
 398
 399         rc = pci_set_dma_mask(pdev, ATA_DMA_MASK);
 400         if (rc)
 401                 goto err_out_regions;
 402         rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK);
 403         if (rc)
 404                 goto err_out_regions;
 405
 406         rc = -ENOMEM;
 407
 408         ppi = &nv_port_info;
 409         probe_ent = ata_pci_init_native_mode(pdev, &ppi, ATA_PORT_PRIMARY | ATA_PORT_SECONDARY);
 410         if (!probe_ent)
 411                 goto err_out_regions;
 412
 413         host = kmalloc(sizeof(struct nv_host), GFP_KERNEL);
 414         if (!host)
 415                 goto err_out_free_ent;
 416
 417         memset(host, 0, sizeof(struct nv_host));
 418         host->host_desc = &nv_device_tbl[ent->driver_data];
 419
 420         probe_ent->private_data = host;
 421
 422         if (pci_resource_flags(pdev, 5) & IORESOURCE_MEM)
 423                 host->host_flags |= NV_HOST_FLAGS_SCR_MMIO;
 424
 425         if (host->host_flags & NV_HOST_FLAGS_SCR_MMIO) {
 426                 unsigned long base;
 427
 428                 probe_ent->mmio_base = pci_iomap(pdev, 5, 0);
 429                 if (probe_ent->mmio_base == NULL) {
 430                         rc = -EIO;
 431                         goto err_out_free_host;
 432                 }
 433
 434                 base = (unsigned long)probe_ent->mmio_base;
 435
 436                 probe_ent->port[0].scr_addr =
 437                         base + NV_PORT0_SCR_REG_OFFSET;
 438                 probe_ent->port[1].scr_addr =
 439                         base + NV_PORT1_SCR_REG_OFFSET;
 440         } else {
 441
 442                 probe_ent->port[0].scr_addr =
 443                         pci_resource_start(pdev, 5) | NV_PORT0_SCR_REG_OFFSET;
 444                 probe_ent->port[1].scr_addr =
 445                         pci_resource_start(pdev, 5) | NV_PORT1_SCR_REG_OFFSET;
 446         }
 447
 448         pci_set_master(pdev);
 449
 450         rc = ata_device_add(probe_ent);
 451         if (rc != NV_PORTS)
 452                 goto err_out_iounmap;
 453
 454         // Enable hotplug event interrupts.
 455         if (host->host_desc->enable_hotplug)
 456                 host->host_desc->enable_hotplug(probe_ent);
 457
 458         kfree(probe_ent);
 459
 460         return 0;
 461
 462 err_out_iounmap:
 463         if (host->host_flags & NV_HOST_FLAGS_SCR_MMIO)
 464                 pci_iounmap(pdev, probe_ent->mmio_base);
 465 err_out_free_host:
 466         kfree(host);
 467 err_out_free_ent:
 468         kfree(probe_ent);
 469 err_out_regions:
 470         pci_release_regions(pdev);
 471 err_out_disable:
 472         if (!pci_dev_busy)
 473                 pci_disable_device(pdev);
 474 err_out:
 475         return rc;
 476 }
 477
 478 static void nv_enable_hotplug(struct ata_probe_ent *probe_ent)
 479 {
 480         u8 intr_mask;
 481
 482         outb(NV_INT_STATUS_HOTPLUG,
 483                 probe_ent->port[0].scr_addr + NV_INT_STATUS);
 484
 485         intr_mask = inb(probe_ent->port[0].scr_addr + NV_INT_ENABLE);
 486         intr_mask |= NV_INT_ENABLE_HOTPLUG;
 487
 488         outb(intr_mask, probe_ent->port[0].scr_addr + NV_INT_ENABLE);
 489 }
 490
 491 static void nv_disable_hotplug(struct ata_host_set *host_set)
 492 {
 493         u8 intr_mask;
 494
 495         intr_mask = inb(host_set->ports[0]->ioaddr.scr_addr + NV_INT_ENABLE);
 496
 497         intr_mask &= ~(NV_INT_ENABLE_HOTPLUG);
 498
 499         outb(intr_mask, host_set->ports[0]->ioaddr.scr_addr + NV_INT_ENABLE);
 500 }
 501
 502 static void nv_check_hotplug(struct ata_host_set *host_set)
 503 {
 504         u8 intr_status;
 505
 506         intr_status = inb(host_set->ports[0]->ioaddr.scr_addr + NV_INT_STATUS);
 507
 508         // Clear interrupt status.
 509         outb(0xff, host_set->ports[0]->ioaddr.scr_addr + NV_INT_STATUS);
 510
 511         if (intr_status & NV_INT_STATUS_HOTPLUG) {
 512                 if (intr_status & NV_INT_STATUS_PDEV_ADDED)
 513                         printk(KERN_WARNING "nv_sata: "
 514                                 "Primary device added\n");
 515
 516                 if (intr_status & NV_INT_STATUS_PDEV_REMOVED)
 517                         printk(KERN_WARNING "nv_sata: "
 518                                 "Primary device removed\n");
 519
 520                 if (intr_status & NV_INT_STATUS_SDEV_ADDED)
 521                         printk(KERN_WARNING "nv_sata: "
 522                                 "Secondary device added\n");
 523
 524                 if (intr_status & NV_INT_STATUS_SDEV_REMOVED)
 525                         printk(KERN_WARNING "nv_sata: "
 526                                 "Secondary device removed\n");
 527         }
 528 }
 529
 530 static void nv_enable_hotplug_ck804(struct ata_probe_ent *probe_ent)
 531 {
 532         struct pci_dev *pdev = to_pci_dev(probe_ent->dev);
 533         u8 intr_mask;
 534         u8 regval;
 535
 536         pci_read_config_byte(pdev, NV_MCP_SATA_CFG_20, &regval);
 537         regval |= NV_MCP_SATA_CFG_20_SATA_SPACE_EN;
 538         pci_write_config_byte(pdev, NV_MCP_SATA_CFG_20, regval);
 539
 540         writeb(NV_INT_STATUS_HOTPLUG, probe_ent->mmio_base + NV_INT_STATUS_CK804);
 541
 542         intr_mask = readb(probe_ent->mmio_base + NV_INT_ENABLE_CK804);
 543         intr_mask |= NV_INT_ENABLE_HOTPLUG;
 544
 545         writeb(intr_mask, probe_ent->mmio_base + NV_INT_ENABLE_CK804);
 546 }
 547
 548 static void nv_disable_hotplug_ck804(struct ata_host_set *host_set)
 549 {
 550         struct pci_dev *pdev = to_pci_dev(host_set->dev);
 551         u8 intr_mask;
 552         u8 regval;
 553
 554         intr_mask = readb(host_set->mmio_base + NV_INT_ENABLE_CK804);
 555
 556         intr_mask &= ~(NV_INT_ENABLE_HOTPLUG);
 557
 558         writeb(intr_mask, host_set->mmio_base + NV_INT_ENABLE_CK804);
 559
 560         pci_read_config_byte(pdev, NV_MCP_SATA_CFG_20, &regval);
 561         regval &= ~NV_MCP_SATA_CFG_20_SATA_SPACE_EN;
 562         pci_write_config_byte(pdev, NV_MCP_SATA_CFG_20, regval);
 563 }
 564
 565 static void nv_check_hotplug_ck804(struct ata_host_set *host_set)
 566 {
 567         u8 intr_status;
 568
 569         intr_status = readb(host_set->mmio_base + NV_INT_STATUS_CK804);
 570
 571         // Clear interrupt status.
 572         writeb(0xff, host_set->mmio_base + NV_INT_STATUS_CK804);
 573
 574         if (intr_status & NV_INT_STATUS_HOTPLUG) {
 575                 if (intr_status & NV_INT_STATUS_PDEV_ADDED)
 576                         printk(KERN_WARNING "nv_sata: "
 577                                 "Primary device added\n");
 578
 579                 if (intr_status & NV_INT_STATUS_PDEV_REMOVED)
 580                         printk(KERN_WARNING "nv_sata: "
 581                                 "Primary device removed\n");
 582
 583                 if (intr_status & NV_INT_STATUS_SDEV_ADDED)
 584                         printk(KERN_WARNING "nv_sata: "
 585                                 "Secondary device added\n");
 586
 587                 if (intr_status & NV_INT_STATUS_SDEV_REMOVED)
 588                         printk(KERN_WARNING "nv_sata: "
 589                                 "Secondary device removed\n");
 590         }
 591 }
 592
 593 static int __init nv_init(void)
 594 {
 595         return pci_module_init(&nv_pci_driver);
 596 }
 597
 598 static void __exit nv_exit(void)
 599 {
 600         pci_unregister_driver(&nv_pci_driver);
 601 }
 602
 603 module_init(nv_init);
 604 module_exit(nv_exit);