#include <lib/libsa/stand.h>
#include "boot.h"
volatile u_char *PCI_mem = (u_char *)0xc0000000;
volatile u_char *ISA_io = (u_char *)0x80000000;
volatile u_char *ISA_mem = (u_char *)0xc0000000;
static int dcache_line_size = 32;
void
outb(int port, u_char val)
{
ISA_io[port] = val;
}
void
outw(int port, u_short val)
{
outb(port, val >> 8);
outb(port + 1, val);
}
u_char
inb(int port)
{
return ISA_io[port];
}
u_short
inw(int port)
{
return *((volatile uint16_t *)(&ISA_io[port]));
}
u_short
inwrb(int port)
{
return le16toh(*((volatile uint16_t *)(&ISA_io[port])));
}
void
writeb(u_long addr, u_char val)
{
PCI_mem[addr] = val;
}
void
writel(u_long addr, u_long val)
{
*((u_long *)&PCI_mem[addr]) = htole32(val);
}
u_char
readb(u_long addr)
{
return PCI_mem[addr];
}
u_short
readw(u_long addr)
{
return le16toh(*((u_short *)&PCI_mem[addr]));
}
u_long
readl(u_long addr)
{
return le32toh(*((u_long *)&PCI_mem[addr]));
}
u_long
local_to_PCI(u_long addr)
{
return (addr & 0x7FFFFFFF) | 0x80000000;
}
void
_wbinv(uint32_t adr, uint32_t siz)
{
uint32_t bnd;
asm volatile("eieio" ::: "memory");
for (bnd = adr + siz; adr < bnd; adr += dcache_line_size)
asm volatile("dcbf 0,%0" :: "r"(adr) : "memory");
asm volatile("sync" ::: "memory");
}
void
_inv(uint32_t adr, uint32_t siz)
{
uint32_t bnd, off;
off = adr & (dcache_line_size - 1);
adr -= off;
siz += off;
asm volatile("eieio" ::: "memory");
if (off != 0) {
asm volatile("dcbf 0,%0" :: "r"(adr) : "memory");
if (siz < dcache_line_size)
goto done;
adr += dcache_line_size;
siz -= dcache_line_size;
}
bnd = adr + siz;
off = bnd & (dcache_line_size - 1);
if (off != 0) {
asm volatile("dcbf 0,%0" :: "r"(bnd) : "memory");
if (siz < dcache_line_size)
goto done;
siz -= off;
}
for (bnd = adr + siz; adr < bnd; adr += dcache_line_size) {
asm volatile("dcbi 0,%0" :: "r"(adr) : "memory");
}
done:
asm volatile("sync" ::: "memory");
}