/* $NetBSD: simple_busfuncs.c,v 1.11 2012/02/12 16:34:06 matt Exp $ */

/*-
 * Copyright (c) 1999 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by Ignatios Souvatzis.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: simple_busfuncs.c,v 1.11 2012/02/12 16:34:06 matt Exp $");

/*
 * Do NOT use this standalone.
 * Instead define the stride (linear, not logarithmic!) in the enclosing
 * file (AMIGA_SIMPLE_BUS_STRIDE), then include this one.
 * If you want to use it only to provide the functions without creating the
 * method array, also define AMIGA_SIMPLE_BUS_NO_ARRAY
 */

#ifndef AMIGA_SIMPLE_BUS_STRIDE
Error AMIGA_SIMPLE_BUS_STRIDE not defined in __FILE__, line __LINE__ .
#endif

#include <sys/bus.h>
#include <sys/null.h>

#define MKN2(x,y) __CONCAT(x, y)
#define MKN1(x,y) MKN2(x, y)
#define oabs(n) MKN1(n, AMIGA_SIMPLE_BUS_STRIDE)

/* function declarations */

int oabs(bsm_)(bus_space_tag_t, bus_addr_t, bus_size_t, int,
        bus_space_handle_t *);

int oabs(bsms_)(bus_space_handle_t, bus_size_t, bus_size_t,
        bus_space_handle_t *);

void oabs(bsu_)(bus_space_handle_t, bus_size_t);

bsr (oabs(bsr1_), u_int8_t);
bsw (oabs(bsw1_), u_int8_t);
bsrm(oabs(bsrm1_), u_int8_t);
bswm(oabs(bswm1_), u_int8_t);
bsrm(oabs(bsrr1_), u_int8_t);
bswm(oabs(bswr1_), u_int8_t);
bssr(oabs(bssr1_), u_int8_t);
bscr(oabs(bscr1_), u_int8_t);

/* function definitions */
/* ARGSUSED */
int
oabs(bsm_)(
        bus_space_tag_t tag,
        bus_addr_t address,
        bus_size_t size,
        int flags,
        bus_space_handle_t *handlep)
{
        *handlep = tag->base + address * AMIGA_SIMPLE_BUS_STRIDE;
        return 0;
}

/* ARGSUSED */
int
oabs(bsms_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        bus_size_t size,
        bus_space_handle_t *nhandlep)
{
        *nhandlep = handle + offset * AMIGA_SIMPLE_BUS_STRIDE;
        return 0;
}

/* ARGSUSED */
void
oabs(bsu_)(
        bus_space_handle_t handle,
        bus_size_t size)
{
        return;
}

u_int8_t
oabs(bsr1_)(
        bus_space_handle_t handle,
        bus_size_t offset)
{
        u_int8_t *p;
        u_int8_t x;

        p = (u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);
        x = *p;
        amiga_bus_reorder_protect();
        return x;
}

void
oabs(bsw1_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        unsigned value)
{
        u_int8_t *p;

        p = (u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);
        *p = (u_int8_t)value;
        amiga_bus_reorder_protect();
}

void
oabs(bsrm1_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        u_int8_t *pointer,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *pointer++ = *p;
                amiga_bus_reorder_protect();
                --count;
        }
}

void
oabs(bswm1_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        const u_int8_t *pointer,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *p = *pointer++;
                amiga_bus_reorder_protect();
                --count;
        }
}

void
oabs(bsrr1_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        u_int8_t *pointer,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *pointer++ = *p;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE;
                --count;
        }
}

void
oabs(bswr1_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        const u_int8_t *pointer,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *p = *pointer++;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE;
                --count;
        }
}

void
oabs(bssr1_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        unsigned value,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *p = value;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE;
                --count;
        }
}

void
oabs(bscr1_)(
        bus_space_handle_t handlefrom,
        bus_size_t from,
        bus_space_handle_t handleto,
        bus_size_t to,
        bus_size_t count)
{
        volatile u_int8_t *p, *q;

        p = (volatile u_int8_t *)(handlefrom + from * AMIGA_SIMPLE_BUS_STRIDE);
        q = (volatile u_int8_t *)(handleto   +   to * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *q = *p;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE;
                q += AMIGA_SIMPLE_BUS_STRIDE;
                --count;
        }
}


