177 lines
4 KiB
C
177 lines
4 KiB
C
|
/*
|
||
|
|
* Copyright 2004 Tyan Computer
|
||
|
|
* by yhlu@tyan.com
|
||
|
|
*/
|
||
|
|
#include <console/console.h>
|
||
|
|
#include <device/device.h>
|
||
|
|
#include <delay.h>
|
||
|
|
#include <device/pci.h>
|
||
|
|
#include <device/pci_ids.h>
|
||
|
|
#include <device/pci_ops.h>
|
||
|
|
#include "ck804.h"
|
||
|
|
|
||
|
|
|
||
|
|
static void sata_com_reset(struct device *dev, unsigned reset)
|
||
|
|
// reset = 1 : reset
|
||
|
|
// reset = 0 : clear
|
||
|
|
{
|
||
|
|
uint32_t *base;
|
||
|
|
uint32_t dword;
|
||
|
|
int loop;
|
||
|
|
|
||
|
|
base = (uint32_t *) pci_read_config32(dev, 0x24);
|
||
|
|
|
||
|
|
printk_debug("base = %08x\r\n", base);
|
||
|
|
|
||
|
|
if(reset) {
|
||
|
|
*(base + 4) = 0xffffffff;
|
||
|
|
*(base + 0x44) = 0xffffffff;
|
||
|
|
}
|
||
|
|
|
||
|
|
dword = *(base +8);
|
||
|
|
dword &= ~(0xf);
|
||
|
|
dword |= reset;
|
||
|
|
|
||
|
|
*(base + 8) = dword;
|
||
|
|
*(base + 0x48) = dword;
|
||
|
|
|
||
|
|
#if 0
|
||
|
|
udelay(1000);
|
||
|
|
dword &= ~(0xf);
|
||
|
|
*(base + 8) = dword;
|
||
|
|
*(base + 0x48) = dword;
|
||
|
|
#endif
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
if(reset) return;
|
||
|
|
|
||
|
|
dword = *(base+ 0);
|
||
|
|
printk_debug("*(base+0)=%08x\r\n",dword);
|
||
|
|
if(dword == 0x113) {
|
||
|
|
loop = 200000;// 2
|
||
|
|
do {
|
||
|
|
dword = *(base + 4);
|
||
|
|
if((dword & 0x10000)!=0) break;
|
||
|
|
udelay(10);
|
||
|
|
} while (--loop>0);
|
||
|
|
printk_debug("loop=%d, *(base+4)=%08x\r\n",loop, dword);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
dword = *(base+ 0x40);
|
||
|
|
printk_debug("*(base+0x40)=%08x\r\n",dword);
|
||
|
|
if(dword == 0x113) {
|
||
|
|
loop = 200000;//2
|
||
|
|
do {
|
||
|
|
dword = *(base + 0x44);
|
||
|
|
if((dword & 0x10000)!=0) break;
|
||
|
|
udelay(10);
|
||
|
|
} while (--loop>0);
|
||
|
|
printk_debug("loop=%d, *(base+0x44)=%08x\r\n",loop, dword);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
static void sata_init(struct device *dev)
|
||
|
|
{
|
||
|
|
|
||
|
|
uint32_t dword;
|
||
|
|
|
||
|
|
struct southbridge_nvidia_ck804_config *conf;
|
||
|
|
conf = dev->chip_info;
|
||
|
|
|
||
|
|
dword = pci_read_config32(dev, 0x50);
|
||
|
|
/* Ensure prefetch is disabled */
|
||
|
|
dword &= ~((1 << 15) | (1 << 13));
|
||
|
|
if (conf->sata1_enable) {
|
||
|
|
/* Enable secondary SATA interface */
|
||
|
|
dword |= (1<<0);
|
||
|
|
printk_debug("SATA S \t");
|
||
|
|
}
|
||
|
|
if (conf->sata0_enable) {
|
||
|
|
/* Enable primary SATA interface */
|
||
|
|
dword |= (1<<1);
|
||
|
|
printk_debug("SATA P \n");
|
||
|
|
}
|
||
|
|
// write back
|
||
|
|
dword |= (1<<12);
|
||
|
|
dword |= (1<<14);
|
||
|
|
|
||
|
|
#if 1
|
||
|
|
// ADMA
|
||
|
|
dword |= (1<<16);
|
||
|
|
dword |= (1<<17);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#if 1
|
||
|
|
//DO NOT relay OK and PAGE_FRNDLY_DTXFR_CNT.
|
||
|
|
dword &= ~(0x1f<<24);
|
||
|
|
dword |= (0x15<<24);
|
||
|
|
#endif
|
||
|
|
pci_write_config32(dev, 0x50, dword);
|
||
|
|
|
||
|
|
#if 1
|
||
|
|
//SLUMBER_DURING_D3.
|
||
|
|
dword = pci_read_config32(dev, 0x7c);
|
||
|
|
dword &= ~(1<<4);
|
||
|
|
pci_write_config32(dev, 0x7c, dword);
|
||
|
|
|
||
|
|
dword = pci_read_config32(dev, 0xd0);
|
||
|
|
dword &= ~(0xff<<24);
|
||
|
|
dword |= (0x68<<24);
|
||
|
|
pci_write_config32(dev, 0xd0, dword);
|
||
|
|
|
||
|
|
dword = pci_read_config32(dev, 0xe0);
|
||
|
|
dword &= ~(0xff<<24);
|
||
|
|
dword |= (0x68<<24);
|
||
|
|
pci_write_config32(dev, 0xe0, dword);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
dword = pci_read_config32(dev, 0xf8);
|
||
|
|
dword |= 2;
|
||
|
|
pci_write_config32(dev, 0xf8, dword);
|
||
|
|
|
||
|
|
#if 0
|
||
|
|
dword = pci_read_config32(dev, 0xac);
|
||
|
|
dword &= ~((1<<13)|(1<<14));
|
||
|
|
dword |= (1<<13)|(0<<14);
|
||
|
|
pci_write_config32(dev, 0xac, dword);
|
||
|
|
|
||
|
|
sata_com_reset(dev, 1); // for discover some s-atapi device
|
||
|
|
#endif
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
static void lpci_set_subsystem(device_t dev, unsigned vendor, unsigned device)
|
||
|
|
{
|
||
|
|
pci_write_config32(dev, 0x40,
|
||
|
|
((device & 0xffff) << 16) | (vendor & 0xffff));
|
||
|
|
}
|
||
|
|
static struct pci_operations lops_pci = {
|
||
|
|
.set_subsystem = lpci_set_subsystem,
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct device_operations sata_ops = {
|
||
|
|
.read_resources = pci_dev_read_resources,
|
||
|
|
.set_resources = pci_dev_set_resources,
|
||
|
|
.enable_resources = pci_dev_enable_resources,
|
||
|
|
// .enable = ck804_enable,
|
||
|
|
.init = sata_init,
|
||
|
|
.scan_bus = 0,
|
||
|
|
.ops_pci = &lops_pci,
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct pci_driver sata0_driver __pci_driver = {
|
||
|
|
.ops = &sata_ops,
|
||
|
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
||
|
|
.device = PCI_DEVICE_ID_NVIDIA_CK804_SATA0,
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct pci_driver sata1_driver __pci_driver = {
|
||
|
|
.ops = &sata_ops,
|
||
|
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
||
|
|
.device = PCI_DEVICE_ID_NVIDIA_CK804_SATA1,
|
||
|
|
};
|