5079a0d32f
As we move to supporting other systems we need to get rid of assembly where we can. The log2 function in src/lib is identical to the assembly one (tested for all 32-bit signed integers :-) and takes about 10 ns to run as opposed to 5ns for the non-portable assembly version. While speed is good, I think we can spare the 15 ns or so we add to boot time by using the C version only. Change-Id: Icafa565eae282c85fa5fc01b3bd1f110cd9aaa91 Signed-off-by: Ronald G. Minnich <rminnich@gmail.com> Reviewed-on: http://review.coreboot.org/1928 Tested-by: build bot (Jenkins)
141 lines
3.5 KiB
C
141 lines
3.5 KiB
C
/*
|
|
* This file is part of the coreboot project.
|
|
*
|
|
* Copyright (C) 2004 Tyan Computer
|
|
* Written by Yinghai Lu <yhlu@tyan.com> for Tyan Computer.
|
|
* Copyright (C) 2006,2007 AMD
|
|
* Written by Yinghai Lu <yinghai.lu@amd.com> for AMD.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*/
|
|
|
|
#include <console/console.h>
|
|
#include <device/device.h>
|
|
#include <device/pci.h>
|
|
#include <device/pci_ids.h>
|
|
#include <device/pci_ops.h>
|
|
#include <device/smbus.h>
|
|
#include <arch/io.h>
|
|
#include "mcp55.h"
|
|
#include "smbus.h"
|
|
|
|
static int lsmbus_recv_byte(device_t dev)
|
|
{
|
|
unsigned device;
|
|
struct resource *res;
|
|
struct bus *pbus;
|
|
|
|
device = dev->path.i2c.device;
|
|
pbus = get_pbus_smbus(dev);
|
|
|
|
res = find_resource(pbus->dev, 0x20 + (pbus->link_num * 4));
|
|
|
|
return do_smbus_recv_byte(res->base, device);
|
|
}
|
|
|
|
static int lsmbus_send_byte(device_t dev, u8 val)
|
|
{
|
|
unsigned device;
|
|
struct resource *res;
|
|
struct bus *pbus;
|
|
|
|
device = dev->path.i2c.device;
|
|
pbus = get_pbus_smbus(dev);
|
|
|
|
res = find_resource(pbus->dev, 0x20 + (pbus->link_num * 4));
|
|
|
|
return do_smbus_send_byte(res->base, device, val);
|
|
}
|
|
|
|
static int lsmbus_read_byte(device_t dev, u8 address)
|
|
{
|
|
unsigned device;
|
|
struct resource *res;
|
|
struct bus *pbus;
|
|
|
|
device = dev->path.i2c.device;
|
|
pbus = get_pbus_smbus(dev);
|
|
|
|
res = find_resource(pbus->dev, 0x20 + (pbus->link_num * 4));
|
|
|
|
return do_smbus_read_byte(res->base, device, address);
|
|
}
|
|
|
|
static int lsmbus_write_byte(device_t dev, u8 address, u8 val)
|
|
{
|
|
unsigned device;
|
|
struct resource *res;
|
|
struct bus *pbus;
|
|
|
|
device = dev->path.i2c.device;
|
|
pbus = get_pbus_smbus(dev);
|
|
|
|
res = find_resource(pbus->dev, 0x20 + (pbus->link_num * 4));
|
|
|
|
return do_smbus_write_byte(res->base, device, address, val);
|
|
}
|
|
static struct smbus_bus_operations lops_smbus_bus = {
|
|
.recv_byte = lsmbus_recv_byte,
|
|
.send_byte = lsmbus_send_byte,
|
|
.read_byte = lsmbus_read_byte,
|
|
.write_byte = lsmbus_write_byte,
|
|
};
|
|
|
|
#if CONFIG_GENERATE_ACPI_TABLES
|
|
unsigned pm_base;
|
|
#endif
|
|
|
|
static void mcp55_sm_read_resources(device_t dev)
|
|
{
|
|
unsigned long index;
|
|
|
|
/* Get the normal pci resources of this device */
|
|
pci_dev_read_resources(dev);
|
|
|
|
for (index = 0x60; index <= 0x68; index+=4) { // We got another 3.
|
|
pci_get_resource(dev, index);
|
|
}
|
|
compact_resources(dev);
|
|
}
|
|
|
|
static void mcp55_sm_init(device_t dev)
|
|
{
|
|
#if CONFIG_GENERATE_ACPI_TABLES
|
|
struct resource *res;
|
|
|
|
res = find_resource(dev, 0x60);
|
|
|
|
if (res)
|
|
pm_base = res->base;
|
|
#endif
|
|
}
|
|
|
|
static struct device_operations smbus_ops = {
|
|
.read_resources = mcp55_sm_read_resources,
|
|
.set_resources = pci_dev_set_resources,
|
|
.enable_resources = pci_dev_enable_resources,
|
|
.init = mcp55_sm_init,
|
|
.scan_bus = scan_static_bus,
|
|
// .enable = mcp55_enable,
|
|
.ops_pci = &mcp55_pci_ops,
|
|
.ops_smbus_bus = &lops_smbus_bus,
|
|
};
|
|
static const struct pci_driver smbus_driver __pci_driver = {
|
|
.ops = &smbus_ops,
|
|
.vendor = PCI_VENDOR_ID_NVIDIA,
|
|
.device = PCI_DEVICE_ID_NVIDIA_MCP55_SM2,
|
|
};
|
|
|