MCP55: Cosmetic fixes, switch to u8 et al.
Signed-off-by: Uwe Hermann <uwe@hermann-uwe.de> Acked-by: Uwe Hermann <uwe@hermann-uwe.de> git-svn-id: svn://svn.coreboot.org/coreboot/trunk@6241 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
This commit is contained in:
parent
7e2fbd5dd3
commit
c7f0c8feab
|
@ -36,25 +36,23 @@ static int set_bits(u32 port, u32 mask, u32 val)
|
||||||
u32 reg32;
|
u32 reg32;
|
||||||
int count;
|
int count;
|
||||||
|
|
||||||
/* Write (val & mask) to port */
|
/* Write (val & mask) to port. */
|
||||||
val &= mask;
|
val &= mask;
|
||||||
reg32 = read32(port);
|
reg32 = read32(port);
|
||||||
reg32 &= ~mask;
|
reg32 &= ~mask;
|
||||||
reg32 |= val;
|
reg32 |= val;
|
||||||
write32(port, reg32);
|
write32(port, reg32);
|
||||||
|
|
||||||
/* Wait for readback of register to
|
/* Wait for readback of register to match what was written to it. */
|
||||||
* match what was just written to it
|
|
||||||
*/
|
|
||||||
count = 50;
|
count = 50;
|
||||||
do {
|
do {
|
||||||
/* Wait 1ms based on BKDG wait time */
|
/* Wait 1ms based on BKDG wait time. */
|
||||||
mdelay(1);
|
mdelay(1);
|
||||||
reg32 = read32(port);
|
reg32 = read32(port);
|
||||||
reg32 &= mask;
|
reg32 &= mask;
|
||||||
} while ((reg32 != val) && --count);
|
} while ((reg32 != val) && --count);
|
||||||
|
|
||||||
/* Timeout occurred */
|
/* Timeout occurred. */
|
||||||
if (!count)
|
if (!count)
|
||||||
return -1;
|
return -1;
|
||||||
return 0;
|
return 0;
|
||||||
|
@ -64,15 +62,15 @@ static int codec_detect(u32 base)
|
||||||
{
|
{
|
||||||
u32 reg32;
|
u32 reg32;
|
||||||
|
|
||||||
/* Set Bit0 to 0 to enter reset state (BAR + 0x8)[0] */
|
/* Set bit 0 to 0 to enter reset state (BAR + 0x8)[0]. */
|
||||||
if (set_bits(base + 0x08, 1, 0) == -1)
|
if (set_bits(base + 0x08, 1, 0) == -1)
|
||||||
goto no_codec;
|
goto no_codec;
|
||||||
|
|
||||||
/* Set Bit 0 to 1 to exit reset state (BAR + 0x8)[0] */
|
/* Set bit 0 to 1 to exit reset state (BAR + 0x8)[0]. */
|
||||||
if (set_bits(base + 0x08, 1, 1) == -1)
|
if (set_bits(base + 0x08, 1, 1) == -1)
|
||||||
goto no_codec;
|
goto no_codec;
|
||||||
|
|
||||||
/* Read in Codec location (BAR + 0xe)[2..0]*/
|
/* Read in codec location (BAR + 0xe)[2..0]. */
|
||||||
reg32 = read32(base + 0xe);
|
reg32 = read32(base + 0xe);
|
||||||
reg32 &= 0x0f;
|
reg32 &= 0x0f;
|
||||||
if (!reg32)
|
if (!reg32)
|
||||||
|
@ -81,8 +79,8 @@ static int codec_detect(u32 base)
|
||||||
return reg32;
|
return reg32;
|
||||||
|
|
||||||
no_codec:
|
no_codec:
|
||||||
/* Codec Not found */
|
/* Codec not found. */
|
||||||
/* Put HDA back in reset (BAR + 0x8) [0] */
|
/* Put HDA back in reset (BAR + 0x8)[0]. */
|
||||||
set_bits(base + 0x08, 1, 0);
|
set_bits(base + 0x08, 1, 0);
|
||||||
printk(BIOS_DEBUG, "Azalia: No codec!\n");
|
printk(BIOS_DEBUG, "Azalia: No codec!\n");
|
||||||
return 0;
|
return 0;
|
||||||
|
@ -96,29 +94,26 @@ static u32 find_verb(struct device *dev, u32 viddid, u32 ** verb)
|
||||||
int idx = 0;
|
int idx = 0;
|
||||||
|
|
||||||
while (idx < (cim_verb_data_size / sizeof(u32))) {
|
while (idx < (cim_verb_data_size / sizeof(u32))) {
|
||||||
u32 verb_size = 4 * cim_verb_data[idx+2]; // in u32
|
u32 verb_size = 4 * cim_verb_data[idx + 2]; /* in u32 */
|
||||||
if (cim_verb_data[idx] != viddid) {
|
if (cim_verb_data[idx] != viddid) {
|
||||||
idx += verb_size + 3; // skip verb + header
|
idx += verb_size + 3; /* Skip verb + header. */
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
*verb = &cim_verb_data[idx + 3];
|
*verb = &cim_verb_data[idx + 3];
|
||||||
return verb_size;
|
return verb_size;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Not all codecs need to load another verb */
|
/* Not all codecs need to load another verb. */
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Wait 50usec for the codec to indicate it is ready
|
* Wait 50usec for the codec to indicate it is ready.
|
||||||
* no response would imply that the codec is non-operative
|
* No response would imply that the codec is non-operative.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
static int wait_for_ready(u32 base)
|
static int wait_for_ready(u32 base)
|
||||||
{
|
{
|
||||||
/* Use a 50 usec timeout - the Linux kernel uses the
|
/* Use a 50 usec timeout - the Linux kernel uses the same duration. */
|
||||||
* same duration */
|
|
||||||
|
|
||||||
int timeout = 50;
|
int timeout = 50;
|
||||||
|
|
||||||
while (timeout--) {
|
while (timeout--) {
|
||||||
|
@ -132,23 +127,19 @@ static int wait_for_ready(u32 base)
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Wait 50usec for the codec to indicate that it accepted
|
* Wait 50usec for the codec to indicate that it accepted the previous command.
|
||||||
* the previous command. No response would imply that the code
|
* No response would imply that the code is non-operative.
|
||||||
* is non-operative
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
static int wait_for_valid(u32 base)
|
static int wait_for_valid(u32 base)
|
||||||
{
|
{
|
||||||
u32 reg32;
|
u32 reg32;
|
||||||
|
|
||||||
/* Send the verb to the codec */
|
/* Send the verb to the codec. */
|
||||||
reg32 = read32(base + 0x68);
|
reg32 = read32(base + 0x68);
|
||||||
reg32 |= (1 << 0) | (1 << 1);
|
reg32 |= (1 << 0) | (1 << 1);
|
||||||
write32(base + 0x68, reg32);
|
write32(base + 0x68, reg32);
|
||||||
|
|
||||||
/* Use a 50 usec timeout - the Linux kernel uses the
|
/* Use a 50 usec timeout - the Linux kernel uses the same duration. */
|
||||||
* same duration */
|
|
||||||
|
|
||||||
int timeout = 50;
|
int timeout = 50;
|
||||||
while (timeout--) {
|
while (timeout--) {
|
||||||
reg32 = read32(base + HDA_ICII_REG);
|
reg32 = read32(base + HDA_ICII_REG);
|
||||||
|
@ -163,9 +154,8 @@ static int wait_for_valid(u32 base)
|
||||||
|
|
||||||
static void codec_init(struct device *dev, u32 base, int addr)
|
static void codec_init(struct device *dev, u32 base, int addr)
|
||||||
{
|
{
|
||||||
u32 reg32;
|
u32 reg32, verb_size;
|
||||||
u32 *verb;
|
u32 *verb;
|
||||||
u32 verb_size;
|
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
printk(BIOS_DEBUG, "Azalia: Initializing codec #%d\n", addr);
|
printk(BIOS_DEBUG, "Azalia: Initializing codec #%d\n", addr);
|
||||||
|
@ -216,44 +206,44 @@ static void codecs_init(struct device *dev, u32 base, u32 codec_mask)
|
||||||
|
|
||||||
static void azalia_init(struct device *dev)
|
static void azalia_init(struct device *dev)
|
||||||
{
|
{
|
||||||
u32 base;
|
u32 base, codec_mask, reg32;
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
u32 codec_mask;
|
|
||||||
u8 reg8;
|
u8 reg8;
|
||||||
u32 reg32;
|
|
||||||
|
|
||||||
/* Set Bus Master */
|
/* Set bus master. */
|
||||||
reg32 = pci_read_config32(dev, PCI_COMMAND);
|
reg32 = pci_read_config32(dev, PCI_COMMAND);
|
||||||
pci_write_config32(dev, PCI_COMMAND, reg32 | PCI_COMMAND_MASTER);
|
pci_write_config32(dev, PCI_COMMAND, reg32 | PCI_COMMAND_MASTER);
|
||||||
|
|
||||||
pci_write_config8(dev, 0x3c, 0x0a); // unused?
|
pci_write_config8(dev, 0x3c, 0x0a); // TODO: Unused?
|
||||||
|
|
||||||
reg8 = pci_read_config8(dev, 0x40);
|
reg8 = pci_read_config8(dev, 0x40);
|
||||||
reg8 |= (1 << 3); // Clear Clock Detect Bit
|
reg8 |= (1 << 3); /* Clear Clock Detect bit. */
|
||||||
pci_write_config8(dev, 0x40, reg8);
|
pci_write_config8(dev, 0x40, reg8);
|
||||||
reg8 &= ~(1 << 3); // Keep CLKDETCLR from clearing the bit over and over
|
reg8 &= ~(1 << 3); /* Keep CLKDETCLR from clearing the bit over and over. */
|
||||||
pci_write_config8(dev, 0x40, reg8);
|
pci_write_config8(dev, 0x40, reg8);
|
||||||
reg8 |= (1 << 2); // Enable clock detection
|
reg8 |= (1 << 2); /* Enable clock detection. */
|
||||||
pci_write_config8(dev, 0x40, reg8);
|
pci_write_config8(dev, 0x40, reg8);
|
||||||
mdelay(1);
|
mdelay(1);
|
||||||
reg8 = pci_read_config8(dev, 0x40);
|
reg8 = pci_read_config8(dev, 0x40);
|
||||||
printk(BIOS_DEBUG, "Azalia: codec type: %s\n", (reg8 & (1 << 1))?"Azalia":"AC97");
|
printk(BIOS_DEBUG, "Azalia: codec type: %s\n",
|
||||||
|
(reg8 & (1 << 1)) ? "Azalia" : "AC97");
|
||||||
|
|
||||||
//
|
reg8 = pci_read_config8(dev, 0x40); /* Audio control */
|
||||||
reg8 = pci_read_config8(dev, 0x40); // Audio Control
|
reg8 |= 1; /* Select Azalia mode. TODO: Control via devicetree.cb. */
|
||||||
reg8 |= 1; // Select Azalia mode. This needs to be controlled via devicetree.cb
|
|
||||||
pci_write_config8(dev, 0x40, reg8);
|
pci_write_config8(dev, 0x40, reg8);
|
||||||
|
|
||||||
reg8 = pci_read_config8(dev, 0x4d); // Docking Status
|
reg8 = pci_read_config8(dev, 0x4d); /* Docking status. */
|
||||||
reg8 &= ~(1 << 7); // Docking not supported
|
reg8 &= ~(1 << 7); /* Docking not supported. */
|
||||||
pci_write_config8(dev, 0x4d, reg8);
|
pci_write_config8(dev, 0x4d, reg8);
|
||||||
|
|
||||||
res = find_resource(dev, 0x10);
|
res = find_resource(dev, 0x10);
|
||||||
if (!res)
|
if (!res)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
// NOTE this will break as soon as the Azalia get's a bar above
|
/*
|
||||||
// 4G. Is there anything we can do about it?
|
* NOTE: This will break as soon as the Azalia gets a BAR above
|
||||||
|
* 4G. Is there anything we can do about it?
|
||||||
|
*/
|
||||||
base = (u32)res->base;
|
base = (u32)res->base;
|
||||||
printk(BIOS_DEBUG, "Azalia: base = %08x\n", (u32)base);
|
printk(BIOS_DEBUG, "Azalia: base = %08x\n", (u32)base);
|
||||||
codec_mask = codec_detect(base);
|
codec_mask = codec_detect(base);
|
||||||
|
@ -294,4 +284,3 @@ static const struct pci_driver azalia __pci_driver = {
|
||||||
.vendor = PCI_VENDOR_ID_NVIDIA,
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
||||||
.device = PCI_DEVICE_ID_NVIDIA_MCP55_AZA,
|
.device = PCI_DEVICE_ID_NVIDIA_MCP55_AZA,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
|
@ -28,28 +28,28 @@
|
||||||
|
|
||||||
static void mcp55_enable_rom(void)
|
static void mcp55_enable_rom(void)
|
||||||
{
|
{
|
||||||
uint8_t byte;
|
u8 byte;
|
||||||
uint16_t word;
|
u16 word;
|
||||||
device_t addr;
|
device_t addr;
|
||||||
|
|
||||||
/* Enable 4MB rom access at 0xFFC00000 - 0xFFFFFFFF */
|
/* Enable 4MB ROM access at 0xFFC00000 - 0xFFFFFFFF. */
|
||||||
#if 0
|
#if 0
|
||||||
/* default MCP55 LPC single */
|
/* Default MCP55 LPC single */
|
||||||
addr = pci_locate_device(PCI_ID(0x10de, 0x0367), 0);
|
addr = pci_locate_device(PCI_ID(0x10de, 0x0367), 0);
|
||||||
#else
|
#else
|
||||||
// addr = pci_locate_device(PCI_ID(0x10de, 0x0360), 0);
|
// addr = pci_locate_device(PCI_ID(0x10de, 0x0360), 0);
|
||||||
addr = PCI_DEV(0, (MCP55_DEVN_BASE + 1), 0);
|
addr = PCI_DEV(0, (MCP55_DEVN_BASE + 1), 0);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/* Set the 4MB enable bit bit */
|
/* Set the 15MB enable bits. */
|
||||||
byte = pci_read_config8(addr, 0x88);
|
byte = pci_read_config8(addr, 0x88);
|
||||||
byte |= 0xff; //256K
|
byte |= 0xff; /* 256K */
|
||||||
pci_write_config8(addr, 0x88, byte);
|
pci_write_config8(addr, 0x88, byte);
|
||||||
byte = pci_read_config8(addr, 0x8c);
|
byte = pci_read_config8(addr, 0x8c);
|
||||||
byte |= 0xff; //1M
|
byte |= 0xff; /* 1M */
|
||||||
pci_write_config8(addr, 0x8c, byte);
|
pci_write_config8(addr, 0x8c, byte);
|
||||||
word = pci_read_config16(addr, 0x90);
|
word = pci_read_config16(addr, 0x90);
|
||||||
word |= 0x7fff; //15M
|
word |= 0x7fff; /* 15M */
|
||||||
pci_write_config16(addr, 0x90, word);
|
pci_write_config16(addr, 0x90, word);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -19,8 +19,8 @@
|
||||||
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef MCP55_CHIP_H
|
#ifndef SOUTHBRIDGE_NVIDIA_MCP55_CHIP_H
|
||||||
#define MCP55_CHIP_H
|
#define SOUTHBRIDGE_NVIDIA_MCP55_CHIP_H
|
||||||
|
|
||||||
#include <device/device.h>
|
#include <device/device.h>
|
||||||
|
|
||||||
|
@ -36,4 +36,4 @@ struct southbridge_nvidia_mcp55_config
|
||||||
struct chip_operations;
|
struct chip_operations;
|
||||||
extern struct chip_operations southbridge_nvidia_mcp55_ops;
|
extern struct chip_operations southbridge_nvidia_mcp55_ops;
|
||||||
|
|
||||||
#endif /* MCP55_CHIP_H */
|
#endif
|
||||||
|
|
|
@ -26,14 +26,11 @@ static unsigned get_sbdn(unsigned bus)
|
||||||
{
|
{
|
||||||
device_t dev;
|
device_t dev;
|
||||||
|
|
||||||
/* Find the device.
|
/* Find the device. */
|
||||||
*/
|
dev = pci_locate_device_on_bus(PCI_ID(PCI_VENDOR_ID_NVIDIA,
|
||||||
dev = pci_locate_device_on_bus(
|
PCI_DEVICE_ID_NVIDIA_MCP55_HT), bus);
|
||||||
PCI_ID(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_MCP55_HT),
|
|
||||||
bus);
|
|
||||||
|
|
||||||
return (dev >> 15) & 0x1f;
|
return (dev >> 15) & 0x1f;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void soft_reset(void)
|
void soft_reset(void)
|
||||||
|
@ -55,7 +52,6 @@ void hard_reset(void)
|
||||||
|
|
||||||
void enable_fid_change_on_sb(unsigned sbbusn, unsigned sbdn)
|
void enable_fid_change_on_sb(unsigned sbbusn, unsigned sbdn)
|
||||||
{
|
{
|
||||||
/* default value for mcp55 is good */
|
/* The default value for MCP55 is good. */
|
||||||
/* set VFSMAF ( VID/FID System Management Action Field) to 2 */
|
/* Set VFSMAF (VID/FID System Management Action Field) to 2. */
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -19,29 +19,28 @@
|
||||||
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
|
||||||
#ifdef UNUSED_CODE
|
#ifdef UNUSED_CODE
|
||||||
int set_ht_link_buffer_counts_chain(uint8_t ht_c_num, unsigned vendorid, unsigned val);
|
int set_ht_link_buffer_counts_chain(u8 ht_c_num, unsigned vendorid, unsigned val);
|
||||||
|
|
||||||
static int set_ht_link_mcp55(uint8_t ht_c_num)
|
static int set_ht_link_mcp55(u8 ht_c_num)
|
||||||
{
|
{
|
||||||
unsigned vendorid = 0x10de;
|
unsigned vendorid = 0x10de;
|
||||||
unsigned val = 0x01610109;
|
unsigned val = 0x01610109;
|
||||||
/* Nvidia mcp55 hardcode, hw can not set it automatically */
|
/* NVIDIA MCP55 hardcode, hardware can not set it automatically. */
|
||||||
return set_ht_link_buffer_counts_chain(ht_c_num, vendorid, val);
|
return set_ht_link_buffer_counts_chain(ht_c_num, vendorid, val);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void setup_ss_table(unsigned index, unsigned where, unsigned control, const unsigned int *register_values, int max)
|
static void setup_ss_table(unsigned index, unsigned where, unsigned control,
|
||||||
|
const unsigned int *register_values, int max)
|
||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
unsigned val;
|
unsigned val;
|
||||||
|
|
||||||
val = inl(control);
|
val = inl(control);
|
||||||
val &= 0xfffffffe;
|
val &= 0xfffffffe;
|
||||||
outl(val, control);
|
outl(val, control);
|
||||||
|
|
||||||
outl(0, index); //index
|
outl(0, index); /* Index */
|
||||||
for (i = 0; i < max; i++) {
|
for (i = 0; i < max; i++) {
|
||||||
unsigned long reg;
|
unsigned long reg;
|
||||||
reg = register_values[i];
|
reg = register_values[i];
|
||||||
|
@ -51,7 +50,6 @@ static void setup_ss_table(unsigned index, unsigned where, unsigned control, con
|
||||||
val = inl(control);
|
val = inl(control);
|
||||||
val |= 1;
|
val |= 1;
|
||||||
outl(val, control);
|
outl(val, control);
|
||||||
|
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
@ -68,17 +66,18 @@ static void setup_ss_table(unsigned index, unsigned where, unsigned control, con
|
||||||
#define ACPICTRL_REG_POS 0x60
|
#define ACPICTRL_REG_POS 0x60
|
||||||
|
|
||||||
/*
|
/*
|
||||||
16 1 1 1 1 8 :0
|
* 16 1 1 1 1 8 :0
|
||||||
16 0 4 0 0 8 :1
|
* 16 0 4 0 0 8 :1
|
||||||
16 0 4 2 2 4 :2
|
* 16 0 4 2 2 4 :2
|
||||||
4 4 4 4 4 8 :3
|
* 4 4 4 4 4 8 :3
|
||||||
8 8 4 0 0 8 :4
|
* 8 8 4 0 0 8 :4
|
||||||
8 0 4 4 4 8 :5
|
* 8 0 4 4 4 8 :5
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#define MCP55_CHIP_REV 3
|
#define MCP55_CHIP_REV 3
|
||||||
|
|
||||||
static void mcp55_early_set_port(unsigned mcp55_num, unsigned *busn, unsigned *devn, unsigned *io_base)
|
static void mcp55_early_set_port(unsigned mcp55_num, unsigned *busn,
|
||||||
|
unsigned *devn, unsigned *io_base)
|
||||||
{
|
{
|
||||||
|
|
||||||
static const unsigned int ctrl_devport_conf[] = {
|
static const unsigned int ctrl_devport_conf[] = {
|
||||||
|
@ -95,9 +94,9 @@ static void mcp55_early_set_port(unsigned mcp55_num, unsigned *busn, unsigned *d
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static void mcp55_early_clear_port(unsigned mcp55_num, unsigned *busn, unsigned *devn, unsigned *io_base)
|
static void mcp55_early_clear_port(unsigned mcp55_num, unsigned *busn,
|
||||||
|
unsigned *devn, unsigned *io_base)
|
||||||
{
|
{
|
||||||
|
|
||||||
static const unsigned int ctrl_devport_conf_clear[] = {
|
static const unsigned int ctrl_devport_conf_clear[] = {
|
||||||
PCI_ADDR(0, 1, 1, ANACTRL_REG_POS), ~(0x0000ff00), 0,
|
PCI_ADDR(0, 1, 1, ANACTRL_REG_POS), ~(0x0000ff00), 0,
|
||||||
PCI_ADDR(0, 1, 1, SYSCTRL_REG_POS), ~(0x0000ff00), 0,
|
PCI_ADDR(0, 1, 1, SYSCTRL_REG_POS), ~(0x0000ff00), 0,
|
||||||
|
@ -110,20 +109,19 @@ static void mcp55_early_clear_port(unsigned mcp55_num, unsigned *busn, unsigned
|
||||||
ARRAY_SIZE(ctrl_devport_conf_clear),
|
ARRAY_SIZE(ctrl_devport_conf_clear),
|
||||||
PCI_DEV(busn[j], devn[j], 0) , io_base[j]);
|
PCI_DEV(busn[j], devn[j], 0) , io_base[j]);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void mcp55_early_pcie_setup(unsigned busnx, unsigned devnx, unsigned anactrl_io_base, unsigned pci_e_x)
|
static void mcp55_early_pcie_setup(unsigned busnx, unsigned devnx,
|
||||||
|
unsigned anactrl_io_base, unsigned pci_e_x)
|
||||||
{
|
{
|
||||||
uint32_t tgio_ctrl;
|
u32 tgio_ctrl, pll_ctrl, dword;
|
||||||
uint32_t pll_ctrl;
|
|
||||||
uint32_t dword;
|
|
||||||
int i;
|
int i;
|
||||||
device_t dev;
|
device_t dev;
|
||||||
|
|
||||||
dev = PCI_DEV(busnx, devnx + 1, 1);
|
dev = PCI_DEV(busnx, devnx + 1, 1);
|
||||||
|
|
||||||
dword = pci_read_config32(dev, 0xe4);
|
dword = pci_read_config32(dev, 0xe4);
|
||||||
dword |= 0x3f0; // disable it at first
|
dword |= 0x3f0; /* Disable it at first. */
|
||||||
pci_write_config32(dev, 0xe4, dword);
|
pci_write_config32(dev, 0xe4, dword);
|
||||||
|
|
||||||
for (i = 0; i < 3; i++) {
|
for (i = 0; i < 3; i++) {
|
||||||
|
@ -143,20 +141,19 @@ static void mcp55_early_pcie_setup(unsigned busnx, unsigned devnx, unsigned anac
|
||||||
tgio_ctrl |= (pci_e_x << 4) | (1 << 8);
|
tgio_ctrl |= (pci_e_x << 4) | (1 << 8);
|
||||||
outl(tgio_ctrl, anactrl_io_base + 0xcc);
|
outl(tgio_ctrl, anactrl_io_base + 0xcc);
|
||||||
|
|
||||||
// wait 100us
|
udelay(100); /* Wait 100us. */
|
||||||
udelay(100);
|
|
||||||
|
|
||||||
dword = pci_read_config32(dev, 0xe4);
|
dword = pci_read_config32(dev, 0xe4);
|
||||||
dword &= ~(0x3f0); // enable
|
dword &= ~(0x3f0); /* Enable. */
|
||||||
pci_write_config32(dev, 0xe4, dword);
|
pci_write_config32(dev, 0xe4, dword);
|
||||||
|
|
||||||
// need to wait 100ms
|
mdelay(100); /* Need to wait 100ms. */
|
||||||
mdelay(100);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void mcp55_early_setup(unsigned mcp55_num, unsigned *busn, unsigned *devn, unsigned *io_base, unsigned *pci_e_x)
|
static void mcp55_early_setup(unsigned mcp55_num, unsigned *busn,
|
||||||
|
unsigned *devn, unsigned *io_base,
|
||||||
|
unsigned *pci_e_x)
|
||||||
{
|
{
|
||||||
|
|
||||||
static const unsigned int ctrl_conf_1[] = {
|
static const unsigned int ctrl_conf_1[] = {
|
||||||
RES_PORT_IO_32, ACPICTRL_IO_BASE + 0x10, 0x0007ffff, 0xff78000,
|
RES_PORT_IO_32, ACPICTRL_IO_BASE + 0x10, 0x0007ffff, 0xff78000,
|
||||||
RES_PORT_IO_32, ACPICTRL_IO_BASE + 0xa4, 0xffedffff, 0x0012000,
|
RES_PORT_IO_32, ACPICTRL_IO_BASE + 0xa4, 0xffedffff, 0x0012000,
|
||||||
|
@ -199,11 +196,11 @@ static void mcp55_early_setup(unsigned mcp55_num, unsigned *busn, unsigned *devn
|
||||||
|
|
||||||
RES_PCI_IO, PCI_ADDR(0, 8, 0, 0x40), 0x00000000, 0xCB8410DE,
|
RES_PCI_IO, PCI_ADDR(0, 8, 0, 0x40), 0x00000000, 0xCB8410DE,
|
||||||
RES_PCI_IO, PCI_ADDR(0, 8, 0, 0x68), 0xFFFFFF00, 0x000000FF,
|
RES_PCI_IO, PCI_ADDR(0, 8, 0, 0x68), 0xFFFFFF00, 0x000000FF,
|
||||||
RES_PCI_IO, PCI_ADDR(0, 8, 0, 0xF8), 0xFFFFFFBF, 0x00000040,//Enable bridge mode
|
RES_PCI_IO, PCI_ADDR(0, 8, 0, 0xF8), 0xFFFFFFBF, 0x00000040, /* Enable bridge mode. */
|
||||||
|
|
||||||
RES_PCI_IO, PCI_ADDR(0, 9, 0, 0x40), 0x00000000, 0xCB8410DE,
|
RES_PCI_IO, PCI_ADDR(0, 9, 0, 0x40), 0x00000000, 0xCB8410DE,
|
||||||
RES_PCI_IO, PCI_ADDR(0, 9, 0, 0x68), 0xFFFFFF00, 0x000000FF,
|
RES_PCI_IO, PCI_ADDR(0, 9, 0, 0x68), 0xFFFFFF00, 0x000000FF,
|
||||||
RES_PCI_IO, PCI_ADDR(0, 9, 0, 0xF8), 0xFFFFFFBF, 0x00000040,//Enable bridge mode
|
RES_PCI_IO, PCI_ADDR(0, 9, 0, 0xF8), 0xFFFFFFBF, 0x00000040, /* Enable bridge mode. */
|
||||||
};
|
};
|
||||||
|
|
||||||
static const unsigned int ctrl_conf_1_1[] = {
|
static const unsigned int ctrl_conf_1_1[] = {
|
||||||
|
@ -218,7 +215,6 @@ static void mcp55_early_setup(unsigned mcp55_num, unsigned *busn, unsigned *devn
|
||||||
RES_PCI_IO, PCI_ADDR(0, 5, 0, 0xE0), 0xF0FFFFFF, 0x03000000,
|
RES_PCI_IO, PCI_ADDR(0, 5, 0, 0xE0), 0xF0FFFFFF, 0x03000000,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
static const unsigned int ctrl_conf_mcp55_only[] = {
|
static const unsigned int ctrl_conf_mcp55_only[] = {
|
||||||
RES_PCI_IO, PCI_ADDR(0, 1, 1, 0x40), 0x00000000, 0xCB8410DE,
|
RES_PCI_IO, PCI_ADDR(0, 1, 1, 0x40), 0x00000000, 0xCB8410DE,
|
||||||
RES_PCI_IO, PCI_ADDR(0, 1, 1, 0xE0), 0xFFFFFEFF, 0x00000000,
|
RES_PCI_IO, PCI_ADDR(0, 1, 1, 0xE0), 0xFFFFFEFF, 0x00000000,
|
||||||
|
@ -251,10 +247,11 @@ static void mcp55_early_setup(unsigned mcp55_num, unsigned *busn, unsigned *devn
|
||||||
#if CONFIG_MCP55_USE_AZA
|
#if CONFIG_MCP55_USE_AZA
|
||||||
RES_PCI_IO, PCI_ADDR(0, 6, 1, 0x40), 0x00000000, 0xCB8410DE,
|
RES_PCI_IO, PCI_ADDR(0, 6, 1, 0x40), 0x00000000, 0xCB8410DE,
|
||||||
|
|
||||||
// RES_PCI_IO, PCI_ADDR(0, 1, 1, 0xE4), ~(1<<14), 1<<14,
|
// RES_PCI_IO, PCI_ADDR(0, 1, 1, 0xE4), ~(1 << 14), (1 << 14),
|
||||||
#endif
|
#endif
|
||||||
// play a while with GPIO in MCP55
|
|
||||||
#ifdef MCP55_MB_SETUP
|
#ifdef MCP55_MB_SETUP
|
||||||
|
/* Play a while with GPIO in MCP55. */
|
||||||
MCP55_MB_SETUP
|
MCP55_MB_SETUP
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
@ -263,21 +260,17 @@ static void mcp55_early_setup(unsigned mcp55_num, unsigned *busn, unsigned *devn
|
||||||
RES_PORT_IO_8, SYSCTRL_IO_BASE + 0xc0+ 22, ~(3 << 2), (2 << 2),
|
RES_PORT_IO_8, SYSCTRL_IO_BASE + 0xc0+ 22, ~(3 << 2), (2 << 2),
|
||||||
RES_PORT_IO_8, SYSCTRL_IO_BASE + 0xc0+ 46, ~(3 << 2), (2 << 2),
|
RES_PORT_IO_8, SYSCTRL_IO_BASE + 0xc0+ 46, ~(3 << 2), (2 << 2),
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
static const unsigned int ctrl_conf_master_only[] = {
|
static const unsigned int ctrl_conf_master_only[] = {
|
||||||
|
|
||||||
RES_PORT_IO_32, ACPICTRL_IO_BASE + 0x80, 0xEFFFFFF, 0x01000000,
|
RES_PORT_IO_32, ACPICTRL_IO_BASE + 0x80, 0xEFFFFFF, 0x01000000,
|
||||||
|
|
||||||
//Master MCP55 ????YHLU
|
/* Master MCP55???? YHLU */
|
||||||
RES_PORT_IO_8, SYSCTRL_IO_BASE + 0xc0+ 0, ~(3 << 2), (0 << 2),
|
RES_PORT_IO_8, SYSCTRL_IO_BASE + 0xc0+ 0, ~(3 << 2), (0 << 2),
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
static const unsigned int ctrl_conf_2[] = {
|
static const unsigned int ctrl_conf_2[] = {
|
||||||
/* I didn't put pcie related stuff here */
|
/* I didn't put PCI-E related stuff here. */
|
||||||
|
|
||||||
RES_PCI_IO, PCI_ADDR(0, 0, 0, 0x74), 0xFFFFF00F, 0x000009D0,
|
RES_PCI_IO, PCI_ADDR(0, 0, 0, 0x74), 0xFFFFF00F, 0x000009D0,
|
||||||
RES_PCI_IO, PCI_ADDR(0, 1, 0, 0x74), 0xFFFF7FFF, 0x00008000,
|
RES_PCI_IO, PCI_ADDR(0, 1, 0, 0x74), 0xFFFF7FFF, 0x00008000,
|
||||||
|
@ -286,41 +279,45 @@ static void mcp55_early_setup(unsigned mcp55_num, unsigned *busn, unsigned *devn
|
||||||
|
|
||||||
RES_PORT_IO_32, ANACTRL_IO_BASE + 0x60, 0xFFFFFF00, 0x00000012,
|
RES_PORT_IO_32, ANACTRL_IO_BASE + 0x60, 0xFFFFFF00, 0x00000012,
|
||||||
|
|
||||||
|
|
||||||
#if CONFIG_MCP55_USE_NIC
|
#if CONFIG_MCP55_USE_NIC
|
||||||
RES_PCI_IO, PCI_ADDR(0, 1, 1, 0xe4), ~((1 << 22) | (1 << 20)), (1 << 22) | (1 << 20),
|
RES_PCI_IO, PCI_ADDR(0, 1, 1, 0xe4), ~((1 << 22) | (1 << 20)), (1 << 22) | (1 << 20),
|
||||||
|
|
||||||
RES_PORT_IO_8, SYSCTRL_IO_BASE + 0xc0+ 4, ~(0xff), ((0 << 4) | (1 << 2) | (0 << 0)),
|
RES_PORT_IO_8, SYSCTRL_IO_BASE + 0xc0+ 4, ~(0xff), ((0 << 4) | (1 << 2) | (0 << 0)),
|
||||||
RES_PORT_IO_8, SYSCTRL_IO_BASE + 0xc0+ 4, ~(0xff), ((0 << 4) | (1 << 2) | (1 << 0)),
|
RES_PORT_IO_8, SYSCTRL_IO_BASE + 0xc0+ 4, ~(0xff), ((0 << 4) | (1 << 2) | (1 << 0)),
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
int j, i;
|
int j, i;
|
||||||
|
|
||||||
for (j = 0; j < mcp55_num; j++) {
|
for (j = 0; j < mcp55_num; j++) {
|
||||||
mcp55_early_pcie_setup(busn[j], devn[j], io_base[j] + ANACTRL_IO_BASE, pci_e_x[j]);
|
mcp55_early_pcie_setup(busn[j], devn[j],
|
||||||
|
io_base[j] + ANACTRL_IO_BASE, pci_e_x[j]);
|
||||||
|
|
||||||
setup_resource_map_x_offset(ctrl_conf_1, ARRAY_SIZE(ctrl_conf_1),
|
setup_resource_map_x_offset(ctrl_conf_1,
|
||||||
|
ARRAY_SIZE(ctrl_conf_1),
|
||||||
PCI_DEV(busn[j], devn[j], 0), io_base[j]);
|
PCI_DEV(busn[j], devn[j], 0), io_base[j]);
|
||||||
for(i=0; i<3; i++) { // three SATA
|
|
||||||
setup_resource_map_x_offset(ctrl_conf_1_1, ARRAY_SIZE(ctrl_conf_1_1),
|
for (i = 0; i < 3; i++) { /* Three SATA */
|
||||||
|
setup_resource_map_x_offset(ctrl_conf_1_1,
|
||||||
|
ARRAY_SIZE(ctrl_conf_1_1),
|
||||||
PCI_DEV(busn[j], devn[j], i), io_base[j]);
|
PCI_DEV(busn[j], devn[j], i), io_base[j]);
|
||||||
}
|
}
|
||||||
|
|
||||||
if (busn[j] == 0) {
|
if (busn[j] == 0) {
|
||||||
setup_resource_map_x_offset(ctrl_conf_mcp55_only, ARRAY_SIZE(ctrl_conf_mcp55_only),
|
setup_resource_map_x_offset(ctrl_conf_mcp55_only,
|
||||||
|
ARRAY_SIZE(ctrl_conf_mcp55_only),
|
||||||
PCI_DEV(busn[j], devn[j], 0), io_base[j]);
|
PCI_DEV(busn[j], devn[j], 0), io_base[j]);
|
||||||
}
|
}
|
||||||
|
|
||||||
if ((busn[j] == 0) && (mcp55_num>1)) {
|
if ((busn[j] == 0) && (mcp55_num>1)) {
|
||||||
setup_resource_map_x_offset(ctrl_conf_master_only, ARRAY_SIZE(ctrl_conf_master_only),
|
setup_resource_map_x_offset(ctrl_conf_master_only,
|
||||||
|
ARRAY_SIZE(ctrl_conf_master_only),
|
||||||
PCI_DEV(busn[j], devn[j], 0), io_base[j]);
|
PCI_DEV(busn[j], devn[j], 0), io_base[j]);
|
||||||
}
|
}
|
||||||
|
|
||||||
setup_resource_map_x_offset(ctrl_conf_2, ARRAY_SIZE(ctrl_conf_2),
|
setup_resource_map_x_offset(ctrl_conf_2,
|
||||||
|
ARRAY_SIZE(ctrl_conf_2),
|
||||||
PCI_DEV(busn[j], devn[j], 0), io_base[j]);
|
PCI_DEV(busn[j], devn[j], 0), io_base[j]);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
#if 0
|
#if 0
|
||||||
|
@ -328,15 +325,17 @@ static void mcp55_early_setup(unsigned mcp55_num, unsigned *busn, unsigned *devn
|
||||||
// PCI-E (XSPLL) SS table 0x40, x044, 0x48
|
// PCI-E (XSPLL) SS table 0x40, x044, 0x48
|
||||||
// SATA (SPPLL) SS table 0xb0, 0xb4, 0xb8
|
// SATA (SPPLL) SS table 0xb0, 0xb4, 0xb8
|
||||||
// CPU (PPLL) SS table 0xc0, 0xc4, 0xc8
|
// CPU (PPLL) SS table 0xc0, 0xc4, 0xc8
|
||||||
setup_ss_table(io_base[j] + ANACTRL_IO_BASE+0x40, io_base[j] + ANACTRL_IO_BASE+0x44,
|
setup_ss_table(io_base[j] + ANACTRL_IO_BASE + 0x40,
|
||||||
|
io_base[j] + ANACTRL_IO_BASE + 0x44,
|
||||||
io_base[j] + ANACTRL_IO_BASE + 0x48, pcie_ss_tbl, 64);
|
io_base[j] + ANACTRL_IO_BASE + 0x48, pcie_ss_tbl, 64);
|
||||||
setup_ss_table(io_base[j] + ANACTRL_IO_BASE+0xb0, io_base[j] + ANACTRL_IO_BASE+0xb4,
|
setup_ss_table(io_base[j] + ANACTRL_IO_BASE + 0xb0,
|
||||||
|
io_base[j] + ANACTRL_IO_BASE + 0xb4,
|
||||||
io_base[j] + ANACTRL_IO_BASE + 0xb8, sata_ss_tbl, 64);
|
io_base[j] + ANACTRL_IO_BASE + 0xb8, sata_ss_tbl, 64);
|
||||||
setup_ss_table(io_base[j] + ANACTRL_IO_BASE+0xc0, io_base[j] + ANACTRL_IO_BASE+0xc4,
|
setup_ss_table(io_base[j] + ANACTRL_IO_BASE + 0xc0,
|
||||||
|
io_base[j] + ANACTRL_IO_BASE + 0xc4,
|
||||||
io_base[j] + ANACTRL_IO_BASE + 0xc8, cpu_ss_tbl, 64);
|
io_base[j] + ANACTRL_IO_BASE + 0xc8, cpu_ss_tbl, 64);
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifndef HT_CHAIN_NUM_MAX
|
#ifndef HT_CHAIN_NUM_MAX
|
||||||
|
@ -349,43 +348,53 @@ static void mcp55_early_setup(unsigned mcp55_num, unsigned *busn, unsigned *devn
|
||||||
|
|
||||||
static int mcp55_early_setup_x(void)
|
static int mcp55_early_setup_x(void)
|
||||||
{
|
{
|
||||||
/*find out how many mcp55 we have */
|
/* Find out how many MCP55 we have. */
|
||||||
unsigned busn[HT_CHAIN_NUM_MAX] = {0};
|
unsigned busn[HT_CHAIN_NUM_MAX] = {0};
|
||||||
unsigned devn[HT_CHAIN_NUM_MAX] = {0};
|
unsigned devn[HT_CHAIN_NUM_MAX] = {0};
|
||||||
unsigned io_base[HT_CHAIN_NUM_MAX] = {0};
|
unsigned io_base[HT_CHAIN_NUM_MAX] = {0};
|
||||||
/*
|
|
||||||
FIXME: May have problem if there is different MCP55 HTX card with different PCI_E lane allocation
|
|
||||||
Need to use same trick about pci1234 to verify node/link connection
|
|
||||||
*/
|
|
||||||
unsigned pci_e_x[HT_CHAIN_NUM_MAX] = {CONFIG_MCP55_PCI_E_X_0, CONFIG_MCP55_PCI_E_X_1, CONFIG_MCP55_PCI_E_X_2, CONFIG_MCP55_PCI_E_X_3 };
|
|
||||||
int mcp55_num = 0;
|
|
||||||
unsigned busnx;
|
|
||||||
unsigned devnx;
|
|
||||||
int ht_c_index;
|
|
||||||
|
|
||||||
/* FIXME: multi pci segment handling */
|
/*
|
||||||
|
* FIXME: May have problem if there is different MCP55 HTX card with
|
||||||
|
* different PCI_E lane allocation. Need to use same trick about
|
||||||
|
* pci1234 to verify node/link connection.
|
||||||
|
*/
|
||||||
|
unsigned pci_e_x[HT_CHAIN_NUM_MAX] = {
|
||||||
|
CONFIG_MCP55_PCI_E_X_0, CONFIG_MCP55_PCI_E_X_1,
|
||||||
|
CONFIG_MCP55_PCI_E_X_2, CONFIG_MCP55_PCI_E_X_3,
|
||||||
|
};
|
||||||
|
int mcp55_num = 0, ht_c_index;
|
||||||
|
unsigned busnx, devnx;
|
||||||
|
|
||||||
|
/* FIXME: Multi PCI segment handling. */
|
||||||
|
|
||||||
/* Any system that only have IO55 without MCP55? */
|
/* Any system that only have IO55 without MCP55? */
|
||||||
for (ht_c_index = 0; ht_c_index < HT_CHAIN_NUM_MAX; ht_c_index++) {
|
for (ht_c_index = 0; ht_c_index < HT_CHAIN_NUM_MAX; ht_c_index++) {
|
||||||
busnx = ht_c_index * HT_CHAIN_BUSN_D;
|
busnx = ht_c_index * HT_CHAIN_BUSN_D;
|
||||||
for (devnx = 0; devnx < 0x20; devnx++) {
|
for (devnx = 0; devnx < 0x20; devnx++) {
|
||||||
uint32_t id;
|
u32 id;
|
||||||
device_t dev;
|
device_t dev;
|
||||||
dev = PCI_DEV(busnx, devnx, 0);
|
dev = PCI_DEV(busnx, devnx, 0);
|
||||||
id = pci_read_config32(dev, PCI_VENDOR_ID);
|
id = pci_read_config32(dev, PCI_VENDOR_ID);
|
||||||
if(id == 0x036910de) {
|
if(id == 0x036910de) {
|
||||||
busn[mcp55_num] = busnx;
|
busn[mcp55_num] = busnx;
|
||||||
devn[mcp55_num] = devnx;
|
devn[mcp55_num] = devnx;
|
||||||
io_base[mcp55_num] = ht_c_index * HT_CHAIN_IOBASE_D; // we may have ht chain other than MCP55
|
|
||||||
|
/* We may have HT chain other than MCP55. */
|
||||||
|
io_base[mcp55_num]
|
||||||
|
= ht_c_index * HT_CHAIN_IOBASE_D;
|
||||||
|
|
||||||
mcp55_num++;
|
mcp55_num++;
|
||||||
if(mcp55_num == CONFIG_MCP55_NUM) goto out;
|
if (mcp55_num == CONFIG_MCP55_NUM)
|
||||||
break; // only one MCP55 on one chain
|
goto out;
|
||||||
|
break; /* Only one MCP55 on one chain. */
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
out:
|
out:
|
||||||
print_debug("mcp55_num:"); print_debug_hex8(mcp55_num); print_debug("\n");
|
print_debug("mcp55_num:");
|
||||||
|
print_debug_hex8(mcp55_num);
|
||||||
|
print_debug("\n");
|
||||||
|
|
||||||
mcp55_early_set_port(mcp55_num, busn, devn, io_base);
|
mcp55_early_set_port(mcp55_num, busn, devn, io_base);
|
||||||
mcp55_early_setup(mcp55_num, busn, devn, io_base, pci_e_x);
|
mcp55_early_setup(mcp55_num, busn, devn, io_base, pci_e_x);
|
||||||
|
@ -395,8 +404,4 @@ out:
|
||||||
// set_ht_link_mcp55(HT_CHAIN_NUM_MAX);
|
// set_ht_link_mcp55(HT_CHAIN_NUM_MAX);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
|
@ -85,6 +85,7 @@ static const unsigned int pcie_ss_tbl[] = {
|
||||||
0x0C5042040,
|
0x0C5042040,
|
||||||
0x0C5042040,
|
0x0C5042040,
|
||||||
};
|
};
|
||||||
|
|
||||||
static const unsigned int sata_ss_tbl[] = {
|
static const unsigned int sata_ss_tbl[] = {
|
||||||
0x0c9044042,
|
0x0c9044042,
|
||||||
0x0c9044042,
|
0x0c9044042,
|
||||||
|
@ -218,5 +219,3 @@ static const unsigned int cpu_ss_tbl[] = {
|
||||||
0x0C5039037,
|
0x0C5039037,
|
||||||
0x0C5039037,
|
0x0C5039037,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
|
|
|
@ -25,7 +25,7 @@
|
||||||
|
|
||||||
#define SMBUS0_IO_BASE 0x1000
|
#define SMBUS0_IO_BASE 0x1000
|
||||||
#define SMBUS1_IO_BASE (0x1000 + (1 << 8))
|
#define SMBUS1_IO_BASE (0x1000 + (1 << 8))
|
||||||
/*SIZE 0x40 */
|
/* Size: 0x40 */
|
||||||
|
|
||||||
static void enable_smbus(void)
|
static void enable_smbus(void)
|
||||||
{
|
{
|
||||||
|
@ -35,12 +35,14 @@ static void enable_smbus(void)
|
||||||
if (dev == PCI_DEV_INVALID)
|
if (dev == PCI_DEV_INVALID)
|
||||||
die("SMBus controller not found\n");
|
die("SMBus controller not found\n");
|
||||||
|
|
||||||
/* set smbus iobase */
|
/* Set SMBus I/O base. */
|
||||||
pci_write_config32(dev, 0x20, SMBUS0_IO_BASE | 1);
|
pci_write_config32(dev, 0x20, SMBUS0_IO_BASE | 1);
|
||||||
pci_write_config32(dev, 0x24, SMBUS1_IO_BASE | 1);
|
pci_write_config32(dev, 0x24, SMBUS1_IO_BASE | 1);
|
||||||
/* Set smbus iospace enable */
|
|
||||||
|
/* Set SMBus I/O space enable. */
|
||||||
pci_write_config16(dev, 0x4, 0x01);
|
pci_write_config16(dev, 0x4, 0x01);
|
||||||
/* clear any lingering errors, so the transaction will run */
|
|
||||||
|
/* Clear any lingering errors, so the transaction will run. */
|
||||||
outb(inb(SMBUS0_IO_BASE + SMBHSTSTAT), SMBUS0_IO_BASE + SMBHSTSTAT);
|
outb(inb(SMBUS0_IO_BASE + SMBHSTSTAT), SMBUS0_IO_BASE + SMBHSTSTAT);
|
||||||
outb(inb(SMBUS1_IO_BASE + SMBHSTSTAT), SMBUS1_IO_BASE + SMBHSTSTAT);
|
outb(inb(SMBUS1_IO_BASE + SMBHSTSTAT), SMBUS1_IO_BASE + SMBHSTSTAT);
|
||||||
}
|
}
|
||||||
|
@ -60,7 +62,8 @@ static inline int smbus_read_byte(unsigned device, unsigned address)
|
||||||
return do_smbus_read_byte(SMBUS0_IO_BASE, device, address);
|
return do_smbus_read_byte(SMBUS0_IO_BASE, device, address);
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline int smbus_write_byte(unsigned device, unsigned address, unsigned char val)
|
static inline int smbus_write_byte(unsigned device, unsigned address,
|
||||||
|
unsigned char val)
|
||||||
{
|
{
|
||||||
return do_smbus_write_byte(SMBUS0_IO_BASE, device, address, val);
|
return do_smbus_write_byte(SMBUS0_IO_BASE, device, address, val);
|
||||||
}
|
}
|
||||||
|
@ -70,18 +73,23 @@ static inline int smbusx_recv_byte(unsigned smb_index, unsigned device)
|
||||||
return do_smbus_recv_byte(SMBUS0_IO_BASE + (smb_index << 8), device);
|
return do_smbus_recv_byte(SMBUS0_IO_BASE + (smb_index << 8), device);
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline int smbusx_send_byte(unsigned smb_index, unsigned device, unsigned char val)
|
static inline int smbusx_send_byte(unsigned smb_index, unsigned device,
|
||||||
|
unsigned char val)
|
||||||
{
|
{
|
||||||
return do_smbus_send_byte(SMBUS0_IO_BASE + (smb_index<<8), device, val);
|
return do_smbus_send_byte(SMBUS0_IO_BASE + (smb_index << 8),
|
||||||
|
device, val);
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline int smbusx_read_byte(unsigned smb_index, unsigned device, unsigned address)
|
static inline int smbusx_read_byte(unsigned smb_index, unsigned device,
|
||||||
|
unsigned address)
|
||||||
{
|
{
|
||||||
return do_smbus_read_byte(SMBUS0_IO_BASE + (smb_index<<8), device, address);
|
return do_smbus_read_byte(SMBUS0_IO_BASE + (smb_index << 8),
|
||||||
|
device, address);
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline int smbusx_write_byte(unsigned smb_index, unsigned device, unsigned address, unsigned char val)
|
static inline int smbusx_write_byte(unsigned smb_index, unsigned device,
|
||||||
|
unsigned address, unsigned char val)
|
||||||
{
|
{
|
||||||
return do_smbus_write_byte(SMBUS0_IO_BASE + (smb_index<<8), device, address, val);
|
return do_smbus_write_byte(SMBUS0_IO_BASE + (smb_index << 8),
|
||||||
|
device, address, val);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -42,4 +42,3 @@ static const struct pci_driver ht_driver __pci_driver = {
|
||||||
.vendor = PCI_VENDOR_ID_NVIDIA,
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
||||||
.device = PCI_DEVICE_ID_NVIDIA_MCP55_HT,
|
.device = PCI_DEVICE_ID_NVIDIA_MCP55_HT,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
|
@ -31,22 +31,21 @@
|
||||||
static void ide_init(struct device *dev)
|
static void ide_init(struct device *dev)
|
||||||
{
|
{
|
||||||
struct southbridge_nvidia_mcp55_config *conf;
|
struct southbridge_nvidia_mcp55_config *conf;
|
||||||
/* Enable ide devices so the linux ide driver will work */
|
u32 dword;
|
||||||
uint32_t dword;
|
u16 word;
|
||||||
uint16_t word;
|
u8 byte;
|
||||||
uint8_t byte;
|
|
||||||
conf = dev->chip_info;
|
conf = dev->chip_info;
|
||||||
|
|
||||||
word = pci_read_config16(dev, 0x50);
|
word = pci_read_config16(dev, 0x50);
|
||||||
/* Ensure prefetch is disabled */
|
/* Ensure prefetch is disabled. */
|
||||||
word &= ~((1 << 15) | (1 << 13));
|
word &= ~((1 << 15) | (1 << 13));
|
||||||
if (conf->ide1_enable) {
|
if (conf->ide1_enable) {
|
||||||
/* Enable secondary ide interface */
|
/* Enable secondary IDE interface. */
|
||||||
word |= (1 << 0);
|
word |= (1 << 0);
|
||||||
printk(BIOS_DEBUG, "IDE1 \t");
|
printk(BIOS_DEBUG, "IDE1 \t");
|
||||||
}
|
}
|
||||||
if (conf->ide0_enable) {
|
if (conf->ide0_enable) {
|
||||||
/* Enable primary ide interface */
|
/* Enable primary IDE interface. */
|
||||||
word |= (1 << 1);
|
word |= (1 << 1);
|
||||||
printk(BIOS_DEBUG, "IDE0\n");
|
printk(BIOS_DEBUG, "IDE0\n");
|
||||||
}
|
}
|
||||||
|
@ -56,8 +55,7 @@ static void ide_init(struct device *dev)
|
||||||
|
|
||||||
pci_write_config16(dev, 0x50, word);
|
pci_write_config16(dev, 0x50, word);
|
||||||
|
|
||||||
|
byte = 0x20; /* Latency: 64-->32 */
|
||||||
byte = 0x20 ; // Latency: 64-->32
|
|
||||||
pci_write_config8(dev, 0xd, byte);
|
pci_write_config8(dev, 0xd, byte);
|
||||||
|
|
||||||
dword = pci_read_config32(dev, 0xf8);
|
dword = pci_read_config32(dev, 0xf8);
|
||||||
|
@ -66,7 +64,6 @@ static void ide_init(struct device *dev)
|
||||||
#if CONFIG_PCI_ROM_RUN == 1
|
#if CONFIG_PCI_ROM_RUN == 1
|
||||||
pci_dev_init(dev);
|
pci_dev_init(dev);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct device_operations ide_ops = {
|
static struct device_operations ide_ops = {
|
||||||
|
@ -84,4 +81,3 @@ static const struct pci_driver ide_driver __pci_driver = {
|
||||||
.vendor = PCI_VENDOR_ID_NVIDIA,
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
||||||
.device = PCI_DEVICE_ID_NVIDIA_MCP55_IDE,
|
.device = PCI_DEVICE_ID_NVIDIA_MCP55_IDE,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
|
@ -54,14 +54,14 @@
|
||||||
|
|
||||||
static void lpc_common_init(device_t dev, int master)
|
static void lpc_common_init(device_t dev, int master)
|
||||||
{
|
{
|
||||||
uint8_t byte;
|
u8 byte;
|
||||||
uint32_t ioapic_base;
|
u32 ioapic_base;
|
||||||
|
|
||||||
/* IO APIC initialization */
|
/* IOAPIC initialization. */
|
||||||
byte = pci_read_config8(dev, 0x74);
|
byte = pci_read_config8(dev, 0x74);
|
||||||
byte |= (1<<0); // enable APIC
|
byte |= (1 << 0); /* Enable IOAPIC. */
|
||||||
pci_write_config8(dev, 0x74, byte);
|
pci_write_config8(dev, 0x74, byte);
|
||||||
ioapic_base = pci_read_config32(dev, PCI_BASE_ADDRESS_1); // 0x14
|
ioapic_base = pci_read_config32(dev, PCI_BASE_ADDRESS_1); /* 0x14 */
|
||||||
|
|
||||||
if (master)
|
if (master)
|
||||||
setup_ioapic(ioapic_base, 0);
|
setup_ioapic(ioapic_base, 0);
|
||||||
|
@ -85,15 +85,13 @@ static void enable_hpet(struct device *dev)
|
||||||
|
|
||||||
static void lpc_init(device_t dev)
|
static void lpc_init(device_t dev)
|
||||||
{
|
{
|
||||||
uint8_t byte;
|
u8 byte, byte_old;
|
||||||
uint8_t byte_old;
|
int on, nmi_option;
|
||||||
int on;
|
|
||||||
int nmi_option;
|
|
||||||
|
|
||||||
lpc_common_init(dev, 1);
|
lpc_common_init(dev, 1);
|
||||||
|
|
||||||
#if 0
|
#if 0
|
||||||
/* posted memory write enable */
|
/* Posted memory write enable. */
|
||||||
byte = pci_read_config8(dev, 0x46);
|
byte = pci_read_config8(dev, 0x46);
|
||||||
pci_write_config8(dev, 0x46, byte | (1 << 0));
|
pci_write_config8(dev, 0x46, byte | (1 << 0));
|
||||||
#endif
|
#endif
|
||||||
|
@ -104,18 +102,17 @@ static void lpc_init(device_t dev)
|
||||||
get_option(&on, "power_on_after_fail");
|
get_option(&on, "power_on_after_fail");
|
||||||
byte = pci_read_config8(dev, PREVIOUS_POWER_STATE);
|
byte = pci_read_config8(dev, PREVIOUS_POWER_STATE);
|
||||||
byte &= ~0x40;
|
byte &= ~0x40;
|
||||||
if (!on) {
|
if (!on)
|
||||||
byte |= 0x40;
|
byte |= 0x40;
|
||||||
}
|
|
||||||
pci_write_config8(dev, PREVIOUS_POWER_STATE, byte);
|
pci_write_config8(dev, PREVIOUS_POWER_STATE, byte);
|
||||||
printk(BIOS_INFO, "set power %s after power fail\n", on ? "on" : "off");
|
printk(BIOS_INFO, "set power %s after power fail\n", on ? "on" : "off");
|
||||||
#endif
|
#endif
|
||||||
/* Throttle the CPU speed down for testing */
|
/* Throttle the CPU speed down for testing. */
|
||||||
on = SLOW_CPU_OFF;
|
on = SLOW_CPU_OFF;
|
||||||
get_option(&on, "slow_cpu");
|
get_option(&on, "slow_cpu");
|
||||||
if (on) {
|
if (on) {
|
||||||
uint16_t pm10_bar;
|
u16 pm10_bar;
|
||||||
uint32_t dword;
|
u32 dword;
|
||||||
pm10_bar = (pci_read_config16(dev, 0x60) & 0xff00);
|
pm10_bar = (pci_read_config16(dev, 0x60) & 0xff00);
|
||||||
outl(((on << 1) + 0x10), (pm10_bar + 0x10));
|
outl(((on << 1) + 0x10), (pm10_bar + 0x10));
|
||||||
dword = inl(pm10_bar + 0x10);
|
dword = inl(pm10_bar + 0x10);
|
||||||
|
@ -125,42 +122,38 @@ static void lpc_init(device_t dev)
|
||||||
}
|
}
|
||||||
|
|
||||||
#if 0
|
#if 0
|
||||||
// default is enabled
|
/* Enable Port 92 fast reset (default is enabled). */
|
||||||
/* Enable Port 92 fast reset */
|
|
||||||
byte = pci_read_config8(dev, 0xe8);
|
byte = pci_read_config8(dev, 0xe8);
|
||||||
byte |= ~(1 << 3);
|
byte |= ~(1 << 3);
|
||||||
pci_write_config8(dev, 0xe8, byte);
|
pci_write_config8(dev, 0xe8, byte);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/* Enable Error reporting */
|
/* Enable error reporting. */
|
||||||
/* Set up sync flood detected */
|
/* Set up sync flood detected. */
|
||||||
byte = pci_read_config8(dev, 0x47);
|
byte = pci_read_config8(dev, 0x47);
|
||||||
byte |= (1 << 1);
|
byte |= (1 << 1);
|
||||||
pci_write_config8(dev, 0x47, byte);
|
pci_write_config8(dev, 0x47, byte);
|
||||||
|
|
||||||
/* Set up NMI on errors */
|
/* Set up NMI on errors. */
|
||||||
byte = inb(0x70); // RTC70
|
byte = inb(0x70); /* RTC70 */
|
||||||
byte_old = byte;
|
byte_old = byte;
|
||||||
nmi_option = NMI_OFF;
|
nmi_option = NMI_OFF;
|
||||||
get_option(&nmi_option, "nmi");
|
get_option(&nmi_option, "nmi");
|
||||||
if (nmi_option) {
|
if (nmi_option)
|
||||||
byte &= ~(1 << 7); /* set NMI */
|
byte &= ~(1 << 7); /* Set NMI. */
|
||||||
} else {
|
else
|
||||||
byte |= ( 1 << 7); // Can not mask NMI from PCI-E and NMI_NOW
|
byte |= ( 1 << 7); /* Can't mask NMI from PCI-E and NMI_NOW. */
|
||||||
}
|
if (byte != byte_old)
|
||||||
if( byte != byte_old) {
|
|
||||||
outb(byte, 0x70);
|
outb(byte, 0x70);
|
||||||
}
|
|
||||||
|
|
||||||
/* Initialize the real time clock */
|
/* Initialize the real time clock. */
|
||||||
rtc_init(0);
|
rtc_init(0);
|
||||||
|
|
||||||
/* Initialize isa dma */
|
/* Initialize ISA DMA. */
|
||||||
isa_dma_init();
|
isa_dma_init();
|
||||||
|
|
||||||
/* Initialize the High Precision Event Timers */
|
/* Initialize the High Precision Event Timers (HPET). */
|
||||||
enable_hpet(dev);
|
enable_hpet(dev);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void mcp55_lpc_read_resources(device_t dev)
|
static void mcp55_lpc_read_resources(device_t dev)
|
||||||
|
@ -191,16 +184,14 @@ static void mcp55_lpc_read_resources(device_t dev)
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Enable resources for children devices
|
* Enable resources for children devices.
|
||||||
*
|
|
||||||
* @param dev the device whos children's resources are to be enabled
|
|
||||||
*
|
*
|
||||||
|
* @param dev The device whose children's resources are to be enabled.
|
||||||
*/
|
*/
|
||||||
static void mcp55_lpc_enable_childrens_resources(device_t dev)
|
static void mcp55_lpc_enable_childrens_resources(device_t dev)
|
||||||
{
|
{
|
||||||
uint32_t reg, reg_var[4];
|
u32 reg, reg_var[4];
|
||||||
int i;
|
int i, var_num = 0;
|
||||||
int var_num = 0;
|
|
||||||
struct bus *link;
|
struct bus *link;
|
||||||
|
|
||||||
reg = pci_read_config32(dev, 0xa0);
|
reg = pci_read_config32(dev, 0xa0);
|
||||||
|
@ -211,27 +202,37 @@ static void mcp55_lpc_enable_childrens_resources(device_t dev)
|
||||||
if (child->enabled && (child->path.type == DEVICE_PATH_PNP)) {
|
if (child->enabled && (child->path.type == DEVICE_PATH_PNP)) {
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
for (res = child->resource_list; res; res = res->next) {
|
for (res = child->resource_list; res; res = res->next) {
|
||||||
unsigned long base, end; // don't need long long
|
unsigned long base, end; /* Don't need long long. */
|
||||||
if(!(res->flags & IORESOURCE_IO)) continue;
|
if (!(res->flags & IORESOURCE_IO))
|
||||||
|
continue;
|
||||||
base = res->base;
|
base = res->base;
|
||||||
end = resource_end(res);
|
end = resource_end(res);
|
||||||
printk(BIOS_DEBUG, "mcp55 lpc decode:%s, base=0x%08lx, end=0x%08lx\n",dev_path(child),base, end);
|
printk(BIOS_DEBUG, "mcp55 lpc decode:%s, base=0x%08lx, end=0x%08lx\n",dev_path(child),base, end);
|
||||||
switch(base) {
|
switch(base) {
|
||||||
case 0x3f8: // COM1
|
case 0x3f8: /* COM1 */
|
||||||
reg |= (1<<0); break;
|
reg |= (1 << 0);
|
||||||
case 0x2f8: // COM2
|
break;
|
||||||
reg |= (1<<1); break;
|
case 0x2f8: /* COM2 */
|
||||||
case 0x378: // Parallal 1
|
reg |= (1 << 1);
|
||||||
reg |= (1<<24); break;
|
break;
|
||||||
case 0x3f0: // FD0
|
case 0x378: /* Parallel 1 */
|
||||||
reg |= (1<<20); break;
|
reg |= (1 << 24);
|
||||||
case 0x220: // Aduio 0
|
break;
|
||||||
reg |= (1<<8); break;
|
case 0x3f0: /* FD0 */
|
||||||
case 0x300: // Midi 0
|
reg |= (1 << 20);
|
||||||
reg |= (1<<12); break;
|
break;
|
||||||
|
case 0x220: /* Audio 0 */
|
||||||
|
reg |= (1 << 8);
|
||||||
|
break;
|
||||||
|
case 0x300: /* Midi 0 */
|
||||||
|
reg |= (1 << 12);
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
if( (base == 0x290) || (base >= 0x400)) {
|
if ((base == 0x290)
|
||||||
if(var_num>=4) continue; // only 4 var ; compact them ?
|
|| (base >= 0x400)) {
|
||||||
|
/* Only 4 var; compact them? */
|
||||||
|
if (var_num >= 4)
|
||||||
|
continue;
|
||||||
reg |= (1 << (28 + var_num));
|
reg |= (1 << (28 + var_num));
|
||||||
reg_var[var_num++] = (base & 0xffff) | ((end & 0xffff) << 16);
|
reg_var[var_num++] = (base & 0xffff) | ((end & 0xffff) << 16);
|
||||||
}
|
}
|
||||||
|
@ -240,13 +241,10 @@ static void mcp55_lpc_enable_childrens_resources(device_t dev)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
pci_write_config32(dev, 0xa0, reg);
|
pci_write_config32(dev, 0xa0, reg);
|
||||||
for(i=0;i<var_num;i++) {
|
for (i = 0; i < var_num; i++)
|
||||||
pci_write_config32(dev, 0xa8 + i * 4, reg_var[i]);
|
pci_write_config32(dev, 0xa8 + i * 4, reg_var[i]);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
static void mcp55_lpc_enable_resources(device_t dev)
|
static void mcp55_lpc_enable_resources(device_t dev)
|
||||||
{
|
{
|
||||||
pci_dev_enable_resources(dev);
|
pci_dev_enable_resources(dev);
|
||||||
|
@ -279,21 +277,25 @@ static const struct pci_driver lpc_driver_lpc2 __pci_driver = {
|
||||||
.vendor = PCI_VENDOR_ID_NVIDIA,
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
||||||
.device = PCI_DEVICE_ID_NVIDIA_MCP55_LPC_2,
|
.device = PCI_DEVICE_ID_NVIDIA_MCP55_LPC_2,
|
||||||
};
|
};
|
||||||
|
|
||||||
static const struct pci_driver lpc_driver_lpc3 __pci_driver = {
|
static const struct pci_driver lpc_driver_lpc3 __pci_driver = {
|
||||||
.ops = &lpc_ops,
|
.ops = &lpc_ops,
|
||||||
.vendor = PCI_VENDOR_ID_NVIDIA,
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
||||||
.device = PCI_DEVICE_ID_NVIDIA_MCP55_LPC_3,
|
.device = PCI_DEVICE_ID_NVIDIA_MCP55_LPC_3,
|
||||||
};
|
};
|
||||||
|
|
||||||
static const struct pci_driver lpc_driver_lpc4 __pci_driver = {
|
static const struct pci_driver lpc_driver_lpc4 __pci_driver = {
|
||||||
.ops = &lpc_ops,
|
.ops = &lpc_ops,
|
||||||
.vendor = PCI_VENDOR_ID_NVIDIA,
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
||||||
.device = PCI_DEVICE_ID_NVIDIA_MCP55_LPC_4,
|
.device = PCI_DEVICE_ID_NVIDIA_MCP55_LPC_4,
|
||||||
};
|
};
|
||||||
|
|
||||||
static const struct pci_driver lpc_driver_lpc5 __pci_driver = {
|
static const struct pci_driver lpc_driver_lpc5 __pci_driver = {
|
||||||
.ops = &lpc_ops,
|
.ops = &lpc_ops,
|
||||||
.vendor = PCI_VENDOR_ID_NVIDIA,
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
||||||
.device = PCI_DEVICE_ID_NVIDIA_MCP55_LPC_5,
|
.device = PCI_DEVICE_ID_NVIDIA_MCP55_LPC_5,
|
||||||
};
|
};
|
||||||
|
|
||||||
static const struct pci_driver lpc_driver_lpc6 __pci_driver = {
|
static const struct pci_driver lpc_driver_lpc6 __pci_driver = {
|
||||||
.ops = &lpc_ops,
|
.ops = &lpc_ops,
|
||||||
.vendor = PCI_VENDOR_ID_NVIDIA,
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
||||||
|
|
|
@ -22,35 +22,35 @@
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <console/console.h>
|
#include <console/console.h>
|
||||||
|
|
||||||
#include <arch/io.h>
|
#include <arch/io.h>
|
||||||
|
|
||||||
#include <device/device.h>
|
#include <device/device.h>
|
||||||
#include <device/pci.h>
|
#include <device/pci.h>
|
||||||
#include <device/pci_ids.h>
|
#include <device/pci_ids.h>
|
||||||
#include <device/pci_ops.h>
|
#include <device/pci_ops.h>
|
||||||
#include "mcp55.h"
|
#include "mcp55.h"
|
||||||
|
|
||||||
static uint32_t final_reg;
|
static u32 final_reg;
|
||||||
|
|
||||||
static device_t find_lpc_dev(device_t dev, unsigned devfn)
|
static device_t find_lpc_dev(device_t dev, unsigned devfn)
|
||||||
{
|
{
|
||||||
|
|
||||||
device_t lpc_dev;
|
device_t lpc_dev;
|
||||||
|
|
||||||
lpc_dev = dev_find_slot(dev->bus->secondary, devfn);
|
lpc_dev = dev_find_slot(dev->bus->secondary, devfn);
|
||||||
|
|
||||||
if ( !lpc_dev ) return lpc_dev;
|
if (!lpc_dev)
|
||||||
|
return lpc_dev;
|
||||||
|
|
||||||
if ((lpc_dev->vendor != PCI_VENDOR_ID_NVIDIA) || (
|
if ((lpc_dev->vendor != PCI_VENDOR_ID_NVIDIA) || (
|
||||||
(lpc_dev->device < PCI_DEVICE_ID_NVIDIA_MCP55_LPC) ||
|
(lpc_dev->device < PCI_DEVICE_ID_NVIDIA_MCP55_LPC) ||
|
||||||
(lpc_dev->device > PCI_DEVICE_ID_NVIDIA_MCP55_PRO)
|
(lpc_dev->device > PCI_DEVICE_ID_NVIDIA_MCP55_PRO)))
|
||||||
) ) {
|
{
|
||||||
uint32_t id;
|
u32 id;
|
||||||
id = pci_read_config32(lpc_dev, PCI_VENDOR_ID);
|
id = pci_read_config32(lpc_dev, PCI_VENDOR_ID);
|
||||||
if ( (id < (PCI_VENDOR_ID_NVIDIA | (PCI_DEVICE_ID_NVIDIA_MCP55_LPC << 16))) ||
|
if ((id < (PCI_VENDOR_ID_NVIDIA
|
||||||
(id > (PCI_VENDOR_ID_NVIDIA | (PCI_DEVICE_ID_NVIDIA_MCP55_PRO << 16)))
|
| (PCI_DEVICE_ID_NVIDIA_MCP55_LPC << 16))) ||
|
||||||
) {
|
(id > (PCI_VENDOR_ID_NVIDIA
|
||||||
|
| (PCI_DEVICE_ID_NVIDIA_MCP55_PRO << 16))))
|
||||||
|
{
|
||||||
lpc_dev = 0;
|
lpc_dev = 0;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -60,21 +60,15 @@ static device_t find_lpc_dev( device_t dev, unsigned devfn)
|
||||||
|
|
||||||
void mcp55_enable(device_t dev)
|
void mcp55_enable(device_t dev)
|
||||||
{
|
{
|
||||||
device_t lpc_dev = 0;
|
device_t lpc_dev = 0, sm_dev = 0;
|
||||||
device_t sm_dev = 0;
|
unsigned index = 0, index2 = 0;
|
||||||
unsigned index = 0;
|
u32 reg_old, reg;
|
||||||
unsigned index2 = 0;
|
u8 byte;
|
||||||
uint32_t reg_old, reg;
|
unsigned deviceid, vendorid, devfn;
|
||||||
uint8_t byte;
|
|
||||||
unsigned deviceid;
|
|
||||||
unsigned vendorid;
|
|
||||||
|
|
||||||
struct southbridge_nvidia_mcp55_config *conf;
|
struct southbridge_nvidia_mcp55_config *conf;
|
||||||
conf = dev->chip_info;
|
conf = dev->chip_info;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
unsigned devfn;
|
|
||||||
|
|
||||||
if (dev->device == 0x0000) {
|
if (dev->device == 0x0000) {
|
||||||
vendorid = pci_read_config32(dev, PCI_VENDOR_ID);
|
vendorid = pci_read_config32(dev, PCI_VENDOR_ID);
|
||||||
deviceid = (vendorid >> 16) & 0xffff;
|
deviceid = (vendorid >> 16) & 0xffff;
|
||||||
|
@ -88,7 +82,6 @@ void mcp55_enable(device_t dev)
|
||||||
switch (deviceid) {
|
switch (deviceid) {
|
||||||
case PCI_DEVICE_ID_NVIDIA_MCP55_HT:
|
case PCI_DEVICE_ID_NVIDIA_MCP55_HT:
|
||||||
return;
|
return;
|
||||||
|
|
||||||
case PCI_DEVICE_ID_NVIDIA_MCP55_SM2: //?
|
case PCI_DEVICE_ID_NVIDIA_MCP55_SM2: //?
|
||||||
index = 16;
|
index = 16;
|
||||||
break;
|
break;
|
||||||
|
@ -106,7 +99,8 @@ void mcp55_enable(device_t dev)
|
||||||
index = 10;
|
index = 10;
|
||||||
for (i = 0; i < 2; i++) {
|
for (i = 0; i < 2; i++) {
|
||||||
lpc_dev = find_lpc_dev(dev, devfn - (i << 3));
|
lpc_dev = find_lpc_dev(dev, devfn - (i << 3));
|
||||||
if(!lpc_dev) continue;
|
if (!lpc_dev)
|
||||||
|
continue;
|
||||||
index -= i;
|
index -= i;
|
||||||
devfn -= (i << 3);
|
devfn -= (i << 3);
|
||||||
break;
|
break;
|
||||||
|
@ -125,9 +119,8 @@ void mcp55_enable(device_t dev)
|
||||||
devfn -= (4 << 3);
|
devfn -= (4 << 3);
|
||||||
index = 22;
|
index = 22;
|
||||||
i = (dev->path.pci.devfn) & 7;
|
i = (dev->path.pci.devfn) & 7;
|
||||||
if(i>0) {
|
if (i > 0)
|
||||||
index -= (i + 3);
|
index -= (i + 3);
|
||||||
}
|
|
||||||
break;
|
break;
|
||||||
case PCI_DEVICE_ID_NVIDIA_MCP55_PCI:
|
case PCI_DEVICE_ID_NVIDIA_MCP55_PCI:
|
||||||
devfn -= (5 << 3);
|
devfn -= (5 << 3);
|
||||||
|
@ -142,7 +135,8 @@ void mcp55_enable(device_t dev)
|
||||||
index2 = 8;
|
index2 = 8;
|
||||||
for (i = 0; i < 2; i++) {
|
for (i = 0; i < 2; i++) {
|
||||||
lpc_dev = find_lpc_dev(dev, devfn - (i << 3));
|
lpc_dev = find_lpc_dev(dev, devfn - (i << 3));
|
||||||
if(!lpc_dev) continue;
|
if (!lpc_dev)
|
||||||
|
continue;
|
||||||
index2 -= i;
|
index2 -= i;
|
||||||
devfn -= (i << 3);
|
devfn -= (i << 3);
|
||||||
break;
|
break;
|
||||||
|
@ -167,52 +161,49 @@ void mcp55_enable(device_t dev)
|
||||||
if (!lpc_dev)
|
if (!lpc_dev)
|
||||||
lpc_dev = find_lpc_dev(dev, devfn);
|
lpc_dev = find_lpc_dev(dev, devfn);
|
||||||
|
|
||||||
if ( !lpc_dev ) return;
|
if (!lpc_dev)
|
||||||
|
return;
|
||||||
|
|
||||||
if (index2 != 0) {
|
if (index2 != 0) {
|
||||||
sm_dev = dev_find_slot(dev->bus->secondary, devfn + 1);
|
sm_dev = dev_find_slot(dev->bus->secondary, devfn + 1);
|
||||||
if(!sm_dev) return;
|
if (!sm_dev)
|
||||||
|
return;
|
||||||
if (sm_dev) {
|
if (sm_dev) {
|
||||||
reg_old = reg = pci_read_config32(sm_dev, 0xe4);
|
reg_old = reg = pci_read_config32(sm_dev, 0xe4);
|
||||||
|
if (!dev->enabled)
|
||||||
if (!dev->enabled) { //disable it
|
reg |= (1<<index2); /* Disable it. */
|
||||||
reg |= (1<<index2);
|
if (reg != reg_old)
|
||||||
}
|
|
||||||
|
|
||||||
if (reg != reg_old) {
|
|
||||||
pci_write_config32(sm_dev, 0xe4, reg);
|
pci_write_config32(sm_dev, 0xe4, reg);
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
|
||||||
index2 = 0;
|
index2 = 0;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
if (index == 0) { // for LPC
|
if (index == 0) { // for LPC
|
||||||
|
/* Expose IOAPIC base. */
|
||||||
// expose ioapic base
|
|
||||||
byte = pci_read_config8(lpc_dev, 0x74);
|
byte = pci_read_config8(lpc_dev, 0x74);
|
||||||
byte |= ((1<<1)); // expose the BAR
|
byte |= (1 << 1); /* Expose the BAR. */
|
||||||
pci_write_config8(dev, 0x74, byte);
|
pci_write_config8(dev, 0x74, byte);
|
||||||
|
|
||||||
// expose trap base
|
/* Expose trap base. */
|
||||||
byte = pci_read_config8(lpc_dev, 0xdd);
|
byte = pci_read_config8(lpc_dev, 0xdd);
|
||||||
byte |= ((1<<0)|(1<<3)); // expose the BAR and enable write
|
byte |= (1 << 0) | (1 << 3); /* Expose BAR and enable write. */
|
||||||
pci_write_config8(dev, 0xdd, byte);
|
pci_write_config8(dev, 0xdd, byte);
|
||||||
|
|
||||||
return;
|
return;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
if (index == 16) {
|
if (index == 16) {
|
||||||
sm_dev = dev_find_slot(dev->bus->secondary, devfn + 1);
|
sm_dev = dev_find_slot(dev->bus->secondary, devfn + 1);
|
||||||
if(!sm_dev) return;
|
if (!sm_dev)
|
||||||
|
return;
|
||||||
|
|
||||||
final_reg = pci_read_config32(sm_dev, 0xe8);
|
final_reg = pci_read_config32(sm_dev, 0xe8);
|
||||||
final_reg &= ~((1<<16)|(1<<8)|(1<<20)|(1<<14)|(1<<22)|(1<<18)|(1<<17)|(1<<15)|(1<<11)|(1<<10)|(1<<9));
|
final_reg &= ~((1 << 16) | (1 << 8) | (1 << 20) | (1 << 14)
|
||||||
pci_write_config32(sm_dev, 0xe8, final_reg); //enable all at first
|
| (1 << 22) | (1 << 18) | (1 << 17) | (1 << 15)
|
||||||
|
| (1 << 11) | (1 << 10) | (1 << 9));
|
||||||
|
pci_write_config32(sm_dev, 0xe8, final_reg); /* Enable all at first. */
|
||||||
|
|
||||||
#if 0
|
#if 0
|
||||||
reg_old = reg = pci_read_config32(sm_dev, 0xe4);
|
reg_old = reg = pci_read_config32(sm_dev, 0xe4);
|
||||||
// reg |= (1 << 0);
|
// reg |= (1 << 0);
|
||||||
|
@ -225,21 +216,22 @@ void mcp55_enable(device_t dev)
|
||||||
}
|
}
|
||||||
|
|
||||||
if (!dev->enabled) {
|
if (!dev->enabled) {
|
||||||
final_reg |= (1 << index);// disable it
|
final_reg |= (1 << index); /* Disable it. */
|
||||||
//The reason for using final_reg, if diable func 1, the func 2 will be func 1 so We need disable them one time.
|
/*
|
||||||
|
* The reason for using final_reg, if diable func 1,
|
||||||
|
* the func 2 will be func 1, so we need disable them one time.
|
||||||
|
*/
|
||||||
}
|
}
|
||||||
|
|
||||||
if(index == 9 ) { //NIC1 is the final, We need update final reg to 0xe8
|
/* NIC1 is the final, we need update final reg to 0xe8. */
|
||||||
|
if (index == 9) {
|
||||||
sm_dev = dev_find_slot(dev->bus->secondary, devfn + 1);
|
sm_dev = dev_find_slot(dev->bus->secondary, devfn + 1);
|
||||||
if(!sm_dev) return;
|
if (!sm_dev)
|
||||||
|
return;
|
||||||
reg_old = pci_read_config32(sm_dev, 0xe8);
|
reg_old = pci_read_config32(sm_dev, 0xe8);
|
||||||
if (final_reg != reg_old) {
|
if (final_reg != reg_old)
|
||||||
pci_write_config32(sm_dev, 0xe8, final_reg);
|
pci_write_config32(sm_dev, 0xe8, final_reg);
|
||||||
}
|
}
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void mcp55_set_subsystem(device_t dev, unsigned vendor, unsigned device)
|
static void mcp55_set_subsystem(device_t dev, unsigned vendor, unsigned device)
|
||||||
|
|
|
@ -19,8 +19,8 @@
|
||||||
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef MCP55_H
|
#ifndef SOUTHBRIDGE_NVIDIA_MCP55_MCP55_H
|
||||||
#define MCP55_H
|
#define SOUTHBRIDGE_NVIDIA_MCP55_MCP55_H
|
||||||
|
|
||||||
#if CONFIG_HT_CHAIN_END_UNITID_BASE != 0x20
|
#if CONFIG_HT_CHAIN_END_UNITID_BASE != 0x20
|
||||||
#define MCP55_DEVN_BASE CONFIG_HT_CHAIN_END_UNITID_BASE
|
#define MCP55_DEVN_BASE CONFIG_HT_CHAIN_END_UNITID_BASE
|
||||||
|
@ -39,4 +39,4 @@ void mcp55_enable_usbdebug(unsigned int port);
|
||||||
#endif
|
#endif
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#endif /* MCP55_H */
|
#endif
|
||||||
|
|
|
@ -35,33 +35,36 @@ static int phy_read(u32 base, unsigned phy_addr, unsigned phy_reg)
|
||||||
{
|
{
|
||||||
u32 dword;
|
u32 dword;
|
||||||
unsigned loop = 0x100;
|
unsigned loop = 0x100;
|
||||||
write32(base+0x190, 0x8000); //Clear MDIO lock bit
|
|
||||||
|
write32(base + 0x190, 0x8000); /* Clear MDIO lock bit. */
|
||||||
mdelay(1);
|
mdelay(1);
|
||||||
dword = read32(base + 0x190);
|
dword = read32(base + 0x190);
|
||||||
if(dword & (1<<15)) return -1;
|
if (dword & (1 << 15))
|
||||||
|
return -1;
|
||||||
|
|
||||||
write32(base + 0x180, 1);
|
write32(base + 0x180, 1);
|
||||||
write32(base + 0x190, (phy_addr << 5) | (phy_reg));
|
write32(base + 0x190, (phy_addr << 5) | (phy_reg));
|
||||||
do {
|
do {
|
||||||
dword = read32(base + 0x190);
|
dword = read32(base + 0x190);
|
||||||
if(--loop==0) return -4;
|
if (--loop==0)
|
||||||
|
return -4;
|
||||||
} while ((dword & (1 << 15)));
|
} while ((dword & (1 << 15)));
|
||||||
|
|
||||||
dword = read32(base + 0x180);
|
dword = read32(base + 0x180);
|
||||||
if(dword & 1) return -3;
|
if (dword & 1)
|
||||||
|
return -3;
|
||||||
|
|
||||||
dword = read32(base + 0x194);
|
dword = read32(base + 0x194);
|
||||||
|
|
||||||
return dword;
|
return dword;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void phy_detect(u32 base)
|
static void phy_detect(u32 base)
|
||||||
{
|
{
|
||||||
u32 dword;
|
u32 dword;
|
||||||
int i;
|
int i, val;
|
||||||
int val;
|
|
||||||
unsigned id;
|
unsigned id;
|
||||||
|
|
||||||
dword = read32(base + 0x188);
|
dword = read32(base + 0x188);
|
||||||
dword &= ~(1 << 20);
|
dword &= ~(1 << 20);
|
||||||
write32(base + 0x188, dword);
|
write32(base + 0x188, dword);
|
||||||
|
@ -71,42 +74,45 @@ static void phy_detect(u32 base)
|
||||||
for (i = 1; i <= 32; i++) {
|
for (i = 1; i <= 32; i++) {
|
||||||
int phyaddr = i & 0x1f;
|
int phyaddr = i & 0x1f;
|
||||||
val = phy_read(base, phyaddr, 1);
|
val = phy_read(base, phyaddr, 1);
|
||||||
if(val<0) continue;
|
if (val < 0)
|
||||||
if((val & 0xffff) == 0xfffff) continue;
|
continue;
|
||||||
if((val & 0xffff) == 0) continue;
|
if ((val & 0xffff) == 0xfffff)
|
||||||
if(!(val & 1)) {
|
continue;
|
||||||
break; // Ethernet PHY
|
if ((val & 0xffff) == 0)
|
||||||
}
|
continue;
|
||||||
|
if (!(val & 1))
|
||||||
|
break; /* Ethernet PHY */
|
||||||
|
|
||||||
val = phy_read(base, phyaddr, 3);
|
val = phy_read(base, phyaddr, 3);
|
||||||
if (val < 0 || val == 0xffff) continue;
|
if (val < 0 || val == 0xffff)
|
||||||
|
continue;
|
||||||
id = val & 0xfc00;
|
id = val & 0xfc00;
|
||||||
val = phy_read(base, phyaddr, 2);
|
val = phy_read(base, phyaddr, 2);
|
||||||
if (val < 0 || val == 0xffff) continue;
|
if (val < 0 || val == 0xffff)
|
||||||
|
continue;
|
||||||
id |= ((val & 0xffff) << 16);
|
id |= ((val & 0xffff) << 16);
|
||||||
printk(BIOS_DEBUG, "MCP55 MAC PHY ID 0x%08x PHY ADDR %d\n", id, i);
|
printk(BIOS_DEBUG, "MCP55 MAC PHY ID 0x%08x PHY ADDR %d\n",
|
||||||
|
id, i);
|
||||||
// if ((id == 0xe0180000) || (id == 0x0032cc00))
|
// if ((id == 0xe0180000) || (id == 0x0032cc00))
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
if(i>32) {
|
if (i > 32)
|
||||||
printk(BIOS_DEBUG, "MCP55 MAC PHY not found\n");
|
printk(BIOS_DEBUG, "MCP55 MAC PHY not found\n");
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
|
||||||
static void nic_init(struct device *dev)
|
static void nic_init(struct device *dev)
|
||||||
{
|
{
|
||||||
u32 mac_h, mac_l;
|
u32 mac_h, mac_l, base;
|
||||||
int eeprom_valid = 0;
|
int eeprom_valid = 0;
|
||||||
struct southbridge_nvidia_mcp55_config *conf;
|
struct southbridge_nvidia_mcp55_config *conf;
|
||||||
|
|
||||||
static u32 nic_index = 0;
|
static u32 nic_index = 0;
|
||||||
|
|
||||||
u32 base;
|
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
|
|
||||||
res = find_resource(dev, 0x10);
|
res = find_resource(dev, 0x10);
|
||||||
|
|
||||||
if(!res) return;
|
if (!res)
|
||||||
|
return;
|
||||||
|
|
||||||
base = res->base;
|
base = res->base;
|
||||||
|
|
||||||
|
|
|
@ -31,9 +31,8 @@
|
||||||
|
|
||||||
static void pci_init(struct device *dev)
|
static void pci_init(struct device *dev)
|
||||||
{
|
{
|
||||||
|
u32 dword;
|
||||||
uint32_t dword;
|
u16 word;
|
||||||
uint16_t word;
|
|
||||||
device_t pci_domain_dev;
|
device_t pci_domain_dev;
|
||||||
struct resource *mem, *pref;
|
struct resource *mem, *pref;
|
||||||
|
|
||||||
|
|
|
@ -30,9 +30,8 @@
|
||||||
|
|
||||||
static void pcie_init(struct device *dev)
|
static void pcie_init(struct device *dev)
|
||||||
{
|
{
|
||||||
|
|
||||||
/* Enable pci error detecting */
|
/* Enable pci error detecting */
|
||||||
uint32_t dword;
|
u32 dword;
|
||||||
|
|
||||||
/* System error enable */
|
/* System error enable */
|
||||||
dword = pci_read_config32(dev, 0x04);
|
dword = pci_read_config32(dev, 0x04);
|
||||||
|
|
|
@ -31,7 +31,7 @@
|
||||||
|
|
||||||
static void sata_init(struct device *dev)
|
static void sata_init(struct device *dev)
|
||||||
{
|
{
|
||||||
uint32_t dword;
|
u32 dword;
|
||||||
|
|
||||||
struct southbridge_nvidia_mcp55_config *conf;
|
struct southbridge_nvidia_mcp55_config *conf;
|
||||||
conf = dev->chip_info;
|
conf = dev->chip_info;
|
||||||
|
|
|
@ -46,7 +46,7 @@ static int lsmbus_recv_byte(device_t dev)
|
||||||
return do_smbus_recv_byte(res->base, device);
|
return do_smbus_recv_byte(res->base, device);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int lsmbus_send_byte(device_t dev, uint8_t val)
|
static int lsmbus_send_byte(device_t dev, u8 val)
|
||||||
{
|
{
|
||||||
unsigned device;
|
unsigned device;
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
|
@ -60,7 +60,7 @@ static int lsmbus_send_byte(device_t dev, uint8_t val)
|
||||||
return do_smbus_send_byte(res->base, device, val);
|
return do_smbus_send_byte(res->base, device, val);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int lsmbus_read_byte(device_t dev, uint8_t address)
|
static int lsmbus_read_byte(device_t dev, u8 address)
|
||||||
{
|
{
|
||||||
unsigned device;
|
unsigned device;
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
|
@ -74,7 +74,7 @@ static int lsmbus_read_byte(device_t dev, uint8_t address)
|
||||||
return do_smbus_read_byte(res->base, device, address);
|
return do_smbus_read_byte(res->base, device, address);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int lsmbus_write_byte(device_t dev, uint8_t address, uint8_t val)
|
static int lsmbus_write_byte(device_t dev, u8 address, u8 val)
|
||||||
{
|
{
|
||||||
unsigned device;
|
unsigned device;
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
|
|
|
@ -33,7 +33,7 @@ extern struct ehci_debug_info dbg_info;
|
||||||
|
|
||||||
static void usb2_init(struct device *dev)
|
static void usb2_init(struct device *dev)
|
||||||
{
|
{
|
||||||
uint32_t dword;
|
u32 dword;
|
||||||
dword = pci_read_config32(dev, 0xf8);
|
dword = pci_read_config32(dev, 0xf8);
|
||||||
dword |= 40;
|
dword |= 40;
|
||||||
pci_write_config32(dev, 0xf8, dword);
|
pci_write_config32(dev, 0xf8, dword);
|
||||||
|
|
Loading…
Reference in New Issue