sys/dev/disk/nata/chipsets/ata-amd.c

   1 /*-
   2  * Copyright (c) 1998 - 2008 Søren Schmidt <sos@FreeBSD.org>
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer,
  10  *    without modification, immediately at the beginning of the file.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  */
  26
  27 /* local prototypes */
  28 static int ata_amd_chipinit(device_t dev);
  29 static void ata_amd_setmode(device_t dev, int mode);
  30
  31 /* misc defines */
  32 #define AMD_BUG         0x01
  33 #define AMD_CABLE       0x02
  34
  35 /*
  36  * Advanced Micro Devices (AMD) chipset support functions
  37  */
  38 int
  39 ata_amd_ident(device_t dev)
  40 {
  41     struct ata_pci_controller *ctlr = device_get_softc(dev);
  42     static const struct ata_chip_id ids[] =
  43     {{ ATA_AMD756,  0x00, 0x00,              0, ATA_UDMA4, "756" },
  44      { ATA_AMD766,  0x00, AMD_CABLE|AMD_BUG, 0, ATA_UDMA5, "766" },
  45      { ATA_AMD768,  0x00, AMD_CABLE,         0, ATA_UDMA5, "768" },
  46      { ATA_AMD8111, 0x00, AMD_CABLE,         0, ATA_UDMA6, "8111" },
  47      { ATA_AMD5536, 0x00, 0x00,              0, ATA_UDMA5, "CS5536" },
  48      { 0, 0, 0, 0, 0, 0}};
  49
  50     if (pci_get_vendor(dev) != ATA_AMD_ID)
  51         return ENXIO;
  52
  53     if (!(ctlr->chip = ata_match_chip(dev, ids)))
  54         return ENXIO;
  55
  56     ata_set_desc(dev);
  57     ctlr->chipinit = ata_amd_chipinit;
  58     return 0;
  59 }
  60
  61 static int
  62 ata_amd_chipinit(device_t dev)
  63 {
  64     struct ata_pci_controller *ctlr = device_get_softc(dev);
  65
  66     if (ata_setup_interrupt(dev, ata_generic_intr))
  67         return ENXIO;
  68
  69     /* disable/set prefetch, postwrite */
  70     if (ctlr->chip->cfg1 & AMD_BUG)
  71         pci_write_config(dev, 0x41, pci_read_config(dev, 0x41, 1) & 0x0f, 1);
  72     else
  73         pci_write_config(dev, 0x41, pci_read_config(dev, 0x41, 1) | 0xf0, 1);
  74
  75     ctlr->setmode = ata_amd_setmode;
  76     return 0;
  77 }
  78
  79 static void
  80 ata_amd_setmode(device_t dev, int mode)
  81 {
  82         device_t gparent = GRANDPARENT(dev);
  83         struct ata_pci_controller *ctlr = device_get_softc(gparent);
  84         struct ata_channel *ch = device_get_softc(device_get_parent(dev));
  85         struct ata_device *atadev = device_get_softc(dev);
  86         int devno = (ch->unit << 1) + atadev->unit;
  87         static const uint8_t timings[] =
  88                          { 0xa8, 0x65, 0x42, 0x22, 0x20, 0x42, 0x22, 0x20,
  89                            0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20 };
  90         static const uint8_t modes[] =
  91             { 0xc2, 0xc1, 0xc0, 0xc4, 0xc5, 0xc6, 0xc7 };
  92         int reg = 0x53 - devno;
  93         int error;
  94
  95     mode = ata_limit_mode(dev, mode, ctlr->chip->max_dma);
  96
  97     if (ctlr->chip->cfg1 & AMD_CABLE) {
  98         if (mode > ATA_UDMA2 &&
  99             !(pci_read_config(gparent, 0x42, 1) & (1 << devno))) {
 100             ata_print_cable(dev, "controller");
 101             mode = ATA_UDMA2;
 102         }
 103     }
 104     else
 105         mode = ata_check_80pin(dev, mode);
 106
 107     error = ata_controlcmd(dev, ATA_SETFEATURES, ATA_SF_SETXFER, 0, mode);
 108     if (bootverbose)
 109         device_printf(dev, "%ssetting %s on %s chip\n",
 110                       (error) ? "FAILURE " : "", ata_mode2str(mode),
 111                       ctlr->chip->text);
 112     if (!error) {
 113         pci_write_config(gparent, reg - 0x08, timings[ata_mode2idx(mode)], 1);
 114         if (mode >= ATA_UDMA0)
 115             pci_write_config(gparent, reg, modes[mode & ATA_MODE_MASK], 1);
 116         else
 117             pci_write_config(gparent, reg, 0x8b, 1);
 118         atadev->mode = mode;
 119     }
 120 }