#include <dev/pci/amas.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <dev/pci/pcivar.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcidevs.h>
int amas_match(struct device*, void*, void*);
void amas_attach(struct device*, struct device*, void*);
#define AMAS_REG_BASE(node) (0x0040 + 0x08 * (node))
#define AMAS_REG_LIMIT(node) (0x0044 + 0x08 * (node))
#define AMAS_REG_EXTBASE(node) (0x0140 + 0x08 * (node))
#define AMAS_REG_EXTLIMIT(node) (0x0144 + 0x08 * (node))
#define AMAS_REG_BL_ADDR(reg) (((reg) >> 16) & 0xffff)
#define AMAS_REG_EBL_ADDR(ereg) ((ereg) & 0xff)
#define AMAS_REG_BL_SHIFT (24)
#define AMAS_REG_EBL_SHIFT (40)
#define AMAS_REG_BL_PGSHIFT (AMAS_REG_BL_SHIFT - PAGE_SHIFT)
#define AMAS_REG_EBL_PGSHIFT (AMAS_REG_EBL_SHIFT - PAGE_SHIFT)
#define AMAS_ADDR2PAGE_BASE(base, ebase) \
(((base) << AMAS_REG_BL_PGSHIFT) | ((ebase) << AMAS_REG_EBL_PGSHIFT))
#define AMAS_ADDR2PAGE_LIMIT(base, ebase) \
(((base + 1) << AMAS_REG_BL_PGSHIFT) | ((ebase) << AMAS_REG_EBL_PGSHIFT))
#define AMAS_DST_NODE(base, limit) ((limit) & 0x07)
#define AMAS_INTL_ENABLE(base, limit) (((base) >> 8) & 0x07)
#define AMAS_INTL_SELECTOR(base, limit) (((limit) >> 8) & 0x07)
#define AMAS_FAM_0Fh (0)
#define AMAS_FAM_10h (1)
#define AMAS_FAM_11h (2)
struct amas_feature_t {
int maxnodes;
int can_intl;
int has_extended_bl;
};
static const struct amas_feature_t amas_feature[] = {
{ 8, 1, 0 },
{ 8, 1, 1 },
{ 1, 0, 0 },
};
const struct cfattach amas_ca = {
sizeof(struct amas_softc),
amas_match,
amas_attach
};
struct cfdriver amas_cd = {
NULL,
"amas",
DV_DULL
};
const struct pci_matchid amas_devices[] = {
{ PCI_VENDOR_AMD, PCI_PRODUCT_AMD_0F_ADDR },
{ PCI_VENDOR_AMD, PCI_PRODUCT_AMD_10_ADDR },
{ PCI_VENDOR_AMD, PCI_PRODUCT_AMD_11_ADDR },
};
int
amas_match(struct device *parent, void *match, void *aux)
{
struct pci_attach_args* pa = aux;
if (pci_matchbyid(pa, amas_devices, nitems(amas_devices)))
return 2;
return 0;
}
void
amas_attach(struct device *parent, struct device *self, void *aux)
{
struct pci_attach_args *pa = aux;
struct amas_softc *amas = (struct amas_softc*)self;
#ifdef DEBUG
paddr_t start_pg, end_pg;
int nodes, i;
#endif
amas->pa_tag = pa->pa_tag;
amas->pa_pc = pa->pa_pc;
switch (PCI_PRODUCT(pa->pa_id)) {
case PCI_PRODUCT_AMD_0F_ADDR:
amas->family = AMAS_FAM_0Fh;
break;
case PCI_PRODUCT_AMD_10_ADDR:
amas->family = AMAS_FAM_10h;
break;
case PCI_PRODUCT_AMD_11_ADDR:
amas->family = AMAS_FAM_11h;
break;
}
#ifdef DEBUG
nodes = amas_intl_nodes(amas);
printf(":");
if (nodes != 0) {
printf(" interleaved");
} else {
for (i = 0; i < AMAS_MAX_NODES; i++) {
amas_get_pagerange(amas, i, &start_pg, &end_pg);
if (!(start_pg == 0 && end_pg == 0))
printf(" [%#lx, %#lx]", start_pg, end_pg);
}
}
#endif
printf("\n");
return;
}
int
amas_intl_nodes(struct amas_softc *amas)
{
pcireg_t base_reg, limit_reg;
int mask;
if (!amas_feature[amas->family].can_intl)
return 0;
base_reg = pci_conf_read(amas->pa_pc, amas->pa_tag, AMAS_REG_BASE(0));
limit_reg = pci_conf_read(amas->pa_pc, amas->pa_tag, AMAS_REG_LIMIT(0));
mask = AMAS_INTL_ENABLE(base_reg, limit_reg);
return mask == 0 ? 0 : mask + 1;
}
void
amas_get_pagerange(struct amas_softc *amas, int node,
paddr_t *start_pg_idx, paddr_t *end_pg_idx)
{
pcireg_t base, ebase, limit, elimit;
paddr_t base_addr, ebase_addr, limit_addr, elimit_addr;
KASSERT(node >= 0 && node < AMAS_MAX_NODES);
if (node >= amas_feature[amas->family].maxnodes) {
*start_pg_idx = 0;
*end_pg_idx = 0;
return;
}
base = pci_conf_read(amas->pa_pc, amas->pa_tag,
AMAS_REG_BASE(node));
limit = pci_conf_read(amas->pa_pc, amas->pa_tag,
AMAS_REG_LIMIT(node));
base_addr = AMAS_REG_BL_ADDR(base);
limit_addr = AMAS_REG_BL_ADDR(limit);
ebase = 0;
elimit = 0;
ebase_addr = 0;
elimit_addr = 0;
#if 0
if (amas_feature[amas->family].has_extended_bl) {
ebase = pci_conf_read(amas->pa_pc, amas->pa_tag,
AMAS_REG_EXTBASE(node));
elimit = pci_conf_read(amas->pa_pc, amas->pa_tag,
AMAS_REG_EXTLIMIT(node));
ebase_addr = AMAS_REG_EBL_ADDR(ebase);
elimit_addr = AMAS_REG_EBL_ADDR(elimit);
}
#endif
if (ebase_addr > elimit_addr ||
(ebase_addr == elimit_addr && base_addr >= limit_addr)) {
*start_pg_idx = 0;
*end_pg_idx = 0;
return;
}
KASSERT(node == AMAS_DST_NODE(base, limit));
*start_pg_idx = AMAS_ADDR2PAGE_BASE(base_addr, ebase_addr);
*end_pg_idx = AMAS_ADDR2PAGE_LIMIT(limit_addr, elimit_addr);
return;
}