Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

/*

 * 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);