HelenOS sources
This source file includes following definitions.
- pci_sabre_init
- pci_psycho_init
- obio_enable_interrupt
- obio_clear_interrupt
- pci_init
- pci_enable_interrupt
- pci_clear_interrupt
#include <arch/drivers/pci.h>
#include <genarch/ofw/ofw_tree.h>
#include <genarch/ofw/upa.h>
#include <arch/trap/interrupt.h>
#include <mm/km.h>
#include <stdlib.h>
#include <typedefs.h>
#include <assert.h>
#include <log.h>
#include <str.h>
#include <arch/asm.h>
#include <sysinfo/sysinfo.h>
#define SABRE_INTERNAL_REG 0
#define PSYCHO_INTERNAL_REG 2
#define OBIO_IMR_BASE 0x200
#define OBIO_IMR(ino) (OBIO_IMR_BASE + ((ino) & INO_MASK))
#define OBIO_CIR_BASE 0x300
#define OBIO_CIR(ino) (OBIO_CIR_BASE + ((ino) & INO_MASK))
static void obio_enable_interrupt(pci_t *, int);
static void obio_clear_interrupt(pci_t *, int);
static pci_t *pci_sabre_init(ofw_tree_node_t *);
static pci_t *pci_psycho_init(ofw_tree_node_t *);
static pci_operations_t pci_sabre_ops = {
.enable_interrupt = obio_enable_interrupt,
.clear_interrupt = obio_clear_interrupt
};
static pci_operations_t pci_psycho_ops = {
.enable_interrupt = obio_enable_interrupt,
.clear_interrupt = obio_clear_interrupt
};
pci_t *pci_sabre_init(ofw_tree_node_t *node)
{
pci_t *pci;
ofw_tree_property_t *prop;
prop = ofw_tree_getprop(node, "reg");
if (!prop || !prop->value)
return NULL;
ofw_upa_reg_t *reg = prop->value;
size_t regs = prop->size / sizeof(ofw_upa_reg_t);
if (regs < SABRE_INTERNAL_REG + 1)
return NULL;
uintptr_t paddr;
if (!ofw_upa_apply_ranges(node->parent, ®[SABRE_INTERNAL_REG],
&paddr))
return NULL;
pci = (pci_t *) malloc(sizeof(pci_t));
if (!pci)
return NULL;
pci->model = PCI_SABRE;
pci->op = &pci_sabre_ops;
pci->reg = (uint64_t *) km_map(paddr, reg[SABRE_INTERNAL_REG].size,
KM_NATURAL_ALIGNMENT, PAGE_WRITE | PAGE_NOT_CACHEABLE);
return pci;
}
pci_t *pci_psycho_init(ofw_tree_node_t *node)
{
pci_t *pci;
ofw_tree_property_t *prop;
prop = ofw_tree_getprop(node, "reg");
if (!prop || !prop->value)
return NULL;
ofw_upa_reg_t *reg = prop->value;
size_t regs = prop->size / sizeof(ofw_upa_reg_t);
if (regs < PSYCHO_INTERNAL_REG + 1)
return NULL;
uintptr_t paddr;
if (!ofw_upa_apply_ranges(node->parent, ®[PSYCHO_INTERNAL_REG],
&paddr))
return NULL;
pci = (pci_t *) malloc(sizeof(pci_t));
if (!pci)
return NULL;
pci->model = PCI_PSYCHO;
pci->op = &pci_psycho_ops;
pci->reg = (uint64_t *) km_map(paddr, reg[PSYCHO_INTERNAL_REG].size,
KM_NATURAL_ALIGNMENT, PAGE_WRITE | PAGE_NOT_CACHEABLE);
return pci;
}
void obio_enable_interrupt(pci_t *pci, int inr)
{
pci->reg[OBIO_IMR(inr & INO_MASK)] |= IMAP_V_MASK;
}
void obio_clear_interrupt(pci_t *pci, int inr)
{
pci->reg[OBIO_CIR(inr & INO_MASK)] = 0;
}
pci_t *pci_init(ofw_tree_node_t *node)
{
ofw_tree_property_t *prop;
assert(str_cmp(ofw_tree_node_name(node), "pci") == 0);
prop = ofw_tree_getprop(node, "model");
if (!prop || !prop->value)
return NULL;
if (str_cmp(prop->value, "SUNW,sabre") == 0) {
return pci_sabre_init(node);
} else if (str_cmp(prop->value, "SUNW,psycho") == 0) {
return pci_psycho_init(node);
} else {
log(LF_ARCH, LVL_WARN, "Unsupported PCI controller model (%s).",
(char *) prop->value);
}
return NULL;
}
void pci_enable_interrupt(pci_t *pci, int inr)
{
assert(pci->op && pci->op->enable_interrupt);
pci->op->enable_interrupt(pci, inr);
}
void pci_clear_interrupt(void *pcip, int inr)
{
pci_t *pci = (pci_t *)pcip;
assert(pci->op && pci->op->clear_interrupt);
pci->op->clear_interrupt(pci, inr);
}
HelenOS homepage, sources at GitHub