435 lines
9.8 KiB
C++
435 lines
9.8 KiB
C++
/*
|
|
* \brief Emulate 'pci_dev' structure
|
|
* \author Sebastian Sumpf <sebastian.sumpf@genode-labs.com>
|
|
* \date 2012-04-02
|
|
*/
|
|
|
|
/*
|
|
* Copyright (C) 2012-2013 Genode Labs GmbH
|
|
*
|
|
* This file is part of the Genode OS framework, which is distributed
|
|
* under the terms of the GNU General Public License version 2.
|
|
*/
|
|
|
|
/* Genode base includes */
|
|
#include <ram_session/client.h>
|
|
#include <base/object_pool.h>
|
|
#include <irq_session/connection.h>
|
|
|
|
/* Genode os includes */
|
|
#include <os/server.h>
|
|
#include <pci_session/connection.h>
|
|
#include <pci_device/client.h>
|
|
|
|
/* Linux includes */
|
|
#include <extern_c_begin.h>
|
|
#include <lx_emul.h>
|
|
#include <extern_c_end.h>
|
|
#include <platform/lx_mem.h>
|
|
|
|
struct bus_type pci_bus_type;
|
|
|
|
|
|
/**
|
|
* Scan PCI bus and probe for HCDs
|
|
*/
|
|
class Pci_driver : public Genode::List<Pci_driver>::Element
|
|
{
|
|
private:
|
|
|
|
pci_driver *_drv; /* Linux PCI driver */
|
|
Pci::Device_capability _cap; /* PCI cap */
|
|
pci_device_id const *_id; /* matched id for this driver */
|
|
|
|
public:
|
|
|
|
pci_dev *_dev; /* Linux PCI device */
|
|
|
|
private:
|
|
|
|
/* offset used in PCI config space */
|
|
enum Pci_config { IRQ = 0x3c, REV = 0x8, CMD = 0x4 };
|
|
|
|
/**
|
|
* Fill Linux device informations
|
|
*/
|
|
void _setup_pci_device()
|
|
{
|
|
using namespace Pci;
|
|
|
|
Device_client client(_cap);
|
|
uint8_t bus, dev, func;
|
|
client.bus_address(&bus, &dev, &func);
|
|
|
|
_dev = new (Genode::env()->heap()) pci_dev;
|
|
_dev->devfn = ((uint16_t)bus << 8) | (0xff & PCI_DEVFN(dev, func));
|
|
_dev->vendor = client.vendor_id();
|
|
_dev->device = client.device_id();
|
|
_dev->class_ = client.class_code();
|
|
_dev->revision = client.config_read(REV, Device::ACCESS_8BIT);
|
|
_dev->dev.driver = &_drv->driver;
|
|
|
|
/* dummy dma mask used to mark device as DMA capable */
|
|
static u64 dma_mask = ~(u64)0;
|
|
_dev->dev.dma_mask = &dma_mask;
|
|
_dev->dev.coherent_dma_mask = ~0;
|
|
|
|
/* read interrupt line */
|
|
_dev->irq = client.config_read(IRQ, Device::ACCESS_8BIT);
|
|
|
|
/* hide ourselfs in bus structure */
|
|
_dev->bus = (struct pci_bus *)this;
|
|
|
|
/* setup resources */
|
|
bool io = false;
|
|
for (int i = 0; i < Device::NUM_RESOURCES; i++) {
|
|
Device::Resource res = client.resource(i);
|
|
_dev->resource[i].start = res.base();
|
|
_dev->resource[i].end = res.base() + res.size() - 1;
|
|
_dev->resource[i].flags = res.type() == Device::Resource::IO
|
|
? IORESOURCE_IO : 0;
|
|
|
|
/* request port I/O session */
|
|
if (res.type() == Device::Resource::IO) {
|
|
if (dde_kit_request_io(res.base(), res.size()))
|
|
PERR("Failed to request I/O: [%u,%u)",
|
|
res.base(), res.base() + res.size());
|
|
io = true;
|
|
dde_kit_log(DEBUG_PCI, "I/O [%u-%u)",
|
|
res.base(), res.base() + res.size());
|
|
}
|
|
|
|
/* request I/O memory (write combined) */
|
|
if (res.type() == Device::Resource::MEMORY)
|
|
dde_kit_log(DEBUG_PCI, "I/O memory [%x-%x)", res.base(),
|
|
res.base() + res.size());
|
|
}
|
|
|
|
/* enable bus master and io bits */
|
|
uint16_t cmd = client.config_read(CMD, Device::ACCESS_16BIT);
|
|
cmd |= io ? 0x1 : 0;
|
|
|
|
/* enable bus master */
|
|
cmd |= 0x4;
|
|
client.config_write(CMD, cmd, Device::ACCESS_16BIT);
|
|
|
|
_drivers().insert(this);
|
|
}
|
|
|
|
/**
|
|
* Probe device with driver
|
|
*/
|
|
bool _probe()
|
|
{
|
|
_setup_pci_device();
|
|
|
|
if (!_drv->probe(_dev, _id))
|
|
return true;
|
|
|
|
PERR("Probe failed\n");
|
|
return false;
|
|
}
|
|
|
|
template <typename T>
|
|
Pci::Device::Access_size _access_size(T t)
|
|
{
|
|
switch (sizeof(T))
|
|
{
|
|
case 1:
|
|
return Pci::Device::ACCESS_8BIT;
|
|
case 2:
|
|
return Pci::Device::ACCESS_16BIT;
|
|
default:
|
|
return Pci::Device::ACCESS_32BIT;
|
|
}
|
|
}
|
|
|
|
static Genode::List<Pci_driver> & _drivers()
|
|
{
|
|
static Genode::List<Pci_driver> _list;
|
|
return _list;
|
|
}
|
|
|
|
public:
|
|
|
|
Pci_driver(pci_driver *drv, Pci::Device_capability cap,
|
|
pci_device_id const * id)
|
|
: _drv(drv), _cap(cap), _id(id), _dev(0)
|
|
{
|
|
if (!_probe())
|
|
throw -1;
|
|
}
|
|
|
|
~Pci_driver()
|
|
{
|
|
if (!_dev)
|
|
return;
|
|
|
|
for (int i = 0; i < Pci::Device::NUM_RESOURCES; i++) {
|
|
resource *r = &_dev->resource[i];
|
|
|
|
if (r->flags & IORESOURCE_IO)
|
|
dde_kit_release_io(r->start, (r->end - r->start) + 1);
|
|
}
|
|
|
|
_drivers().remove(this);
|
|
|
|
destroy(Genode::env()->heap(), _dev);
|
|
}
|
|
|
|
/**
|
|
* Read/write data from/to config space
|
|
*/
|
|
template <typename T>
|
|
void config_read(unsigned int devfn, T *val)
|
|
{
|
|
Pci::Device_client client(_cap);
|
|
*val = client.config_read(devfn, _access_size(*val));
|
|
}
|
|
|
|
template <typename T>
|
|
void config_write(unsigned int devfn, T val)
|
|
{
|
|
Pci::Device_client client(_cap);
|
|
client.config_write(devfn, val, _access_size(val));
|
|
}
|
|
|
|
static Genode::Irq_session_capability irq_cap(unsigned irq)
|
|
{
|
|
for (Pci_driver *d = _drivers().first(); d; d = d->next()) {
|
|
if (d->_dev && d->_dev->irq != irq)
|
|
continue;
|
|
|
|
Pci::Device_client client(d->_cap);
|
|
return client.irq(0);
|
|
}
|
|
|
|
return Genode::Irq_session_capability();
|
|
}
|
|
};
|
|
|
|
/********************************
|
|
** Backend memory definitions **
|
|
********************************/
|
|
|
|
struct Memory_object_base : Genode::Object_pool<Memory_object_base>::Entry
|
|
{
|
|
Memory_object_base(Genode::Ram_dataspace_capability cap)
|
|
: Genode::Object_pool<Memory_object_base>::Entry(cap) {}
|
|
virtual ~Memory_object_base() {};
|
|
|
|
virtual void free() = 0;
|
|
|
|
Genode::Ram_dataspace_capability ram_cap()
|
|
{
|
|
using namespace Genode;
|
|
return reinterpret_cap_cast<Ram_dataspace>(cap());
|
|
}
|
|
};
|
|
|
|
|
|
struct Ram_object : Memory_object_base
|
|
{
|
|
Ram_object(Genode::Ram_dataspace_capability cap)
|
|
: Memory_object_base(cap) {}
|
|
|
|
void free();
|
|
};
|
|
|
|
|
|
struct Dma_object : Memory_object_base
|
|
{
|
|
Dma_object(Genode::Ram_dataspace_capability cap)
|
|
: Memory_object_base(cap) {}
|
|
|
|
void free();
|
|
};
|
|
|
|
|
|
/*********************
|
|
** Linux interface **
|
|
*********************/
|
|
|
|
static Pci::Connection pci;
|
|
static Genode::Object_pool<Memory_object_base> memory_pool;
|
|
|
|
int pci_register_driver(struct pci_driver *drv)
|
|
{
|
|
dde_kit_log(DEBUG_PCI, "DRIVER name: %s", drv->name);
|
|
drv->driver.name = drv->name;
|
|
|
|
pci_device_id const *id = drv->id_table;
|
|
if (!id)
|
|
return -ENODEV;
|
|
|
|
using namespace Genode;
|
|
|
|
bool found = false;
|
|
|
|
while (id->class_ || id->class_mask || id->class_) {
|
|
|
|
if (id->class_ == (unsigned)PCI_ANY_ID) {
|
|
dde_kit_log(DEBUG_PCI, "Skipping PCI_ANY_ID device class");
|
|
id++;
|
|
continue;
|
|
}
|
|
|
|
Pci::Device_capability cap = pci.first_device(id->class_,
|
|
id->class_mask);
|
|
while (cap.valid()) {
|
|
|
|
if (DEBUG_PCI) {
|
|
uint8_t bus, dev, func;
|
|
Pci::Device_client client(cap);
|
|
client.bus_address(&bus, &dev, &func);
|
|
dde_kit_log(DEBUG_PCI, "bus: %x dev: %x func: %x", bus, dev, func);
|
|
}
|
|
|
|
Pci_driver *pci_drv = 0;
|
|
try {
|
|
/* trigger that the device get be assigned to the usb driver */
|
|
pci.config_extended(cap);
|
|
|
|
/* probe device */
|
|
pci_drv = new (env()->heap()) Pci_driver(drv, cap, id);
|
|
pci.on_destruction(Pci::Connection::KEEP_OPEN);
|
|
found = true;
|
|
|
|
} catch (...) {
|
|
destroy(env()->heap(), pci_drv);
|
|
pci_drv = 0;
|
|
}
|
|
|
|
Pci::Device_capability free_up = cap;
|
|
cap = pci.next_device(cap, id->class_, id->class_mask);
|
|
if (!pci_drv)
|
|
pci.release_device(free_up);
|
|
}
|
|
id++;
|
|
}
|
|
|
|
return found ? 0 : -ENODEV;
|
|
}
|
|
|
|
|
|
size_t pci_resource_start(struct pci_dev *dev, unsigned bar)
|
|
{
|
|
if (bar >= DEVICE_COUNT_RESOURCE)
|
|
return 0;
|
|
|
|
return dev->resource[bar].start;
|
|
}
|
|
|
|
|
|
size_t pci_resource_len(struct pci_dev *dev, unsigned bar)
|
|
{
|
|
size_t start = pci_resource_start(dev, bar);
|
|
|
|
if (!start)
|
|
return 0;
|
|
|
|
return (dev->resource[bar].end - start) + 1;
|
|
}
|
|
|
|
|
|
unsigned int pci_resource_flags(struct pci_dev *dev, unsigned bar)
|
|
{
|
|
if (bar >= DEVICE_COUNT_RESOURCE)
|
|
return 0;
|
|
|
|
return dev->resource[bar].flags;
|
|
}
|
|
|
|
|
|
int pci_bus_read_config_byte(struct pci_bus *bus, unsigned int, int where, u8 *val)
|
|
{
|
|
Pci_driver *drv = (Pci_driver *)bus;
|
|
drv->config_read(where, val);
|
|
dde_kit_log(DEBUG_PCI, "READ %p: where: %x val: %x", drv, where, *val);
|
|
return 0;
|
|
}
|
|
|
|
|
|
int pci_bus_read_config_word(struct pci_bus *bus, unsigned int, int where, u16 *val)
|
|
{
|
|
Pci_driver *drv = (Pci_driver *)bus;
|
|
drv->config_read(where, val);
|
|
dde_kit_log(DEBUG_PCI, "READ %p: where: %x val: %x", drv, where, *val);
|
|
return 0;
|
|
}
|
|
|
|
|
|
int pci_bus_write_config_word(struct pci_bus *bus, unsigned int, int where, u16 val)
|
|
{
|
|
Pci_driver *drv = (Pci_driver *)bus;
|
|
dde_kit_log(DEBUG_PCI, "WRITE %p: where: %x val: %x", drv, where, val);
|
|
drv->config_write(where, val);
|
|
return 0;
|
|
}
|
|
|
|
|
|
int pci_bus_write_config_byte(struct pci_bus *bus, unsigned int, int where, u8 val)
|
|
{
|
|
Pci_driver *drv = (Pci_driver *)bus;
|
|
dde_kit_log(DEBUG_PCI, "WRITE %p: where: %x val: %x", drv, where, val);
|
|
drv->config_write(where, val);
|
|
return 0;
|
|
}
|
|
|
|
|
|
const char *pci_name(const struct pci_dev *pdev)
|
|
{
|
|
/* simply return driver name */
|
|
return "dummy";
|
|
}
|
|
|
|
|
|
void Ram_object::free() { Genode::env()->ram_session()->free(ram_cap()); }
|
|
|
|
|
|
void Dma_object::free() { pci.free_dma_buffer(ram_cap()); }
|
|
|
|
|
|
Genode::Ram_dataspace_capability
|
|
Backend_memory::alloc(Genode::addr_t size, Genode::Cache_attribute cached)
|
|
{
|
|
using namespace Genode;
|
|
|
|
Memory_object_base *o;
|
|
Genode::Ram_dataspace_capability cap;
|
|
if (cached == CACHED) {
|
|
cap = env()->ram_session()->alloc(size);
|
|
o = new (env()->heap()) Ram_object(cap);
|
|
} else {
|
|
cap = pci.alloc_dma_buffer(size);
|
|
o = new (env()->heap()) Dma_object(cap);
|
|
}
|
|
|
|
memory_pool.insert(o);
|
|
return cap;
|
|
}
|
|
|
|
|
|
void Backend_memory::free(Genode::Ram_dataspace_capability cap)
|
|
{
|
|
using namespace Genode;
|
|
|
|
Memory_object_base *o = memory_pool.lookup_and_lock(cap);
|
|
if (!o)
|
|
return;
|
|
|
|
o->free();
|
|
memory_pool.remove_locked(o);
|
|
destroy(env()->heap(), o);
|
|
}
|
|
|
|
|
|
/*****************************************
|
|
** Platform specific irq cap discovery **
|
|
*****************************************/
|
|
|
|
Genode::Irq_session_capability platform_irq_activate(int irq)
|
|
{
|
|
return Pci_driver::irq_cap(irq);
|
|
}
|