Revision: linuxbios@linuxbios.org--devel/freebios--devel--2.0--patch-10

[coreboot.git] / src / drivers / generic / debug / debug_dev.c

diff --git a/src/drivers/generic/debug/debug_dev.c b/src/drivers/generic/debug/debug_dev.c
index 727d4747f581792a0a4b30c50ab6d9f727ebd12a..600b1fcf60ddecb246a7415635f002140749f9f8 100644 (file)
--- a/src/drivers/generic/debug/debug_dev.c
+++ b/src/drivers/generic/debug/debug_dev.c
@@ -1,5 +1,6 @@
 #include <console/console.h>
 #include <device/device.h>
+#include <device/smbus.h>
 #include <device/pci.h>
 #include <device/pci_ids.h>
 #include <device/pci_ops.h>
@@ -12,14 +13,14 @@ static void print_pci_regs(struct device *dev)
       int i;
 
       for(i=0;i<256;i++) {
-            byte = pci_read_config8(dev, i);
+             byte = pci_read_config8(dev, i);
    
-             if((i & 0xf)==0) printk_debug("\n%02x:",i);
-             printk_debug(" %02x",byte);
+             if((i & 0xf)==0) printk_debug("\n%02x:",i);
+             printk_debug(" %02x",byte);
       }
       printk_debug("\n");
-
 }
+
 static void print_mem(void)
 {
         unsigned int i;
@@ -34,53 +35,101 @@ static void print_mem(void)
 static void print_pci_regs_all(void)
 {
         struct device *dev;
-       unsigned char i,j,k;
+       unsigned bus, device, function;
 
-       for(i=0;i<=15;i++) {
-               for(j=0;j<=0x1f;j++) {
-                       for (k=0;k<=6;k++){
-                               dev = dev_find_slot(i, PCI_DEVFN(j, k));
+       for(bus=0; bus<256; bus++) {
+               for(device=0; device<=0x1f; device++) {
+                       for (function=0; function<=7; function++){
+                               unsigned devfn;
+                               devfn = PCI_DEVFN(device, function);
+                               dev = dev_find_slot(bus, devfn);
                                if(!dev) {
                                        continue;
                                }
                                if(!dev->enabled) {
                                        continue;
                                }
-                               printk_debug("\n%02x:%02x:%02x aka %s",i,j,k, dev_path(dev));
+                               printk_debug("\n%02x:%02x:%02x aka %s", 
+                                       bus, device, function, dev_path(dev));
                                print_pci_regs(dev);
                        }
                }
        }
+}
+
+static void print_cpuid()
+{
+       msr_t msr;
+       unsigned index;
+       unsigned eax, ebx, ecx, edx;
+       index = 0x80000007;
+       printk_debug("calling cpuid 0x%08x\n", index);
+       asm volatile(
+               "cpuid"
+               : "=a" (eax), "=b" (ebx), "=c" (ecx), "=d" (edx)
+               : "a" (index)
+               );
+       printk_debug("cpuid[%08x]: %08x %08x %08x %08x\n",
+               index, eax, ebx, ecx, edx);
+       if (edx & (3 << 1)) {
+               index = 0xC0010042;
+               printk_debug("Reading msr: 0x%08x\n", index);
+               msr = rdmsr(index);
+               printk_debug("msr[0x%08x]: 0x%08x%08x\n",
+                       index, msr.hi, msr.hi);
+       }
 
 }
+static void print_smbus_regs(struct device *dev)
+{               
+       int j;
+       printk_debug("smbus:  %s[%d]->",  dev_path(dev->bus->dev), dev->bus->link );
+       printk_debug("%s",  dev_path(dev));
+       for(j = 0; j < 256; j++) {
+               int status;
+               unsigned char byte;
+               if ((j & 0xf) == 0) {
+                       printk_debug("\r\n%02x: ", j);
+               }
+               status = smbus_read_byte(dev, j);
+               if (status < 0) {
+                       printk_debug("bad device status= %08x\r\n", status);
+                       break;
+               }
+               byte = status & 0xff;
+               printk_debug("%02x ", byte);
+       }
+       printk_debug("\r\n");
+}
 
-static void print_msr()
+static void print_smbus_regs_all(struct device *dev)
 {
-        msr_t msr;
-        unsigned index;
-        unsigned eax, ebx, ecx, edx;
-        index = 0x80000007;
-        printk_debug("calling cpuid 0x%08x\n", index);
-        asm volatile(
-                "cpuid"
-                : "=a" (eax), "=b" (ebx), "=c" (ecx), "=d" (edx)
-                : "a" (index)
-                );
-        printk_debug("cpuid[%08x]: %08x %08x %08x %08x\n",
-                index, eax, ebx, ecx, edx);
-        if (edx & (3 << 1)) {
-                index = 0xC0010042;
-                printk_debug("Reading msr: 0x%08x\n", index);
-                msr = rdmsr(index);
-                printk_debug("msr[0x%08x]: 0x%08x%08x\n",
-                        index, msr.hi, msr.hi);
-        }
+       struct device *child;
+       int i;
+       if (dev->enabled && dev->path.type == DEVICE_PATH_I2C)
+       {
+               // Here don't need to call smbus_set_link, because we scan it from top to down
+               if( dev->bus->dev->path.type == DEVICE_PATH_I2C) { // it's under i2c MUX so set mux at first
+                       if(ops_smbus_bus(get_pbus_smbus(dev->bus->dev))) {
+                               if(dev->bus->dev->ops && dev->bus->dev->ops->set_link) 
+                                       dev->bus->dev->ops->set_link(dev->bus->dev, dev->bus->link);
+                       }
+               }
+               
+               if(ops_smbus_bus(get_pbus_smbus(dev))) print_smbus_regs(dev);   
+       }
 
+       for(i=0; i< dev->links; i++) {
+               for (child = dev->link[i].children; child; child = child->sibling) {
+                       print_smbus_regs_all(child);
+               }
+       }
 }
- 
 static void debug_init(device_t dev)
 {
        device_t parent;
+       if (!dev->enabled)
+               return;
        switch(dev->path.u.pnp.device) {
 #if CONFIG_CHIP_NAME
        case 0:
@@ -101,7 +150,10 @@ static void debug_init(device_t dev)
                print_mem();
                break;
        case 3:
-               print_msr();
+               print_cpuid();
+               break;
+       case 4: 
+               print_smbus_regs_all(&dev_root);
                break;
        }
 }