|
@@ -1,128 +0,0 @@
|
|
|
-/*
|
|
|
- * Copyright (C) 2000 David J. Mckay (david.mckay@st.com)
|
|
|
- *
|
|
|
- * May be copied or modified under the terms of the GNU General Public
|
|
|
- * License. See linux/COPYING for more information.
|
|
|
- *
|
|
|
- * This file contains the I/O routines for use on the overdrive board
|
|
|
- *
|
|
|
- */
|
|
|
-
|
|
|
-#include <linux/kernel.h>
|
|
|
-#include <linux/types.h>
|
|
|
-#include <linux/delay.h>
|
|
|
-#include <linux/module.h>
|
|
|
-#include <asm/system.h>
|
|
|
-#include <asm/processor.h>
|
|
|
-#include <asm/io.h>
|
|
|
-
|
|
|
-/* Now for the string version of these functions */
|
|
|
-void outsb(unsigned long port, const void *addr, unsigned long count)
|
|
|
-{
|
|
|
- int i;
|
|
|
- unsigned char *p = (unsigned char *) addr;
|
|
|
-
|
|
|
- for (i = 0; i < count; i++, p++) {
|
|
|
- outb(*p, port);
|
|
|
- }
|
|
|
-}
|
|
|
-EXPORT_SYMBOL(outsb);
|
|
|
-
|
|
|
-void insb(unsigned long port, void *addr, unsigned long count)
|
|
|
-{
|
|
|
- int i;
|
|
|
- unsigned char *p = (unsigned char *) addr;
|
|
|
-
|
|
|
- for (i = 0; i < count; i++, p++) {
|
|
|
- *p = inb(port);
|
|
|
- }
|
|
|
-}
|
|
|
-EXPORT_SYMBOL(insb);
|
|
|
-
|
|
|
-/* For the 16 and 32 bit string functions, we have to worry about alignment.
|
|
|
- * The SH does not do unaligned accesses, so we have to read as bytes and
|
|
|
- * then write as a word or dword.
|
|
|
- * This can be optimised a lot more, especially in the case where the data
|
|
|
- * is aligned
|
|
|
- */
|
|
|
-
|
|
|
-void outsw(unsigned long port, const void *addr, unsigned long count)
|
|
|
-{
|
|
|
- int i;
|
|
|
- unsigned short tmp;
|
|
|
- unsigned char *p = (unsigned char *) addr;
|
|
|
-
|
|
|
- for (i = 0; i < count; i++, p += 2) {
|
|
|
- tmp = (*p) | ((*(p + 1)) << 8);
|
|
|
- outw(tmp, port);
|
|
|
- }
|
|
|
-}
|
|
|
-EXPORT_SYMBOL(outsw);
|
|
|
-
|
|
|
-void insw(unsigned long port, void *addr, unsigned long count)
|
|
|
-{
|
|
|
- int i;
|
|
|
- unsigned short tmp;
|
|
|
- unsigned char *p = (unsigned char *) addr;
|
|
|
-
|
|
|
- for (i = 0; i < count; i++, p += 2) {
|
|
|
- tmp = inw(port);
|
|
|
- p[0] = tmp & 0xff;
|
|
|
- p[1] = (tmp >> 8) & 0xff;
|
|
|
- }
|
|
|
-}
|
|
|
-EXPORT_SYMBOL(insw);
|
|
|
-
|
|
|
-void outsl(unsigned long port, const void *addr, unsigned long count)
|
|
|
-{
|
|
|
- int i;
|
|
|
- unsigned tmp;
|
|
|
- unsigned char *p = (unsigned char *) addr;
|
|
|
-
|
|
|
- for (i = 0; i < count; i++, p += 4) {
|
|
|
- tmp = (*p) | ((*(p + 1)) << 8) | ((*(p + 2)) << 16) |
|
|
|
- ((*(p + 3)) << 24);
|
|
|
- outl(tmp, port);
|
|
|
- }
|
|
|
-}
|
|
|
-EXPORT_SYMBOL(outsl);
|
|
|
-
|
|
|
-void insl(unsigned long port, void *addr, unsigned long count)
|
|
|
-{
|
|
|
- int i;
|
|
|
- unsigned tmp;
|
|
|
- unsigned char *p = (unsigned char *) addr;
|
|
|
-
|
|
|
- for (i = 0; i < count; i++, p += 4) {
|
|
|
- tmp = inl(port);
|
|
|
- p[0] = tmp & 0xff;
|
|
|
- p[1] = (tmp >> 8) & 0xff;
|
|
|
- p[2] = (tmp >> 16) & 0xff;
|
|
|
- p[3] = (tmp >> 24) & 0xff;
|
|
|
-
|
|
|
- }
|
|
|
-}
|
|
|
-EXPORT_SYMBOL(insl);
|
|
|
-
|
|
|
-void memcpy_toio(void __iomem *to, const void *from, long count)
|
|
|
-{
|
|
|
- unsigned char *p = (unsigned char *) from;
|
|
|
-
|
|
|
- while (count) {
|
|
|
- count--;
|
|
|
- writeb(*p++, to++);
|
|
|
- }
|
|
|
-}
|
|
|
-EXPORT_SYMBOL(memcpy_toio);
|
|
|
-
|
|
|
-void memcpy_fromio(void *to, void __iomem *from, long count)
|
|
|
-{
|
|
|
- int i;
|
|
|
- unsigned char *p = (unsigned char *) to;
|
|
|
-
|
|
|
- for (i = 0; i < count; i++) {
|
|
|
- p[i] = readb(from);
|
|
|
- from++;
|
|
|
- }
|
|
|
-}
|
|
|
-EXPORT_SYMBOL(memcpy_fromio);
|