i2c mux support
git-svn-id: svn://svn.coreboot.org/coreboot/trunk@1809 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
This commit is contained in:
@@ -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>
|
||||
@@ -46,7 +47,7 @@ static void print_pci_regs_all(void)
|
||||
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",i,j,k, dev_path(dev));
|
||||
print_pci_regs(dev);
|
||||
}
|
||||
}
|
||||
@@ -56,28 +57,72 @@ static void print_pci_regs_all(void)
|
||||
|
||||
static void print_msr()
|
||||
{
|
||||
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);
|
||||
}
|
||||
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_smbus_regs_all(struct device *dev)
|
||||
{
|
||||
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;
|
||||
@@ -103,6 +148,9 @@ static void debug_init(device_t dev)
|
||||
case 3:
|
||||
print_msr();
|
||||
break;
|
||||
case 4:
|
||||
print_smbus_regs_all(&dev_root);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
|
2
src/drivers/i2c/adm1026/Config.lb
Normal file
2
src/drivers/i2c/adm1026/Config.lb
Normal file
@@ -0,0 +1,2 @@
|
||||
config chip.h
|
||||
object adm1026.o
|
68
src/drivers/i2c/adm1026/adm1026.c
Normal file
68
src/drivers/i2c/adm1026/adm1026.c
Normal file
@@ -0,0 +1,68 @@
|
||||
#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>
|
||||
#include <part/hard_reset.h>
|
||||
#include <cpu/x86/msr.h>
|
||||
#include "chip.h"
|
||||
|
||||
#define ADM1026_DEVICE 0x2c /* 0x2e or 0x2d */
|
||||
#define ADM1026_REG_CONFIG1 0x00
|
||||
#define CFG1_MONITOR 0x01
|
||||
#define CFG1_INT_ENABLE 0x02
|
||||
#define CFG1_INT_CLEAR 0x04
|
||||
#define CFG1_AIN8_9 0x08
|
||||
#define CFG1_THERM_HOT 0x10
|
||||
#define CFT1_DAC_AFC 0x20
|
||||
#define CFG1_PWM_AFC 0x40
|
||||
#define CFG1_RESET 0x80
|
||||
#define ADM1026_REG_CONFIG2 0x01
|
||||
#define ADM1026_REG_CONFIG3 0x07
|
||||
|
||||
static void adm1026_init(device_t dev)
|
||||
{
|
||||
if (dev->enabled && dev->path.type == DEVICE_PATH_I2C)
|
||||
{
|
||||
if(ops_smbus_bus(get_pbus_smbus(dev))) {
|
||||
if( dev->bus->dev->path.type == DEVICE_PATH_I2C) smbus_set_link(dev); // it is under mux
|
||||
adm1026_enable_monitoring(dev);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
static void adm1026_enable_monitoring(device_t dev)
|
||||
{
|
||||
int result;
|
||||
result = smbus_read_byte(dev, ADM1026_REG_CONFIG1);
|
||||
|
||||
result = (result | CFG1_MONITOR) & ~(CFG1_INT_CLEAR | CFG1_RESET);
|
||||
result = smbus_write_byte(dev, ADM1026_REG_CONFIG1, result);
|
||||
|
||||
result = smbus_read_byte(dev, ADM1026_REG_CONFIG1);
|
||||
if (!(result & CFG1_MONITOR)) {
|
||||
printk_debug("ADM1026: monitoring would not enable");
|
||||
}
|
||||
}
|
||||
static void adm1026_noop(device_t dummy)
|
||||
{
|
||||
}
|
||||
|
||||
static struct device_operations adm1026_operations = {
|
||||
.read_resources = adm1026_noop,
|
||||
.set_resources = adm1026_noop,
|
||||
.enable_resources = adm1026_noop,
|
||||
.init = adm1026_init,
|
||||
};
|
||||
|
||||
static void enable_dev(struct device *dev)
|
||||
{
|
||||
dev->ops = &adm1026_operations;
|
||||
}
|
||||
|
||||
struct chip_operations drivers_i2c_adm1026_ops = {
|
||||
CHIP_NAME("adm1026")
|
||||
.enable_dev = enable_dev,
|
||||
};
|
4
src/drivers/i2c/adm1026/chip.h
Normal file
4
src/drivers/i2c/adm1026/chip.h
Normal file
@@ -0,0 +1,4 @@
|
||||
extern struct chip_operations drivers_i2c_adm1026_ops;
|
||||
|
||||
struct drivers_i2c_adm1026_config {
|
||||
};
|
2
src/drivers/i2c/adm1027/Config.lb
Normal file
2
src/drivers/i2c/adm1027/Config.lb
Normal file
@@ -0,0 +1,2 @@
|
||||
config chip.h
|
||||
object adm1027.o
|
72
src/drivers/i2c/adm1027/adm1027.c
Normal file
72
src/drivers/i2c/adm1027/adm1027.c
Normal file
@@ -0,0 +1,72 @@
|
||||
#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>
|
||||
#include <part/hard_reset.h>
|
||||
#include <cpu/x86/msr.h>
|
||||
#include "chip.h"
|
||||
|
||||
#define ADM1027_REG_CONFIG1 0x40
|
||||
#define CFG1_STRT 0x01
|
||||
#define CFG1_LOCK 0x02
|
||||
#define CFG1_RDY 0x04
|
||||
#define CFG1_FSPD 0x08
|
||||
#define CFG1_VXI 0x10
|
||||
#define CFT1_FSPDIS 0x20
|
||||
#define CFG1_TODIS 0x40
|
||||
#define CFG1_VCC 0x80
|
||||
#define ADM1027_REG_CONFIG2 0x73
|
||||
#define ADM1027_REG_CONFIG3 0x78
|
||||
|
||||
static void adm1027_enable_monitoring(device_t dev)
|
||||
{
|
||||
int result;
|
||||
result = smbus_read_byte(dev, ADM1027_REG_CONFIG1);
|
||||
|
||||
if(!(result & CFG1_RDY) ) {
|
||||
printk_debug("ADM1027: monitoring not ready");
|
||||
return;
|
||||
}
|
||||
result = (result | CFG1_STRT);
|
||||
result = smbus_write_byte(dev, ADM1027_REG_CONFIG1, result);
|
||||
|
||||
result = smbus_read_byte(dev, ADM1027_REG_CONFIG1);
|
||||
if (!(result & CFG1_STRT)) {
|
||||
printk_debug("ADM1027: monitoring would not enable");
|
||||
}
|
||||
}
|
||||
|
||||
static void adm1027_init(device_t dev)
|
||||
{
|
||||
if (dev->enabled && dev->path.type == DEVICE_PATH_I2C)
|
||||
{
|
||||
if(ops_smbus_bus(get_pbus_smbus(dev))) {
|
||||
if( dev->bus->dev->path.type == DEVICE_PATH_I2C) smbus_set_link(dev); // it is under mux
|
||||
adm1027_enable_monitoring(dev);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
static void adm1027_noop(device_t dummy)
|
||||
{
|
||||
}
|
||||
|
||||
static struct device_operations adm1027_operations = {
|
||||
.read_resources = adm1027_noop,
|
||||
.set_resources = adm1027_noop,
|
||||
.enable_resources = adm1027_noop,
|
||||
.init = adm1027_init,
|
||||
};
|
||||
|
||||
static void enable_dev(struct device *dev)
|
||||
{
|
||||
dev->ops = &adm1027_operations;
|
||||
}
|
||||
|
||||
struct chip_operations drivers_i2c_adm1027_ops = {
|
||||
CHIP_NAME("adm1027")
|
||||
.enable_dev = enable_dev,
|
||||
};
|
4
src/drivers/i2c/adm1027/chip.h
Normal file
4
src/drivers/i2c/adm1027/chip.h
Normal file
@@ -0,0 +1,4 @@
|
||||
extern struct chip_operations drivers_i2c_adm1027_ops;
|
||||
|
||||
struct drivers_i2c_adm1027_config {
|
||||
};
|
2
src/drivers/i2c/i2cmux/Config.lb
Normal file
2
src/drivers/i2c/i2cmux/Config.lb
Normal file
@@ -0,0 +1,2 @@
|
||||
config chip.h
|
||||
object i2cmux.o
|
4
src/drivers/i2c/i2cmux/chip.h
Normal file
4
src/drivers/i2c/i2cmux/chip.h
Normal file
@@ -0,0 +1,4 @@
|
||||
extern struct chip_operations drivers_i2c_i2cmux_ops;
|
||||
|
||||
struct drivers_i2c_i2cmux_config {
|
||||
};
|
44
src/drivers/i2c/i2cmux/i2cmux.c
Normal file
44
src/drivers/i2c/i2cmux/i2cmux.c
Normal file
@@ -0,0 +1,44 @@
|
||||
#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>
|
||||
#include <cpu/x86/msr.h>
|
||||
#include "chip.h"
|
||||
|
||||
static void i2cmux_set_link(device_t dev, unsigned int link)
|
||||
{
|
||||
if (dev->enabled && dev->path.type == DEVICE_PATH_I2C)
|
||||
{
|
||||
if(ops_smbus_bus(get_pbus_smbus(dev))) {
|
||||
smbus_write_byte(dev, 0x01, 1<<link); // output value
|
||||
smbus_write_byte(dev, 0x03, 0); // all output
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
static void i2cmux_noop(device_t dummy)
|
||||
{
|
||||
}
|
||||
|
||||
static struct device_operations i2cmux_operations = {
|
||||
.read_resources = i2cmux_noop,
|
||||
.set_resources = i2cmux_noop,
|
||||
.enable_resources = i2cmux_noop,
|
||||
.init = i2cmux_noop,
|
||||
.scan_bus = scan_static_bus,
|
||||
.set_link = i2cmux_set_link,
|
||||
};
|
||||
|
||||
static void enable_dev(struct device *dev)
|
||||
{
|
||||
if(dev->links>0)
|
||||
dev->ops = &i2cmux_operations;
|
||||
}
|
||||
|
||||
struct chip_operations drivers_i2c_i2cmux_ops = {
|
||||
CHIP_NAME("i2cmux")
|
||||
.enable_dev = enable_dev,
|
||||
};
|
2
src/drivers/i2c/lm63/Config.lb
Normal file
2
src/drivers/i2c/lm63/Config.lb
Normal file
@@ -0,0 +1,2 @@
|
||||
config chip.h
|
||||
object lm63.o
|
4
src/drivers/i2c/lm63/chip.h
Normal file
4
src/drivers/i2c/lm63/chip.h
Normal file
@@ -0,0 +1,4 @@
|
||||
extern struct chip_operations drivers_i2c_lm63_ops;
|
||||
|
||||
struct drivers_i2c_lm63_config {
|
||||
};
|
46
src/drivers/i2c/lm63/lm63.c
Normal file
46
src/drivers/i2c/lm63/lm63.c
Normal file
@@ -0,0 +1,46 @@
|
||||
#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>
|
||||
#include <cpu/x86/msr.h>
|
||||
#include "chip.h"
|
||||
|
||||
|
||||
static void lm63_init(device_t dev)
|
||||
{
|
||||
int result;
|
||||
if (dev->enabled && dev->path.type == DEVICE_PATH_I2C)
|
||||
{
|
||||
if(ops_smbus_bus(get_pbus_smbus(dev))) {
|
||||
if( dev->bus->dev->path.type == DEVICE_PATH_I2C) smbus_set_link(dev); // it is under mux
|
||||
result = smbus_read_byte(dev, 0x03);
|
||||
// result &= ~0x04;
|
||||
result |= 0x04;
|
||||
smbus_write_byte(dev, 0x03, result & 0xff); // config lm63
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
static void lm63_noop(device_t dummy)
|
||||
{
|
||||
}
|
||||
|
||||
static struct device_operations lm63_operations = {
|
||||
.read_resources = lm63_noop,
|
||||
.set_resources = lm63_noop,
|
||||
.enable_resources = lm63_noop,
|
||||
.init = lm63_init,
|
||||
};
|
||||
|
||||
static void enable_dev(struct device *dev)
|
||||
{
|
||||
dev->ops = &lm63_operations;
|
||||
}
|
||||
|
||||
struct chip_operations drivers_i2c_lm63_ops = {
|
||||
CHIP_NAME("lm63")
|
||||
.enable_dev = enable_dev,
|
||||
};
|
Reference in New Issue
Block a user