b1c4ba4ab6
Due to the ABI we are using we have to use the earm architecture moniker for the build system to behave correctly. This involves then some headers to move around. There is also a few related Makefile updates as well as minor source code corrections.
480 lines
10 KiB
C
480 lines
10 KiB
C
/*
|
|
amddev.c
|
|
|
|
Driver for the AMD Device Exclusion Vector (DEV)
|
|
*/
|
|
|
|
#include <minix/driver.h>
|
|
#include <minix/config.h>
|
|
#include <minix/type.h>
|
|
|
|
#include <errno.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
#include <machine/vm.h>
|
|
#include <signal.h>
|
|
#include <minix/com.h>
|
|
#include <minix/const.h>
|
|
#include <minix/ipc.h>
|
|
#include <minix/syslib.h>
|
|
#include <minix/sysutil.h>
|
|
#include <minix/endpoint.h>
|
|
#include <machine/pci.h>
|
|
|
|
/* Offsets from capability pointer */
|
|
#define DEV_OP 4 /* Selects control/status register to access */
|
|
#define DEV_OP_FUNC_SHIFT 8 /* Function part in OP reg. */
|
|
#define DEV_DATA 8 /* Read/write to access reg. selected */
|
|
|
|
/* Functions */
|
|
#define DEVF_BASE_LO 0
|
|
#define DEVF_BASE_HI 1
|
|
#define DEVF_MAP 2
|
|
#define DEVF_CAP 3
|
|
#define DEVF_CAP_MAPS_MASK 0x00ff0000
|
|
#define DEVF_CAP_MAPS_SHIFT 16
|
|
#define DEVF_CAP_DOMS_MASK 0x0000ff00
|
|
#define DEVF_CAP_DOMS_SHIFT 8
|
|
#define DEVF_CAP_REV_MASK 0x000000ff
|
|
#define DEVF_CAP_REV_SHIFT 0
|
|
#define DEVF_CR 4
|
|
#define DEVF_ERR_STATUS 5
|
|
#define DEVF_ERR_ADDR_LO 6
|
|
#define DEVF_ERR_ADDR_HI 7
|
|
|
|
static int dev_devind;
|
|
static u8_t dev_capptr;
|
|
static u8_t *table;
|
|
|
|
static int find_dev(int *devindp, u8_t *capaddrp);
|
|
static u32_t read_reg(int function, int index);
|
|
static void write_reg(int function, int index, u32_t value);
|
|
static void init_domain(int index);
|
|
static void init_map(unsigned int ix);
|
|
static int do_add4pci(const message *m);
|
|
static void add_range(phys_bytes busaddr, phys_bytes size);
|
|
#if 0
|
|
static void del_range(phys_bytes busaddr, phys_bytes size);
|
|
static void sef_cb_signal_handler(int signo);
|
|
#endif
|
|
static void report_exceptions(void);
|
|
|
|
/* SEF functions and variables. */
|
|
static void sef_local_startup(void);
|
|
static int sef_cb_init_fresh(int type, sef_init_info_t *info);
|
|
|
|
int main(void)
|
|
{
|
|
int r;
|
|
message m;
|
|
int ipc_status;
|
|
|
|
/* SEF local startup. */
|
|
sef_local_startup();
|
|
|
|
for(;;)
|
|
{
|
|
report_exceptions();
|
|
|
|
r= driver_receive(ANY, &m, &ipc_status);
|
|
if (r != OK)
|
|
panic("driver_receive failed: %d", r);
|
|
if (m.m_type == IOMMU_MAP) {
|
|
r= do_add4pci(&m);
|
|
m.m_type= r;
|
|
send(m.m_source, &m);
|
|
continue;
|
|
}
|
|
printf("amddev: got message from %d\n", m.m_source);
|
|
}
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* sef_local_startup *
|
|
*===========================================================================*/
|
|
static void sef_local_startup()
|
|
{
|
|
/* Register init callbacks. */
|
|
sef_setcb_init_fresh(sef_cb_init_fresh);
|
|
sef_setcb_init_lu(sef_cb_init_fresh);
|
|
sef_setcb_init_restart(sef_cb_init_fresh);
|
|
|
|
/* Register live update callbacks. */
|
|
sef_setcb_lu_prepare(sef_cb_lu_prepare_always_ready);
|
|
sef_setcb_lu_state_isvalid(sef_cb_lu_state_isvalid_standard);
|
|
|
|
#if 0
|
|
/* Register signal callbacks. */
|
|
sef_setcb_signal_handler(sef_cb_signal_handler);
|
|
#endif
|
|
|
|
/* Let SEF perform startup. */
|
|
sef_startup();
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* sef_cb_init_fresh *
|
|
*===========================================================================*/
|
|
static int sef_cb_init_fresh(int UNUSED(type), sef_init_info_t *UNUSED(info))
|
|
{
|
|
/* Initialize the amddev driver. */
|
|
int r, n_maps, n_domains, revision;
|
|
u16_t flags;
|
|
u32_t bits;
|
|
|
|
printf("amddev: starting\n");
|
|
|
|
r= find_dev(&dev_devind, &dev_capptr);
|
|
if (!r)
|
|
return r;
|
|
flags= pci_attr_r16(dev_devind, dev_capptr+CAP_SD_INFO);
|
|
printf("amddev`init: flags = 0x%x\n", flags);
|
|
|
|
bits= read_reg(DEVF_CAP, 0);
|
|
n_maps= ((bits & DEVF_CAP_MAPS_MASK) >> DEVF_CAP_MAPS_SHIFT);
|
|
n_domains= ((bits & DEVF_CAP_DOMS_MASK) >> DEVF_CAP_DOMS_SHIFT);
|
|
revision= ((bits & DEVF_CAP_REV_MASK) >> DEVF_CAP_REV_SHIFT);
|
|
printf("amddev`init: DEVF_CAP = 0x%x (%d maps, %d domains, rev 0x%x)\n",
|
|
bits, n_maps, n_domains, revision);
|
|
|
|
printf("status = 0x%x, addr-lo = 0x%x, addr-hi = 0x%x\n",
|
|
read_reg(DEVF_ERR_STATUS, 0),
|
|
read_reg(DEVF_ERR_ADDR_LO, 0),
|
|
read_reg(DEVF_ERR_ADDR_HI, 0));
|
|
|
|
init_domain(0);
|
|
init_map(0);
|
|
#if 0
|
|
init_domain(1);
|
|
#endif
|
|
|
|
write_reg(DEVF_CR, 0, 0x10 | 0x8 | 0x4 | 1);
|
|
|
|
printf("after write: DEVF_CR: 0x%x\n", read_reg(DEVF_CR, 0));
|
|
|
|
return(OK);
|
|
}
|
|
|
|
|
|
#if 0
|
|
/*===========================================================================*
|
|
* sef_cb_signal_handler *
|
|
*===========================================================================*/
|
|
static void sef_cb_signal_handler(int signo)
|
|
{
|
|
int r;
|
|
endpoint_t proc_e;
|
|
phys_bytes base, size;
|
|
|
|
/* Only check for termination signal, ignore anything else. */
|
|
if (signo != SIGTERM) return;
|
|
|
|
for (;;)
|
|
{
|
|
r= vm_getdma(&proc_e, &base, &size);
|
|
if (r == -1)
|
|
{
|
|
if (errno != -EAGAIN)
|
|
{
|
|
printf(
|
|
"amddev: vm_getdma failed: %d\n",
|
|
errno);
|
|
}
|
|
break;
|
|
}
|
|
|
|
printf(
|
|
"amddev: deleting 0x%lx@0x%lx for proc %d\n",
|
|
size, base, proc_e);
|
|
del_range(base, size);
|
|
r= vm_deldma(proc_e, base, size);
|
|
if (r == -1)
|
|
{
|
|
printf("amddev: vm_deldma failed: %d\n",
|
|
errno);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/* Returns 0 if no device found, or 1 if a device is found. */
|
|
static int find_dev(devindp, capaddrp)
|
|
int *devindp;
|
|
u8_t *capaddrp;
|
|
{
|
|
int r, devind, first;
|
|
u8_t capptr, type, next, subtype;
|
|
u16_t vid, did, status;
|
|
|
|
pci_init();
|
|
|
|
first= 1;
|
|
for(;;)
|
|
{
|
|
if (first)
|
|
{
|
|
first= 0;
|
|
r= pci_first_dev(&devind, &vid, &did);
|
|
if (!r)
|
|
{
|
|
printf("amddev`find_dev: no first dev\n");
|
|
return 0;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
r= pci_next_dev(&devind, &vid, &did);
|
|
if (!r)
|
|
{
|
|
printf("amddev`find_dev: no next dev\n");
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
printf("amddev`find_dev: got devind %d, vid 0x%x, did 0x%x\n",
|
|
devind, vid, did);
|
|
|
|
/* Check capabilities bit in the device status register */
|
|
status= pci_attr_r16(devind, PCI_SR);
|
|
if (!(status & PSR_CAPPTR))
|
|
continue;
|
|
|
|
capptr= (pci_attr_r8(devind, PCI_CAPPTR) & PCI_CP_MASK);
|
|
while (capptr != 0)
|
|
{
|
|
type = pci_attr_r8(devind, capptr+CAP_TYPE);
|
|
next= (pci_attr_r8(devind, capptr+CAP_NEXT) &
|
|
PCI_CP_MASK);
|
|
if (type == CAP_T_SECURE_DEV)
|
|
{
|
|
printf(
|
|
"amddev`find_dev: found secure device\n");
|
|
subtype= (pci_attr_r8(devind, capptr+
|
|
CAP_SD_INFO) & CAP_SD_SUBTYPE_MASK);
|
|
if (subtype == CAP_T_SD_DEV)
|
|
{
|
|
printf("amddev`find_dev: AMD DEV\n");
|
|
pci_reserve(devind);
|
|
*devindp= devind;
|
|
*capaddrp= capptr;
|
|
return 1;
|
|
}
|
|
}
|
|
capptr= next;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static u32_t read_reg(int function, int index)
|
|
{
|
|
pci_attr_w32(dev_devind, dev_capptr + DEV_OP, ((function <<
|
|
DEV_OP_FUNC_SHIFT) | index));
|
|
return pci_attr_r32(dev_devind, dev_capptr + DEV_DATA);
|
|
}
|
|
|
|
static void write_reg(int function, int index, u32_t value)
|
|
{
|
|
pci_attr_w32(dev_devind, dev_capptr + DEV_OP, ((function <<
|
|
DEV_OP_FUNC_SHIFT) | index));
|
|
pci_attr_w32(dev_devind, dev_capptr + DEV_DATA, value);
|
|
}
|
|
|
|
static void init_domain(int index)
|
|
{
|
|
size_t size, memsize;
|
|
phys_bytes busaddr;
|
|
|
|
size= 0x100000 / 8;
|
|
table= alloc_contig(size, AC_ALIGN4K, &busaddr);
|
|
if (table == NULL)
|
|
panic("malloc failed");
|
|
if (index == 0)
|
|
{
|
|
memset(table, 0, size);
|
|
memsize= 0x37000 / 8;
|
|
printf("memsize = 0x%x / 8\n", memsize*8);
|
|
memset(table, 0xff, memsize);
|
|
}
|
|
else
|
|
{
|
|
memset(table, 0xff, size);
|
|
memset(table, 0x00, size);
|
|
}
|
|
|
|
printf("init_domain: busaddr = 0x%lx\n", busaddr);
|
|
|
|
write_reg(DEVF_BASE_HI, index, 0);
|
|
write_reg(DEVF_BASE_LO, index, busaddr | 3);
|
|
|
|
printf("after write: DEVF_BASE_LO: 0x%x\n",
|
|
read_reg(DEVF_BASE_LO, index));
|
|
}
|
|
|
|
static void init_map(unsigned int ix)
|
|
{
|
|
u32_t v, dom, busno, unit0, unit1;
|
|
|
|
dom= 1;
|
|
busno= 7;
|
|
unit1= 9;
|
|
unit0= 9;
|
|
v= (dom << 26) | (dom << 20) | (busno << 12) |
|
|
(0 << 11) | (unit1 << 6) |
|
|
(0 << 5) | (unit0 << 0);
|
|
write_reg(DEVF_MAP, ix, v);
|
|
|
|
printf("after write: DEVF_MAP: 0x%x\n", read_reg(DEVF_MAP, ix));
|
|
}
|
|
|
|
#if 0
|
|
static int do_add(message *m)
|
|
{
|
|
int r;
|
|
endpoint_t proc;
|
|
vir_bytes start;
|
|
size_t size;
|
|
phys_bytes busaddr;
|
|
|
|
proc= m->m_source;
|
|
start= m->m2_l1;
|
|
size= m->m2_l2;
|
|
|
|
#if 0
|
|
printf("amddev`do_add: got request for 0x%x@0x%x from %d\n",
|
|
size, start, proc);
|
|
#endif
|
|
|
|
if (start % PAGE_SIZE)
|
|
{
|
|
printf("amddev`do_add: bad start 0x%x from proc %d\n",
|
|
start, proc);
|
|
return EINVAL;
|
|
}
|
|
if (size % PAGE_SIZE)
|
|
{
|
|
printf("amddev`do_add: bad size 0x%x from proc %d\n",
|
|
size, proc);
|
|
return EINVAL;
|
|
}
|
|
r= sys_umap_remote(proc, SELF, VM_D, (vir_bytes)start, size, &busaddr);
|
|
if (r != OK)
|
|
{
|
|
printf("amddev`do_add: umap failed for 0x%x@0x%x, proc %d\n",
|
|
size, start, proc);
|
|
return r;
|
|
}
|
|
add_range(busaddr, size);
|
|
|
|
}
|
|
#endif
|
|
|
|
|
|
|
|
static int do_add4pci(const message *m)
|
|
{
|
|
int r, pci_bus, pci_dev, pci_func;
|
|
endpoint_t proc;
|
|
vir_bytes start;
|
|
size_t size;
|
|
phys_bytes busaddr;
|
|
|
|
proc= m->m_source;
|
|
start= m->m2_l1;
|
|
size= m->m2_l2;
|
|
pci_bus= m->m1_i1;
|
|
pci_dev= m->m1_i2;
|
|
pci_func= m->m1_i3;
|
|
|
|
printf(
|
|
"amddev`do_add4pci: got request for 0x%x@0x%lx from %d for pci dev %u.%u.%u\n",
|
|
size, start, proc, pci_bus, pci_dev, pci_func);
|
|
|
|
if (start % PAGE_SIZE)
|
|
{
|
|
printf("amddev`do_add4pci: bad start 0x%lx from proc %d\n",
|
|
start, proc);
|
|
return EINVAL;
|
|
}
|
|
if (size % PAGE_SIZE)
|
|
{
|
|
printf("amddev`do_add4pci: bad size 0x%x from proc %d\n",
|
|
size, proc);
|
|
return EINVAL;
|
|
}
|
|
|
|
printf("amddev`do_add4pci: should check with PCI\n");
|
|
|
|
r= sys_umap_remote(proc, SELF, VM_D, (vir_bytes)start, size, &busaddr);
|
|
if (r != OK)
|
|
{
|
|
printf(
|
|
"amddev`do_add4pci: umap failed for 0x%x@0x%lx, proc %d: %d\n",
|
|
size, start, proc, r);
|
|
return r;
|
|
}
|
|
|
|
#if 0
|
|
r= vm_adddma(proc, start, size);
|
|
if (r != 0)
|
|
{
|
|
r= -errno;
|
|
printf("amddev`do_add4pci: vm_adddma failed for 0x%x@0x%lx, "
|
|
"proc %d: %d\n", size, start, proc, r);
|
|
return r;
|
|
}
|
|
#endif
|
|
|
|
add_range(busaddr, size);
|
|
|
|
return OK;
|
|
}
|
|
|
|
|
|
static void add_range(phys_bytes busaddr, phys_bytes size)
|
|
{
|
|
phys_bytes o;
|
|
|
|
#if 0
|
|
printf("add_range: mapping 0x%x@0x%x\n", size, busaddr);
|
|
#endif
|
|
|
|
for (o= 0; o<size; o += PAGE_SIZE)
|
|
{
|
|
u32_t bit= (busaddr+o)/PAGE_SIZE;
|
|
table[bit/8] &= ~(1U << (bit % 8));
|
|
}
|
|
}
|
|
|
|
#if 0
|
|
static void del_range(phys_bytes busaddr, phys_bytes size)
|
|
{
|
|
phys_bytes o;
|
|
|
|
#if 0
|
|
printf("del_range: mapping 0x%x@0x%x\n", size, busaddr);
|
|
#endif
|
|
|
|
for (o= 0; o<size; o += PAGE_SIZE)
|
|
{
|
|
u32_t bit= (busaddr+o)/PAGE_SIZE;
|
|
table[bit/8] |= (1 << (bit % 8));
|
|
}
|
|
}
|
|
#endif
|
|
|
|
static void report_exceptions(void)
|
|
{
|
|
u32_t status;
|
|
|
|
status= read_reg(DEVF_ERR_STATUS, 0);
|
|
if (!(status & 0x80000000))
|
|
return;
|
|
printf("amddev: status = 0x%x, addr-lo = 0x%x, addr-hi = 0x%x\n",
|
|
status, read_reg(DEVF_ERR_ADDR_LO, 0),
|
|
read_reg(DEVF_ERR_ADDR_HI, 0));
|
|
write_reg(DEVF_ERR_STATUS, 0, 0);
|
|
}
|