Module Name: src
Committed By: kiyohara
Date: Thu Oct 14 05:52:01 UTC 2010
Modified Files:
src/sys/arch/bebox/stand/boot: boot.h io.c
Log Message:
Add PCI_mem and many access/cache-ope functions.
+ inw/inwrb/writeb/writel/readb/readw/readl.
+ _wbinv/_inv.
To generate a diff of this commit:
cvs rdiff -u -r1.7 -r1.8 src/sys/arch/bebox/stand/boot/boot.h
cvs rdiff -u -r1.6 -r1.7 src/sys/arch/bebox/stand/boot/io.c
Please note that diffs are not public domain; they are subject to the
copyright notices on the relevant files.
Modified files:
Index: src/sys/arch/bebox/stand/boot/boot.h
diff -u src/sys/arch/bebox/stand/boot/boot.h:1.7 src/sys/arch/bebox/stand/boot/boot.h:1.8
--- src/sys/arch/bebox/stand/boot/boot.h:1.7 Mon May 26 16:28:39 2008
+++ src/sys/arch/bebox/stand/boot/boot.h Thu Oct 14 05:52:01 2010
@@ -1,4 +1,4 @@
-/* $NetBSD: boot.h,v 1.7 2008/05/26 16:28:39 kiyohara Exp $ */
+/* $NetBSD: boot.h,v 1.8 2010/10/14 05:52:01 kiyohara Exp $ */
#define TICKS_PER_SEC (33000000 / 4) /* 33MHz */
#define NS_PER_TICK (1000000000 / TICKS_PER_SEC)
@@ -47,10 +47,19 @@
/*
* io
*/
-void outb(int, char);
+void outb(int, u_char);
void outw(int, u_short);
u_char inb(int);
+u_short inw(int);
+u_short inwrb(int);
+void writeb(u_long, u_char);
+void writel(u_long, u_long);
+u_char readb(u_long);
+u_short readw(u_long);
+u_long readl(u_long);
u_long local_to_PCI(u_long);
+void _wbinv(uint32_t, uint32_t);
+void _inv(uint32_t, uint32_t);
/*
* kbd
Index: src/sys/arch/bebox/stand/boot/io.c
diff -u src/sys/arch/bebox/stand/boot/io.c:1.6 src/sys/arch/bebox/stand/boot/io.c:1.7
--- src/sys/arch/bebox/stand/boot/io.c:1.6 Mon May 26 16:28:39 2008
+++ src/sys/arch/bebox/stand/boot/io.c Thu Oct 14 05:52:01 2010
@@ -1,4 +1,4 @@
-/* $NetBSD: io.c,v 1.6 2008/05/26 16:28:39 kiyohara Exp $ */
+/* $NetBSD: io.c,v 1.7 2010/10/14 05:52:01 kiyohara Exp $ */
/*-
* Copyright (C) 1995-1997 Gary Thomas ([email protected])
@@ -35,11 +35,14 @@
#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;
+volatile u_char *ISA_mem = (u_char *)0xc0000000;
+
+static int dcache_line_size = 32;
void
-outb(int port, char val)
+outb(int port, u_char val)
{
ISA_io[port] = val;
@@ -60,9 +63,103 @@
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");
+ for (bnd = adr + siz; adr < bnd; adr += dcache_line_size)
+ asm volatile ("dcbf 0,%0" :: "r"(adr));
+ asm volatile ("sync");
+}
+
+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");
+ if (off != 0) {
+ /* wbinv() leading unaligned dcache line */
+ asm volatile ("dcbf 0,%0" :: "r"(adr));
+ 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) {
+ /* wbinv() trailing unaligned dcache line */
+ asm volatile ("dcbf 0,%0" :: "r"(bnd)); /* it's OK */
+ if (siz < dcache_line_size)
+ goto done;
+ siz -= off;
+ }
+ for (bnd = adr + siz; adr < bnd; adr += dcache_line_size) {
+ /* inv() intermediate dcache lines if ever */
+ asm volatile ("dcbi 0,%0" :: "r"(adr));
+ }
+ done:
+ asm volatile ("sync");
+}