#ifdef AMIGA_SIMPLE_BUS_WORD_METHODS

/* word methods */

bsr (oabs(bsr2_), u_int16_t);
bsw (oabs(bsw2_), u_int16_t);
bsrm(oabs(bsrm2_), u_int16_t);
bswm(oabs(bswm2_), u_int16_t);
bsrm(oabs(bsrr2_), u_int16_t);
bswm(oabs(bswr2_), u_int16_t);
bssr(oabs(bssr2_), u_int16_t);
bscr(oabs(bscr2_), u_int16_t);

u_int16_t
oabs(bsr2_)(
        bus_space_handle_t handle,
        bus_size_t offset)
{
        u_int16_t *p;
        u_int16_t x;

        p = (u_int16_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);
        x = *p;
        amiga_bus_reorder_protect();
        return x;
}

void
oabs(bsw2_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        unsigned value)
{
        u_int16_t *p;

        p = (u_int16_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);
        *p = (u_int16_t)value;
        amiga_bus_reorder_protect();
}

void
oabs(bsrm2_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        u_int16_t *pointer,
        bus_size_t count)
{
        volatile u_int16_t *p;

        p = (volatile u_int16_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *pointer++ = *p;
                amiga_bus_reorder_protect();
                --count;
        }
}

void
oabs(bswm2_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        const u_int16_t *pointer,
        bus_size_t count)
{
        volatile u_int16_t *p;

        p = (volatile u_int16_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *p = *pointer++;
                amiga_bus_reorder_protect();
                --count;
        }
}

void
oabs(bsrr2_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        u_int16_t *pointer,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *pointer++ = *(volatile u_int16_t *)p;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE * sizeof(u_int16_t);
                --count;
        }
}

void
oabs(bswr2_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        const u_int16_t *pointer,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *(volatile u_int16_t *)p = *pointer++;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE * sizeof(u_int16_t);
                --count;
        }
}

void
oabs(bssr2_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        unsigned value,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *(volatile u_int16_t *)p = (unsigned)value;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE * sizeof(u_int16_t);
                --count;
        }
}

void
oabs(bscr2_)(
        bus_space_handle_t handlefrom,
        bus_size_t from,
        bus_space_handle_t handleto,
        bus_size_t to,
        bus_size_t count)
{
        volatile u_int8_t *p, *q;

        p = (volatile u_int8_t *)(handlefrom + from * AMIGA_SIMPLE_BUS_STRIDE);
        q = (volatile u_int8_t *)(handleto   +   to * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *(volatile u_int16_t *)q = *(volatile u_int16_t *)p;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE * sizeof(u_int16_t);
                q += AMIGA_SIMPLE_BUS_STRIDE * sizeof(u_int16_t);
                --count;
        }
}
#endif /* AMIGA_SIMPLE_BUS_WORD_METHODS */

#ifdef AMIGA_SIMPLE_BUS_LONGWORD_METHODS

/* longword methods */

bsr (oabs(bsr4_), u_int32_t);
bsw (oabs(bsw4_), u_int32_t);
bsrm(oabs(bsrm4_), u_int32_t);
bswm(oabs(bswm4_), u_int32_t);
bsrm(oabs(bsrr4_), u_int32_t);
bswm(oabs(bswr4_), u_int32_t);
bssr(oabs(bssr4_), u_int32_t);
bscr(oabs(bscr4_), u_int32_t);

u_int32_t
oabs(bsr4_)(
        bus_space_handle_t handle,
        bus_size_t offset)
{
        u_int32_t *p;
        u_int32_t x;

        p = (u_int32_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);
        x = *p;
        amiga_bus_reorder_protect();
        return x;
}

void
oabs(bsw4_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        unsigned value)
{
        u_int32_t *p;

        p = (u_int32_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);
        *p = (u_int32_t)value;
        amiga_bus_reorder_protect();
}


void
oabs(bsrm4_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        u_int32_t *pointer,
        bus_size_t count)
{
        volatile u_int32_t *p;

        p = (volatile u_int32_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *pointer++ = *p;
                amiga_bus_reorder_protect();
                --count;
        }
}

void
oabs(bswm4_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        const u_int32_t *pointer,
        bus_size_t count)
{
        volatile u_int32_t *p;

        p = (volatile u_int32_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *p = *pointer++;
                amiga_bus_reorder_protect();
                --count;
        }
}

