src/southbridge/nvidia/mcp55/mcp55_sata.c

   1 /*
   2  * This file is part of the LinuxBIOS project.
   3  *
   4  * Copyright (C) 2004 Tyan Computer
   5  * Written by Yinghai Lu <yhlu@tyan.com> for Tyan Computer.
   6  * Copyright (C) 2006,2007 AMD
   7  * Written by Yinghai Lu <yinghai.lu@amd.com> for AMD.
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License, or
  12  * (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  22  */
  23
  24 #include <console/console.h>
  25 #include <device/device.h>
  26 #include <delay.h>
  27 #include <device/pci.h>
  28 #include <device/pci_ids.h>
  29 #include <device/pci_ops.h>
  30 #include "mcp55.h"
  31
  32 static void sata_init(struct device *dev)
  33 {
  34         uint32_t dword;
  35
  36         struct southbridge_nvidia_mcp55_config *conf;
  37         conf = dev->chip_info;
  38
  39         dword = pci_read_config32(dev, 0x50);
  40         /* Ensure prefetch is disabled */
  41         dword &= ~((1 << 15) | (1 << 13));
  42         if(conf) {
  43                 if (conf->sata1_enable) {
  44                         /* Enable secondary SATA interface */
  45                         dword |= (1<<0);
  46                         printk_debug("SATA S \t");
  47                 }
  48                 if (conf->sata0_enable) {
  49                         /* Enable primary SATA interface */
  50                         dword |= (1<<1);
  51                         printk_debug("SATA P \n");
  52                 }
  53         } else {
  54                 dword |= (1<<1) | (1<<0);
  55                 printk_debug("SATA P and S \n");
  56         }
  57
  58
  59 #if 1
  60         dword &= ~(0x1f<<24);
  61         dword |= (0x15<<24);
  62 #endif
  63         pci_write_config32(dev, 0x50, dword);
  64
  65         dword = pci_read_config32(dev, 0xf8);
  66         dword |= 2;
  67         pci_write_config32(dev, 0xf8, dword);
  68
  69
  70 }
  71
  72 static void lpci_set_subsystem(device_t dev, unsigned vendor, unsigned device)
  73 {
  74         pci_write_config32(dev, 0x40,
  75                 ((device & 0xffff) << 16) | (vendor & 0xffff));
  76 }
  77 static struct pci_operations lops_pci = {
  78         .set_subsystem  = lpci_set_subsystem,
  79 };
  80
  81 static struct device_operations sata_ops = {
  82         .read_resources = pci_dev_read_resources,
  83         .set_resources  = pci_dev_set_resources,
  84         .enable_resources       = pci_dev_enable_resources,
  85 //      .enable         = mcp55_enable,
  86         .init           = sata_init,
  87         .scan_bus       = 0,
  88         .ops_pci        = &lops_pci,
  89 };
  90
  91 static const struct pci_driver sata0_driver __pci_driver = {
  92         .ops    = &sata_ops,
  93         .vendor = PCI_VENDOR_ID_NVIDIA,
  94         .device = PCI_DEVICE_ID_NVIDIA_MCP55_SATA0,
  95 };
  96
  97 static const struct pci_driver sata1_driver __pci_driver = {
  98         .ops    = &sata_ops,
  99         .vendor = PCI_VENDOR_ID_NVIDIA,
 100         .device = PCI_DEVICE_ID_NVIDIA_MCP55_SATA1,
 101 };