drivers/ata/pata_amd.c

   1 /*
   2  * pata_amd.c   - AMD PATA for new ATA layer
   3  *                        (C) 2005-2006 Red Hat Inc
   4  *                        Alan Cox <alan@redhat.com>
   5  *
   6  *  Based on pata-sil680. Errata information is taken from data sheets
   7  *  and the amd74xx.c driver by Vojtech Pavlik. Nvidia SATA devices are
   8  *  claimed by sata-nv.c.
   9  *
  10  *  TODO:
  11  *      Variable system clock when/if it makes sense
  12  *      Power management on ports
  13  *
  14  *
  15  *  Documentation publically available.
  16  */
  17
  18 #include <linux/kernel.h>
  19 #include <linux/module.h>
  20 #include <linux/pci.h>
  21 #include <linux/init.h>
  22 #include <linux/blkdev.h>
  23 #include <linux/delay.h>
  24 #include <scsi/scsi_host.h>
  25 #include <linux/libata.h>
  26
  27 #define DRV_NAME "pata_amd"
  28 #define DRV_VERSION "0.2.8"
  29
  30 /**
  31  *      timing_setup            -       shared timing computation and load
  32  *      @ap: ATA port being set up
  33  *      @adev: drive being configured
  34  *      @offset: port offset
  35  *      @speed: target speed
  36  *      @clock: clock multiplier (number of times 33MHz for this part)
  37  *
  38  *      Perform the actual timing set up for Nvidia or AMD PATA devices.
  39  *      The actual devices vary so they all call into this helper function
  40  *      providing the clock multipler and offset (because AMD and Nvidia put
  41  *      the ports at different locations).
  42  */
  43
  44 static void timing_setup(struct ata_port *ap, struct ata_device *adev, int offset, int speed, int clock)
  45 {
  46         static const unsigned char amd_cyc2udma[] = {
  47                 6, 6, 5, 4, 0, 1, 1, 2, 2, 3, 3, 3, 3, 3, 3, 7
  48         };
  49
  50         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
  51         struct ata_device *peer = ata_dev_pair(adev);
  52         int dn = ap->port_no * 2 + adev->devno;
  53         struct ata_timing at, apeer;
  54         int T, UT;
  55         const int amd_clock = 33333;    /* KHz. */
  56         u8 t;
  57
  58         T = 1000000000 / amd_clock;
  59         UT = T / min_t(int, max_t(int, clock, 1), 2);
  60
  61         if (ata_timing_compute(adev, speed, &at, T, UT) < 0) {
  62                 dev_printk(KERN_ERR, &pdev->dev, "unknown mode %d.\n", speed);
  63                 return;
  64         }
  65
  66         if (peer) {
  67                 /* This may be over conservative */
  68                 if (peer->dma_mode) {
  69                         ata_timing_compute(peer, peer->dma_mode, &apeer, T, UT);
  70                         ata_timing_merge(&apeer, &at, &at, ATA_TIMING_8BIT);
  71                 }
  72                 ata_timing_compute(peer, peer->pio_mode, &apeer, T, UT);
  73                 ata_timing_merge(&apeer, &at, &at, ATA_TIMING_8BIT);
  74         }
  75
  76         if (speed == XFER_UDMA_5 && amd_clock <= 33333) at.udma = 1;
  77         if (speed == XFER_UDMA_6 && amd_clock <= 33333) at.udma = 15;
  78
  79         /*
  80          *      Now do the setup work
  81          */
  82
  83         /* Configure the address set up timing */
  84         pci_read_config_byte(pdev, offset + 0x0C, &t);
  85         t = (t & ~(3 << ((3 - dn) << 1))) | ((FIT(at.setup, 1, 4) - 1) << ((3 - dn) << 1));
  86         pci_write_config_byte(pdev, offset + 0x0C , t);
  87
  88         /* Configure the 8bit I/O timing */
  89         pci_write_config_byte(pdev, offset + 0x0E + (1 - (dn >> 1)),
  90                 ((FIT(at.act8b, 1, 16) - 1) << 4) | (FIT(at.rec8b, 1, 16) - 1));
  91
  92         /* Drive timing */
  93         pci_write_config_byte(pdev, offset + 0x08 + (3 - dn),
  94                 ((FIT(at.active, 1, 16) - 1) << 4) | (FIT(at.recover, 1, 16) - 1));
  95
  96         switch (clock) {
  97                 case 1:
  98                 t = at.udma ? (0xc0 | (FIT(at.udma, 2, 5) - 2)) : 0x03;
  99                 break;
 100
 101                 case 2:
 102                 t = at.udma ? (0xc0 | amd_cyc2udma[FIT(at.udma, 2, 10)]) : 0x03;
 103                 break;
 104
 105                 case 3:
 106                 t = at.udma ? (0xc0 | amd_cyc2udma[FIT(at.udma, 1, 10)]) : 0x03;
 107                 break;
 108
 109                 case 4:
 110                 t = at.udma ? (0xc0 | amd_cyc2udma[FIT(at.udma, 1, 15)]) : 0x03;
 111                 break;
 112
 113                 default:
 114                         return;
 115         }
 116
 117         /* UDMA timing */
 118         pci_write_config_byte(pdev, offset + 0x10 + (3 - dn), t);
 119 }
 120
 121 /**
 122  *      amd_probe_init          -       cable detection
 123  *      @ap: ATA port
 124  *
 125  *      Perform cable detection. The BIOS stores this in PCI config
 126  *      space for us.
 127  */
 128
 129 static int amd_pre_reset(struct ata_port *ap)
 130 {
 131         static const u32 bitmask[2] = {0x03, 0x0C};
 132         static const struct pci_bits amd_enable_bits[] = {
 133                 { 0x40, 1, 0x02, 0x02 },
 134                 { 0x40, 1, 0x01, 0x01 }
 135         };
 136
 137         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 138         u8 ata66;
 139
 140         if (!pci_test_config_bits(pdev, &amd_enable_bits[ap->port_no]))
 141                 return -ENOENT;
 142
 143         pci_read_config_byte(pdev, 0x42, &ata66);
 144         if (ata66 & bitmask[ap->port_no])
 145                 ap->cbl = ATA_CBL_PATA80;
 146         else
 147                 ap->cbl = ATA_CBL_PATA40;
 148         return ata_std_prereset(ap);
 149
 150 }
 151
 152 static void amd_error_handler(struct ata_port *ap)
 153 {
 154         return ata_bmdma_drive_eh(ap, amd_pre_reset,
 155                                       ata_std_softreset, NULL,
 156                                       ata_std_postreset);
 157 }
 158
 159 static int amd_early_pre_reset(struct ata_port *ap)
 160 {
 161         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 162         static struct pci_bits amd_enable_bits[] = {
 163                 { 0x40, 1, 0x02, 0x02 },
 164                 { 0x40, 1, 0x01, 0x01 }
 165         };
 166
 167         if (!pci_test_config_bits(pdev, &amd_enable_bits[ap->port_no]))
 168                 return -ENOENT;
 169
 170         /* No host side cable detection */
 171         ap->cbl = ATA_CBL_PATA80;
 172         return ata_std_prereset(ap);
 173
 174 }
 175
 176 static void amd_early_error_handler(struct ata_port *ap)
 177 {
 178         ata_bmdma_drive_eh(ap, amd_early_pre_reset,
 179                                ata_std_softreset, NULL,
 180                                ata_std_postreset);
 181 }
 182
 183 /**
 184  *      amd33_set_piomode       -       set initial PIO mode data
 185  *      @ap: ATA interface
 186  *      @adev: ATA device
 187  *
 188  *      Program the AMD registers for PIO mode.
 189  */
 190
 191 static void amd33_set_piomode(struct ata_port *ap, struct ata_device *adev)
 192 {
 193         timing_setup(ap, adev, 0x40, adev->pio_mode, 1);
 194 }
 195
 196 static void amd66_set_piomode(struct ata_port *ap, struct ata_device *adev)
 197 {
 198         timing_setup(ap, adev, 0x40, adev->pio_mode, 2);
 199 }
 200
 201 static void amd100_set_piomode(struct ata_port *ap, struct ata_device *adev)
 202 {
 203         timing_setup(ap, adev, 0x40, adev->pio_mode, 3);
 204 }
 205
 206 static void amd133_set_piomode(struct ata_port *ap, struct ata_device *adev)
 207 {
 208         timing_setup(ap, adev, 0x40, adev->pio_mode, 4);
 209 }
 210
 211 /**
 212  *      amd33_set_dmamode       -       set initial DMA mode data
 213  *      @ap: ATA interface
 214  *      @adev: ATA device
 215  *
 216  *      Program the MWDMA/UDMA modes for the AMD and Nvidia
 217  *      chipset.
 218  */
 219
 220 static void amd33_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 221 {
 222         timing_setup(ap, adev, 0x40, adev->dma_mode, 1);
 223 }
 224
 225 static void amd66_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 226 {
 227         timing_setup(ap, adev, 0x40, adev->dma_mode, 2);
 228 }
 229
 230 static void amd100_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 231 {
 232         timing_setup(ap, adev, 0x40, adev->dma_mode, 3);
 233 }
 234
 235 static void amd133_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 236 {
 237         timing_setup(ap, adev, 0x40, adev->dma_mode, 4);
 238 }
 239
 240
 241 /**
 242  *      nv_probe_init   -       cable detection
 243  *      @ap: ATA port
 244  *
 245  *      Perform cable detection. The BIOS stores this in PCI config
 246  *      space for us.
 247  */
 248
 249 static int nv_pre_reset(struct ata_port *ap) {
 250         static const u8 bitmask[2] = {0x03, 0x0C};
 251         static const struct pci_bits nv_enable_bits[] = {
 252                 { 0x50, 1, 0x02, 0x02 },
 253                 { 0x50, 1, 0x01, 0x01 }
 254         };
 255
 256         struct pci_dev *pdev = to_pci_dev(ap->host->dev);
 257         u8 ata66;
 258         u16 udma;
 259
 260         if (!pci_test_config_bits(pdev, &nv_enable_bits[ap->port_no]))
 261                 return -ENOENT;
 262
 263         pci_read_config_byte(pdev, 0x52, &ata66);
 264         if (ata66 & bitmask[ap->port_no])
 265                 ap->cbl = ATA_CBL_PATA80;
 266         else
 267                 ap->cbl = ATA_CBL_PATA40;
 268
 269         /* We now have to double check because the Nvidia boxes BIOS
 270            doesn't always set the cable bits but does set mode bits */
 271
 272         pci_read_config_word(pdev, 0x62 - 2 * ap->port_no, &udma);
 273         if ((udma & 0xC4) == 0xC4 || (udma & 0xC400) == 0xC400)
 274                 ap->cbl = ATA_CBL_PATA80;
 275         return ata_std_prereset(ap);
 276 }
 277
 278 static void nv_error_handler(struct ata_port *ap)
 279 {
 280         ata_bmdma_drive_eh(ap, nv_pre_reset,
 281                                ata_std_softreset, NULL,
 282                                ata_std_postreset);
 283 }
 284 /**
 285  *      nv100_set_piomode       -       set initial PIO mode data
 286  *      @ap: ATA interface
 287  *      @adev: ATA device
 288  *
 289  *      Program the AMD registers for PIO mode.
 290  */
 291
 292 static void nv100_set_piomode(struct ata_port *ap, struct ata_device *adev)
 293 {
 294         timing_setup(ap, adev, 0x50, adev->pio_mode, 3);
 295 }
 296
 297 static void nv133_set_piomode(struct ata_port *ap, struct ata_device *adev)
 298 {
 299         timing_setup(ap, adev, 0x50, adev->pio_mode, 4);
 300 }
 301
 302 /**
 303  *      nv100_set_dmamode       -       set initial DMA mode data
 304  *      @ap: ATA interface
 305  *      @adev: ATA device
 306  *
 307  *      Program the MWDMA/UDMA modes for the AMD and Nvidia
 308  *      chipset.
 309  */
 310
 311 static void nv100_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 312 {
 313         timing_setup(ap, adev, 0x50, adev->dma_mode, 3);
 314 }
 315
 316 static void nv133_set_dmamode(struct ata_port *ap, struct ata_device *adev)
 317 {
 318         timing_setup(ap, adev, 0x50, adev->dma_mode, 4);
 319 }
 320
 321 static struct scsi_host_template amd_sht = {
 322         .module                 = THIS_MODULE,
 323         .name                   = DRV_NAME,
 324         .ioctl                  = ata_scsi_ioctl,
 325         .queuecommand           = ata_scsi_queuecmd,
 326         .can_queue              = ATA_DEF_QUEUE,
 327         .this_id                = ATA_SHT_THIS_ID,
 328         .sg_tablesize           = LIBATA_MAX_PRD,
 329         .cmd_per_lun            = ATA_SHT_CMD_PER_LUN,
 330         .emulated               = ATA_SHT_EMULATED,
 331         .use_clustering         = ATA_SHT_USE_CLUSTERING,
 332         .proc_name              = DRV_NAME,
 333         .dma_boundary           = ATA_DMA_BOUNDARY,
 334         .slave_configure        = ata_scsi_slave_config,
 335         .slave_destroy          = ata_scsi_slave_destroy,
 336         .bios_param             = ata_std_bios_param,
 337 #ifdef CONFIG_PM
 338         .resume                 = ata_scsi_device_resume,
 339         .suspend                = ata_scsi_device_suspend,
 340 #endif
 341 };
 342
 343 static struct ata_port_operations amd33_port_ops = {
 344         .port_disable   = ata_port_disable,
 345         .set_piomode    = amd33_set_piomode,
 346         .set_dmamode    = amd33_set_dmamode,
 347         .mode_filter    = ata_pci_default_filter,
 348         .tf_load        = ata_tf_load,
 349         .tf_read        = ata_tf_read,
 350         .check_status   = ata_check_status,
 351         .exec_command   = ata_exec_command,
 352         .dev_select     = ata_std_dev_select,
 353
 354         .freeze         = ata_bmdma_freeze,
 355         .thaw           = ata_bmdma_thaw,
 356         .error_handler  = amd_early_error_handler,
 357         .post_internal_cmd = ata_bmdma_post_internal_cmd,
 358
 359         .bmdma_setup    = ata_bmdma_setup,
 360         .bmdma_start    = ata_bmdma_start,
 361         .bmdma_stop     = ata_bmdma_stop,
 362         .bmdma_status   = ata_bmdma_status,
 363
 364         .qc_prep        = ata_qc_prep,
 365         .qc_issue       = ata_qc_issue_prot,
 366
 367         .data_xfer      = ata_data_xfer,
 368
 369         .irq_handler    = ata_interrupt,
 370         .irq_clear      = ata_bmdma_irq_clear,
 371         .irq_on         = ata_irq_on,
 372         .irq_ack        = ata_irq_ack,
 373
 374         .port_start     = ata_port_start,
 375 };
 376
 377 static struct ata_port_operations amd66_port_ops = {
 378         .port_disable   = ata_port_disable,
 379         .set_piomode    = amd66_set_piomode,
 380         .set_dmamode    = amd66_set_dmamode,
 381         .mode_filter    = ata_pci_default_filter,
 382         .tf_load        = ata_tf_load,
 383         .tf_read        = ata_tf_read,
 384         .check_status   = ata_check_status,
 385         .exec_command   = ata_exec_command,
 386         .dev_select     = ata_std_dev_select,
 387
 388         .freeze         = ata_bmdma_freeze,
 389         .thaw           = ata_bmdma_thaw,
 390         .error_handler  = amd_early_error_handler,
 391         .post_internal_cmd = ata_bmdma_post_internal_cmd,
 392
 393         .bmdma_setup    = ata_bmdma_setup,
 394         .bmdma_start    = ata_bmdma_start,
 395         .bmdma_stop     = ata_bmdma_stop,
 396         .bmdma_status   = ata_bmdma_status,
 397
 398         .qc_prep        = ata_qc_prep,
 399         .qc_issue       = ata_qc_issue_prot,
 400
 401         .data_xfer      = ata_data_xfer,
 402
 403         .irq_handler    = ata_interrupt,
 404         .irq_clear      = ata_bmdma_irq_clear,
 405         .irq_on         = ata_irq_on,
 406         .irq_ack        = ata_irq_ack,
 407
 408         .port_start     = ata_port_start,
 409 };
 410
 411 static struct ata_port_operations amd100_port_ops = {
 412         .port_disable   = ata_port_disable,
 413         .set_piomode    = amd100_set_piomode,
 414         .set_dmamode    = amd100_set_dmamode,
 415         .mode_filter    = ata_pci_default_filter,
 416         .tf_load        = ata_tf_load,
 417         .tf_read        = ata_tf_read,
 418         .check_status   = ata_check_status,
 419         .exec_command   = ata_exec_command,
 420         .dev_select     = ata_std_dev_select,
 421
 422         .freeze         = ata_bmdma_freeze,
 423         .thaw           = ata_bmdma_thaw,
 424         .error_handler  = amd_error_handler,
 425         .post_internal_cmd = ata_bmdma_post_internal_cmd,
 426
 427         .bmdma_setup    = ata_bmdma_setup,
 428         .bmdma_start    = ata_bmdma_start,
 429         .bmdma_stop     = ata_bmdma_stop,
 430         .bmdma_status   = ata_bmdma_status,
 431
 432         .qc_prep        = ata_qc_prep,
 433         .qc_issue       = ata_qc_issue_prot,
 434
 435         .data_xfer      = ata_data_xfer,
 436
 437         .irq_handler    = ata_interrupt,
 438         .irq_clear      = ata_bmdma_irq_clear,
 439         .irq_on         = ata_irq_on,
 440         .irq_ack        = ata_irq_ack,
 441
 442         .port_start     = ata_port_start,
 443 };
 444
 445 static struct ata_port_operations amd133_port_ops = {
 446         .port_disable   = ata_port_disable,
 447         .set_piomode    = amd133_set_piomode,
 448         .set_dmamode    = amd133_set_dmamode,
 449         .mode_filter    = ata_pci_default_filter,
 450         .tf_load        = ata_tf_load,
 451         .tf_read        = ata_tf_read,
 452         .check_status   = ata_check_status,
 453         .exec_command   = ata_exec_command,
 454         .dev_select     = ata_std_dev_select,
 455
 456         .freeze         = ata_bmdma_freeze,
 457         .thaw           = ata_bmdma_thaw,
 458         .error_handler  = amd_error_handler,
 459         .post_internal_cmd = ata_bmdma_post_internal_cmd,
 460
 461         .bmdma_setup    = ata_bmdma_setup,
 462         .bmdma_start    = ata_bmdma_start,
 463         .bmdma_stop     = ata_bmdma_stop,
 464         .bmdma_status   = ata_bmdma_status,
 465
 466         .qc_prep        = ata_qc_prep,
 467         .qc_issue       = ata_qc_issue_prot,
 468
 469         .data_xfer      = ata_data_xfer,
 470
 471         .irq_handler    = ata_interrupt,
 472         .irq_clear      = ata_bmdma_irq_clear,
 473         .irq_on         = ata_irq_on,
 474         .irq_ack        = ata_irq_ack,
 475
 476         .port_start     = ata_port_start,
 477 };
 478
 479 static struct ata_port_operations nv100_port_ops = {
 480         .port_disable   = ata_port_disable,
 481         .set_piomode    = nv100_set_piomode,
 482         .set_dmamode    = nv100_set_dmamode,
 483         .mode_filter    = ata_pci_default_filter,
 484         .tf_load        = ata_tf_load,
 485         .tf_read        = ata_tf_read,
 486         .check_status   = ata_check_status,
 487         .exec_command   = ata_exec_command,
 488         .dev_select     = ata_std_dev_select,
 489
 490         .freeze         = ata_bmdma_freeze,
 491         .thaw           = ata_bmdma_thaw,
 492         .error_handler  = nv_error_handler,
 493         .post_internal_cmd = ata_bmdma_post_internal_cmd,
 494
 495         .bmdma_setup    = ata_bmdma_setup,
 496         .bmdma_start    = ata_bmdma_start,
 497         .bmdma_stop     = ata_bmdma_stop,
 498         .bmdma_status   = ata_bmdma_status,
 499
 500         .qc_prep        = ata_qc_prep,
 501         .qc_issue       = ata_qc_issue_prot,
 502
 503         .data_xfer      = ata_data_xfer,
 504
 505         .irq_handler    = ata_interrupt,
 506         .irq_clear      = ata_bmdma_irq_clear,
 507         .irq_on         = ata_irq_on,
 508         .irq_ack        = ata_irq_ack,
 509
 510         .port_start     = ata_port_start,
 511 };
 512
 513 static struct ata_port_operations nv133_port_ops = {
 514         .port_disable   = ata_port_disable,
 515         .set_piomode    = nv133_set_piomode,
 516         .set_dmamode    = nv133_set_dmamode,
 517         .mode_filter    = ata_pci_default_filter,
 518         .tf_load        = ata_tf_load,
 519         .tf_read        = ata_tf_read,
 520         .check_status   = ata_check_status,
 521         .exec_command   = ata_exec_command,
 522         .dev_select     = ata_std_dev_select,
 523
 524         .freeze         = ata_bmdma_freeze,
 525         .thaw           = ata_bmdma_thaw,
 526         .error_handler  = nv_error_handler,
 527         .post_internal_cmd = ata_bmdma_post_internal_cmd,
 528
 529         .bmdma_setup    = ata_bmdma_setup,
 530         .bmdma_start    = ata_bmdma_start,
 531         .bmdma_stop     = ata_bmdma_stop,
 532         .bmdma_status   = ata_bmdma_status,
 533
 534         .qc_prep        = ata_qc_prep,
 535         .qc_issue       = ata_qc_issue_prot,
 536
 537         .data_xfer      = ata_data_xfer,
 538
 539         .irq_handler    = ata_interrupt,
 540         .irq_clear      = ata_bmdma_irq_clear,
 541         .irq_on         = ata_irq_on,
 542         .irq_ack        = ata_irq_ack,
 543
 544         .port_start     = ata_port_start,
 545 };
 546
 547 static int amd_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
 548 {
 549         static struct ata_port_info info[10] = {
 550                 {       /* 0: AMD 7401 */
 551                         .sht = &amd_sht,
 552                         .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
 553                         .pio_mask = 0x1f,
 554                         .mwdma_mask = 0x07,     /* No SWDMA */
 555                         .udma_mask = 0x07,      /* UDMA 33 */
 556                         .port_ops = &amd33_port_ops
 557                 },
 558                 {       /* 1: Early AMD7409 - no swdma */
 559                         .sht = &amd_sht,
 560                         .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
 561                         .pio_mask = 0x1f,
 562                         .mwdma_mask = 0x07,
 563                         .udma_mask = 0x1f,      /* UDMA 66 */
 564                         .port_ops = &amd66_port_ops
 565                 },
 566                 {       /* 2: AMD 7409, no swdma errata */
 567                         .sht = &amd_sht,
 568                         .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
 569                         .pio_mask = 0x1f,
 570                         .mwdma_mask = 0x07,
 571                         .udma_mask = 0x1f,      /* UDMA 66 */
 572                         .port_ops = &amd66_port_ops
 573                 },
 574                 {       /* 3: AMD 7411 */
 575                         .sht = &amd_sht,
 576                         .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
 577                         .pio_mask = 0x1f,
 578                         .mwdma_mask = 0x07,
 579                         .udma_mask = 0x3f,      /* UDMA 100 */
 580                         .port_ops = &amd100_port_ops
 581                 },
 582                 {       /* 4: AMD 7441 */
 583                         .sht = &amd_sht,
 584                         .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
 585                         .pio_mask = 0x1f,
 586                         .mwdma_mask = 0x07,
 587                         .udma_mask = 0x3f,      /* UDMA 100 */
 588                         .port_ops = &amd100_port_ops
 589                 },
 590                 {       /* 5: AMD 8111*/
 591                         .sht = &amd_sht,
 592                         .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
 593                         .pio_mask = 0x1f,
 594                         .mwdma_mask = 0x07,
 595                         .udma_mask = 0x7f,      /* UDMA 133, no swdma */
 596                         .port_ops = &amd133_port_ops
 597                 },
 598                 {       /* 6: AMD 8111 UDMA 100 (Serenade) */
 599                         .sht = &amd_sht,
 600                         .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
 601                         .pio_mask = 0x1f,
 602                         .mwdma_mask = 0x07,
 603                         .udma_mask = 0x3f,      /* UDMA 100, no swdma */
 604                         .port_ops = &amd133_port_ops
 605                 },
 606                 {       /* 7: Nvidia Nforce */
 607                         .sht = &amd_sht,
 608                         .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
 609                         .pio_mask = 0x1f,
 610                         .mwdma_mask = 0x07,
 611                         .udma_mask = 0x3f,      /* UDMA 100 */
 612                         .port_ops = &nv100_port_ops
 613                 },
 614                 {       /* 8: Nvidia Nforce2 and later */
 615                         .sht = &amd_sht,
 616                         .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
 617                         .pio_mask = 0x1f,
 618                         .mwdma_mask = 0x07,
 619                         .udma_mask = 0x7f,      /* UDMA 133, no swdma */
 620                         .port_ops = &nv133_port_ops
 621                 },
 622                 {       /* 9: AMD CS5536 (Geode companion) */
 623                         .sht = &amd_sht,
 624                         .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
 625                         .pio_mask = 0x1f,
 626                         .mwdma_mask = 0x07,
 627                         .udma_mask = 0x3f,      /* UDMA 100 */
 628                         .port_ops = &amd100_port_ops
 629                 }
 630         };
 631         static struct ata_port_info *port_info[2];
 632         static int printed_version;
 633         int type = id->driver_data;
 634         u8 rev;
 635         u8 fifo;
 636
 637         if (!printed_version++)
 638                 dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
 639
 640         pci_read_config_byte(pdev, PCI_REVISION_ID, &rev);
 641         pci_read_config_byte(pdev, 0x41, &fifo);
 642
 643         /* Check for AMD7409 without swdma errata and if found adjust type */
 644         if (type == 1 && rev > 0x7)
 645                 type = 2;
 646
 647         /* Check for AMD7411 */
 648         if (type == 3)
 649                 /* FIFO is broken */
 650                 pci_write_config_byte(pdev, 0x41, fifo & 0x0F);
 651         else
 652                 pci_write_config_byte(pdev, 0x41, fifo | 0xF0);
 653
 654         /* Serenade ? */
 655         if (type == 5 && pdev->subsystem_vendor == PCI_VENDOR_ID_AMD &&
 656                          pdev->subsystem_device == PCI_DEVICE_ID_AMD_SERENADE)
 657                 type = 6;       /* UDMA 100 only */
 658
 659         if (type < 3)
 660                 ata_pci_clear_simplex(pdev);
 661
 662         /* And fire it up */
 663
 664         port_info[0] = port_info[1] = &info[type];
 665         return ata_pci_init_one(pdev, port_info, 2);
 666 }
 667
 668 #ifdef CONFIG_PM
 669 static int amd_reinit_one(struct pci_dev *pdev)
 670 {
 671         if (pdev->vendor == PCI_VENDOR_ID_AMD) {
 672                 u8 fifo;
 673                 pci_read_config_byte(pdev, 0x41, &fifo);
 674                 if (pdev->device == PCI_DEVICE_ID_AMD_VIPER_7411)
 675                         /* FIFO is broken */
 676                         pci_write_config_byte(pdev, 0x41, fifo & 0x0F);
 677                 else
 678                         pci_write_config_byte(pdev, 0x41, fifo | 0xF0);
 679                 if (pdev->device == PCI_DEVICE_ID_AMD_VIPER_7409 ||
 680                     pdev->device == PCI_DEVICE_ID_AMD_COBRA_7401)
 681                         ata_pci_clear_simplex(pdev);
 682         }
 683         return ata_pci_device_resume(pdev);
 684 }
 685 #endif
 686
 687 static const struct pci_device_id amd[] = {
 688         { PCI_VDEVICE(AMD,      PCI_DEVICE_ID_AMD_COBRA_7401),          0 },
 689         { PCI_VDEVICE(AMD,      PCI_DEVICE_ID_AMD_VIPER_7409),          1 },
 690         { PCI_VDEVICE(AMD,      PCI_DEVICE_ID_AMD_VIPER_7411),          3 },
 691         { PCI_VDEVICE(AMD,      PCI_DEVICE_ID_AMD_OPUS_7441),           4 },
 692         { PCI_VDEVICE(AMD,      PCI_DEVICE_ID_AMD_8111_IDE),            5 },
 693         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE_IDE),       7 },
 694         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE2_IDE),      8 },
 695         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE2S_IDE),     8 },
 696         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE3_IDE),      8 },
 697         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE3S_IDE),     8 },
 698         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_IDE), 8 },
 699         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_IDE), 8 },
 700         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_IDE), 8 },
 701         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_IDE), 8 },
 702         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE_MCP61_IDE), 8 },
 703         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE_MCP65_IDE), 8 },
 704         { PCI_VDEVICE(NVIDIA,   PCI_DEVICE_ID_NVIDIA_NFORCE_MCP67_IDE), 8 },
 705         { PCI_VDEVICE(AMD,      PCI_DEVICE_ID_AMD_CS5536_IDE),          9 },
 706
 707         { },
 708 };
 709
 710 static struct pci_driver amd_pci_driver = {
 711         .name           = DRV_NAME,
 712         .id_table       = amd,
 713         .probe          = amd_init_one,
 714         .remove         = ata_pci_remove_one,
 715 #ifdef CONFIG_PM
 716         .suspend        = ata_pci_device_suspend,
 717         .resume         = amd_reinit_one,
 718 #endif
 719 };
 720
 721 static int __init amd_init(void)
 722 {
 723         return pci_register_driver(&amd_pci_driver);
 724 }
 725
 726 static void __exit amd_exit(void)
 727 {
 728         pci_unregister_driver(&amd_pci_driver);
 729 }
 730
 731 MODULE_AUTHOR("Alan Cox");
 732 MODULE_DESCRIPTION("low-level driver for AMD PATA IDE");
 733 MODULE_LICENSE("GPL");
 734 MODULE_DEVICE_TABLE(pci, amd);
 735 MODULE_VERSION(DRV_VERSION);
 736
 737 module_init(amd_init);
 738 module_exit(amd_exit);