void
oabs(bsrr4_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        u_int32_t *pointer,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *pointer++ = *(volatile u_int32_t *)p;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE * sizeof(u_int32_t);
                --count;
        }
}

void
oabs(bswr4_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        const u_int32_t *pointer,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *(volatile u_int32_t *)p = *pointer++;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE * sizeof(u_int32_t);
                --count;
        }
}

void
oabs(bssr4_)(
        bus_space_handle_t handle,
        bus_size_t offset,
        unsigned value,
        bus_size_t count)
{
        volatile u_int8_t *p;

        p = (volatile u_int8_t *)(handle + offset * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *(volatile u_int32_t *)p = (unsigned)value;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE * sizeof(u_int32_t);
                --count;
        }
}

void
oabs(bscr4_)(
        bus_space_handle_t handlefrom,
        bus_size_t from,
        bus_space_handle_t handleto,
        bus_size_t to,
        bus_size_t count)
{
        volatile u_int8_t *p, *q;

        p = (volatile u_int8_t *)(handlefrom + from * AMIGA_SIMPLE_BUS_STRIDE);
        q = (volatile u_int8_t *)(handleto   +   to * AMIGA_SIMPLE_BUS_STRIDE);

        while (count > 0) {
                *(volatile u_int32_t *)q = *(volatile u_int32_t *)p;
                amiga_bus_reorder_protect();
                p += AMIGA_SIMPLE_BUS_STRIDE * sizeof(u_int32_t);
                q += AMIGA_SIMPLE_BUS_STRIDE * sizeof(u_int32_t);
                --count;
        }
}
#endif /* AMIGA_SIMPLE_BUS_LONGWORD_METHODS */

#ifndef AMIGA_SIMPLE_BUS_NO_ARRAY
/* method array */

const struct amiga_bus_space_methods oabs(amiga_bus_stride_) = {

        .bsm =          oabs(bsm_),
        .bsms =         oabs(bsms_),
        .bsu =          oabs(bsu_),
        .bsa =          NULL,
        .bsf =          NULL,

        .bsr1 = oabs(bsr1_),
        .bsw1 =         oabs(bsw1_),
        .bsrm1 =        oabs(bsrm1_),
        .bswm1 =        oabs(bswm1_),
        .bsrr1 =        oabs(bsrr1_),
        .bswr1 =        oabs(bswr1_),
        .bssr1 =        oabs(bssr1_),
        .bscr1 =        oabs(bscr1_),

#ifdef AMIGA_SIMPLE_BUS_WORD_METHODS
        .bsr2 =         oabs(bsr2_),
        .bsw2 =         oabs(bsw2_),
        .bsrs2 =        oabs(bsr2_),
        .bsws2 =        oabs(bsw2_),
        .bsrm2 =        oabs(bsrm2_),
        .bswm2 =        oabs(bswm2_),
        .bsrms2 =       oabs(bsrm2_),
        .bswms2 =       oabs(bswm2_),
        .bsrr2 =        oabs(bsrr2_),
        .bswr2 =        oabs(bswr2_),
        .bsrrs2 =       oabs(bsrr2_),
        .bswrs2 =       oabs(bswr2_),
        .bssr2 =        oabs(bssr2_),
        .bscr2 =        oabs(bscr2_),
#endif /* AMIGA_SIMPLE_BUS_WORD_METHODS */

#ifdef AMIGA_SIMPLE_BUS_LONGWORD_METHODS
        .bsr4 =         oabs(bsr4_),
        .bsw4 =         oabs(bsw4_),
        .bsrs4 =        oabs(bsr4_),
        .bsws4 =        oabs(bsw4_),
        .bsrm4 =        oabs(bsrm4_),
        .bswm4 =        oabs(bswm4_),
        .bsrms4 =       oabs(bsrm4_),
        .bswms4 =       oabs(bswm4_),
        .bsrr4 =        oabs(bsrr4_),
        .bswr4 =        oabs(bswr4_),
        .bsrrs4 =       oabs(bsrr4_),
        .bswrs4 =       oabs(bswr4_),
        .bssr4 =        oabs(bssr4_),
        .bscr4 =        oabs(bscr4_)
#endif /* AMIGA_SIMPLE_BUS_LONGWORD_METHODS */
};
#endif