root/sys/arch/evbsh3/t_sh7706lan/t_sh7706lan_space.c
/*      $NetBSD: t_sh7706lan_space.c,v 1.1 2010/04/06 15:54:31 nonaka Exp $     */

/*-
 * Copyright (c) 1998 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by Charles M. Hannum.
 *
 * 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: t_sh7706lan_space.c,v 1.1 2010/04/06 15:54:31 nonaka Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/bus.h>
#include <sys/intr.h>

#include <uvm/uvm_extern.h>

#include <sh3/bscreg.h>
#include <sh3/devreg.h>
#include <sh3/mmu.h>
#include <sh3/pmap.h>
#include <sh3/pte.h>

#include <machine/cpu.h>

/*
 * I/O bus space
 */
#define T_SH7706LAN_IOMEM_IO            0       /* space is i/o space */
#define T_SH7706LAN_IOMEM_MEM           1       /* space is mem space */
#define T_SH7706LAN_IOMEM_PCMCIA_IO     2       /* PCMCIA IO space */
#define T_SH7706LAN_IOMEM_PCMCIA_MEM    3       /* PCMCIA Mem space */
#define T_SH7706LAN_IOMEM_PCMCIA_ATT    4       /* PCMCIA Attr space */
#define T_SH7706LAN_IOMEM_PCMCIA_8BIT   0x8000  /* PCMCIA BUS 8 BIT WIDTH */
#define T_SH7706LAN_IOMEM_PCMCIA_IO8 \
            (T_SH7706LAN_IOMEM_PCMCIA_IO|T_SH7706LAN_IOMEM_PCMCIA_8BIT)
#define T_SH7706LAN_IOMEM_PCMCIA_MEM8 \
            (T_SH7706LAN_IOMEM_PCMCIA_MEM|T_SH7706LAN_IOMEM_PCMCIA_8BIT)
#define T_SH7706LAN_IOMEM_PCMCIA_ATT8 \
            (T_SH7706LAN_IOMEM_PCMCIA_ATT|T_SH7706LAN_IOMEM_PCMCIA_8BIT)

int t_sh7706lan_iomem_map(void *v, bus_addr_t bpa, bus_size_t size, int flags,
    bus_space_handle_t *bshp);
void t_sh7706lan_iomem_unmap(void *v, bus_space_handle_t bsh, bus_size_t size);
int t_sh7706lan_iomem_subregion(void *v, bus_space_handle_t bsh,
    bus_size_t offset, bus_size_t size, bus_space_handle_t *nbshp);
int t_sh7706lan_iomem_alloc(void *v, bus_addr_t rstart, bus_addr_t rend,
    bus_size_t size, bus_size_t alignment, bus_size_t boundary, int flags,
    bus_addr_t *bpap, bus_space_handle_t *bshp);
void t_sh7706lan_iomem_free(void *v, bus_space_handle_t bsh, bus_size_t size);

static int t_sh7706lan_iomem_add_mapping(bus_addr_t, bus_size_t, int,
    bus_space_handle_t *);

static int
t_sh7706lan_iomem_add_mapping(bus_addr_t bpa, bus_size_t size, int type,
    bus_space_handle_t *bshp)
{
        u_long pa, endpa;
        vaddr_t va;
        pt_entry_t *pte;
        unsigned int m = 0;
        int io_type = type & ~T_SH7706LAN_IOMEM_PCMCIA_8BIT;

        pa = sh3_trunc_page(bpa);
        endpa = sh3_round_page(bpa + size);

#ifdef DIAGNOSTIC
        if (endpa <= pa)
                panic("t_sh7706lan_iomem_add_mapping: overflow");
#endif

        va = uvm_km_alloc(kernel_map, endpa - pa, 0, UVM_KMF_VAONLY);
        if (va == 0){
                printf("t_sh7706lan_iomem_add_mapping: nomem\n");
                return (ENOMEM);
        }

        *bshp = (bus_space_handle_t)(va + (bpa & PGOFSET));

#define MODE(t, s)                                                      \
        ((t) & T_SH7706LAN_IOMEM_PCMCIA_8BIT) ?                         \
                _PG_PCMCIA_ ## s ## 8 :                                 \
                _PG_PCMCIA_ ## s ## 16
        switch (io_type) {
        default:
                panic("unknown pcmcia space.");
                /* NOTREACHED */
        case T_SH7706LAN_IOMEM_PCMCIA_IO:
                m = MODE(type, IO);
                break;
        case T_SH7706LAN_IOMEM_PCMCIA_MEM:
                m = MODE(type, MEM);
                break;
        case T_SH7706LAN_IOMEM_PCMCIA_ATT:
                m = MODE(type, ATTR);
                break;
        }
#undef MODE

        for (; pa < endpa; pa += PAGE_SIZE, va += PAGE_SIZE) {
                pmap_kenter_pa(va, pa, VM_PROT_READ | VM_PROT_WRITE, 0);
                pte = __pmap_kpte_lookup(va);
                KDASSERT(pte);
                *pte |= m;  /* PTEA PCMCIA assistant bit */
                sh_tlb_update(0, va, *pte);
        }

        return (0);
}

int
t_sh7706lan_iomem_map(void *v, bus_addr_t bpa, bus_size_t size,
    int flags, bus_space_handle_t *bshp)
{
        bus_addr_t addr = SH3_PHYS_TO_P2SEG(bpa);
        int error;

        KASSERT((bpa & SH3_PHYS_MASK) == bpa);

        if (bpa < 0x14000000 || bpa >= 0x1c000000) {
                /* CS0,1,2,3,4,7 */
                *bshp = (bus_space_handle_t)addr;
                return (0);
        }

        /* CS5,6 */
        error = t_sh7706lan_iomem_add_mapping(addr, size, (int)(u_long)v, bshp);

        return (error);
}

void
t_sh7706lan_iomem_unmap(void *v, bus_space_handle_t bsh, bus_size_t size)
{
        u_long va, endva;
        bus_addr_t bpa;

        if (bsh >= SH3_P2SEG_BASE && bsh <= SH3_P2SEG_END) {
                /* maybe CS0,1,2,3,4,7 */
                return;
        }

        /* CS5,6 */
        va = sh3_trunc_page(bsh);
        endva = sh3_round_page(bsh + size);

#ifdef DIAGNOSTIC
        if (endva <= va)
                panic("t_sh7706lan_io_unmap: overflow");
#endif

        pmap_extract(pmap_kernel(), va, &bpa);
        bpa += bsh & PGOFSET;

        pmap_kremove(va, endva - va);

        /*
         * Free the kernel virtual mapping.
         */
        uvm_km_free(kernel_map, va, endva - va, UVM_KMF_VAONLY);
}

int
t_sh7706lan_iomem_subregion(void *v, bus_space_handle_t bsh,
    bus_size_t offset, bus_size_t size, bus_space_handle_t *nbshp)
{

        *nbshp = bsh + offset;

        return (0);
}

int
t_sh7706lan_iomem_alloc(void *v, bus_addr_t rstart, bus_addr_t rend,
    bus_size_t size, bus_size_t alignment, bus_size_t boundary, int flags,
    bus_addr_t *bpap, bus_space_handle_t *bshp)
{

        *bshp = *bpap = rstart;

        return (0);
}

void
t_sh7706lan_iomem_free(void *v, bus_space_handle_t bsh, bus_size_t size)
{

        t_sh7706lan_iomem_unmap(v, bsh, size);
}

/*
 * on-board I/O bus space read/write
 */
uint8_t t_sh7706lan_iomem_read_1(void *v, bus_space_handle_t bsh, bus_size_t offset);
uint16_t t_sh7706lan_iomem_read_2(void *v, bus_space_handle_t bsh, bus_size_t offset);
uint32_t t_sh7706lan_iomem_read_4(void *v, bus_space_handle_t bsh, bus_size_t offset);
void t_sh7706lan_iomem_read_multi_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint8_t *addr, bus_size_t count);
void t_sh7706lan_iomem_read_multi_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint16_t *addr, bus_size_t count);
void t_sh7706lan_iomem_read_multi_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint32_t *addr, bus_size_t count);
void t_sh7706lan_iomem_read_region_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint8_t *addr, bus_size_t count);
void t_sh7706lan_iomem_read_region_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint16_t *addr, bus_size_t count);
void t_sh7706lan_iomem_read_region_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint32_t *addr, bus_size_t count);
void t_sh7706lan_iomem_write_1(void *v, bus_space_handle_t bsh, bus_size_t offset,
    uint8_t value);
void t_sh7706lan_iomem_write_2(void *v, bus_space_handle_t bsh, bus_size_t offset,
    uint16_t value);
void t_sh7706lan_iomem_write_4(void *v, bus_space_handle_t bsh, bus_size_t offset,
    uint32_t value);
void t_sh7706lan_iomem_write_multi_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint8_t *addr, bus_size_t count);
void t_sh7706lan_iomem_write_multi_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint16_t *addr, bus_size_t count);
void t_sh7706lan_iomem_write_multi_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint32_t *addr, bus_size_t count);
void t_sh7706lan_iomem_write_region_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint8_t *addr, bus_size_t count);
void t_sh7706lan_iomem_write_region_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint16_t *addr, bus_size_t count);
void t_sh7706lan_iomem_write_region_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint32_t *addr, bus_size_t count);
void t_sh7706lan_iomem_set_multi_1(void *v, bus_space_handle_t bsh, bus_size_t offset,
    uint8_t val, bus_size_t count);
void t_sh7706lan_iomem_set_multi_2(void *v, bus_space_handle_t bsh, bus_size_t offset,
    uint16_t val, bus_size_t count);
void t_sh7706lan_iomem_set_multi_4(void *v, bus_space_handle_t bsh, bus_size_t offset,
    uint32_t val, bus_size_t count);
void t_sh7706lan_iomem_set_region_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint8_t val, bus_size_t count);
void t_sh7706lan_iomem_set_region_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint16_t val, bus_size_t count);
void t_sh7706lan_iomem_set_region_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint32_t val, bus_size_t count);
void t_sh7706lan_iomem_copy_region_1(void *v, bus_space_handle_t h1, bus_size_t o1,
    bus_space_handle_t h2, bus_size_t o2, bus_size_t count);
void t_sh7706lan_iomem_copy_region_2(void *v, bus_space_handle_t h1, bus_size_t o1,
    bus_space_handle_t h2, bus_size_t o2, bus_size_t count);
void t_sh7706lan_iomem_copy_region_4(void *v, bus_space_handle_t h1, bus_size_t o1,
    bus_space_handle_t h2, bus_size_t o2, bus_size_t count);

struct _bus_space t_sh7706lan_bus_io =
{
        .bs_cookie = (void *)T_SH7706LAN_IOMEM_PCMCIA_IO,

        .bs_map = t_sh7706lan_iomem_map,
        .bs_unmap = t_sh7706lan_iomem_unmap,
        .bs_subregion = t_sh7706lan_iomem_subregion,

        .bs_alloc = t_sh7706lan_iomem_alloc,
        .bs_free = t_sh7706lan_iomem_free,

        .bs_r_1 = t_sh7706lan_iomem_read_1,
        .bs_r_2 = t_sh7706lan_iomem_read_2,
        .bs_r_4 = t_sh7706lan_iomem_read_4,

        .bs_rm_1 = t_sh7706lan_iomem_read_multi_1,
        .bs_rm_2 = t_sh7706lan_iomem_read_multi_2,
        .bs_rm_4 = t_sh7706lan_iomem_read_multi_4,

        .bs_rr_1 = t_sh7706lan_iomem_read_region_1,
        .bs_rr_2 = t_sh7706lan_iomem_read_region_2,
        .bs_rr_4 = t_sh7706lan_iomem_read_region_4,

        .bs_rs_1 = t_sh7706lan_iomem_read_1,
        .bs_rs_2 = t_sh7706lan_iomem_read_2,
        .bs_rs_4 = t_sh7706lan_iomem_read_4,

        .bs_rms_1 = t_sh7706lan_iomem_read_multi_1,
        .bs_rms_2 = t_sh7706lan_iomem_read_multi_2,
        .bs_rms_4 = t_sh7706lan_iomem_read_multi_4,

        .bs_rrs_1 = t_sh7706lan_iomem_read_region_1,
        .bs_rrs_2 = t_sh7706lan_iomem_read_region_2,
        .bs_rrs_4 = t_sh7706lan_iomem_read_region_4,

        .bs_w_1 = t_sh7706lan_iomem_write_1,
        .bs_w_2 = t_sh7706lan_iomem_write_2,
        .bs_w_4 = t_sh7706lan_iomem_write_4,

        .bs_wm_1 = t_sh7706lan_iomem_write_multi_1,
        .bs_wm_2 = t_sh7706lan_iomem_write_multi_2,
        .bs_wm_4 = t_sh7706lan_iomem_write_multi_4,

        .bs_wr_1 = t_sh7706lan_iomem_write_region_1,
        .bs_wr_2 = t_sh7706lan_iomem_write_region_2,
        .bs_wr_4 = t_sh7706lan_iomem_write_region_4,

        .bs_ws_1 = t_sh7706lan_iomem_write_1,
        .bs_ws_2 = t_sh7706lan_iomem_write_2,
        .bs_ws_4 = t_sh7706lan_iomem_write_4,

        .bs_wms_1 = t_sh7706lan_iomem_write_multi_1,
        .bs_wms_2 = t_sh7706lan_iomem_write_multi_2,
        .bs_wms_4 = t_sh7706lan_iomem_write_multi_4,

        .bs_wrs_1 = t_sh7706lan_iomem_write_region_1,
        .bs_wrs_2 = t_sh7706lan_iomem_write_region_2,
        .bs_wrs_4 = t_sh7706lan_iomem_write_region_4,

        .bs_sm_1 = t_sh7706lan_iomem_set_multi_1,
        .bs_sm_2 = t_sh7706lan_iomem_set_multi_2,
        .bs_sm_4 = t_sh7706lan_iomem_set_multi_4,

        .bs_sr_1 = t_sh7706lan_iomem_set_region_1,
        .bs_sr_2 = t_sh7706lan_iomem_set_region_2,
        .bs_sr_4 = t_sh7706lan_iomem_set_region_4,

        .bs_c_1 = t_sh7706lan_iomem_copy_region_1,
        .bs_c_2 = t_sh7706lan_iomem_copy_region_2,
        .bs_c_4 = t_sh7706lan_iomem_copy_region_4,
};

struct _bus_space t_sh7706lan_bus_mem =
{
        .bs_cookie = (void *)T_SH7706LAN_IOMEM_PCMCIA_MEM,

        .bs_map = t_sh7706lan_iomem_map,
        .bs_unmap = t_sh7706lan_iomem_unmap,
        .bs_subregion = t_sh7706lan_iomem_subregion,

        .bs_alloc = t_sh7706lan_iomem_alloc,
        .bs_free = t_sh7706lan_iomem_free,

        .bs_r_1 = t_sh7706lan_iomem_read_1,
        .bs_r_2 = t_sh7706lan_iomem_read_2,
        .bs_r_4 = t_sh7706lan_iomem_read_4,

        .bs_rm_1 = t_sh7706lan_iomem_read_multi_1,
        .bs_rm_2 = t_sh7706lan_iomem_read_multi_2,
        .bs_rm_4 = t_sh7706lan_iomem_read_multi_4,

        .bs_rr_1 = t_sh7706lan_iomem_read_region_1,
        .bs_rr_2 = t_sh7706lan_iomem_read_region_2,
        .bs_rr_4 = t_sh7706lan_iomem_read_region_4,

        .bs_rs_1 = t_sh7706lan_iomem_read_1,
        .bs_rs_2 = t_sh7706lan_iomem_read_2,
        .bs_rs_4 = t_sh7706lan_iomem_read_4,

        .bs_rms_1 = t_sh7706lan_iomem_read_multi_1,
        .bs_rms_2 = t_sh7706lan_iomem_read_multi_2,
        .bs_rms_4 = t_sh7706lan_iomem_read_multi_4,

        .bs_rrs_1 = t_sh7706lan_iomem_read_region_1,
        .bs_rrs_2 = t_sh7706lan_iomem_read_region_2,
        .bs_rrs_4 = t_sh7706lan_iomem_read_region_4,

        .bs_w_1 = t_sh7706lan_iomem_write_1,
        .bs_w_2 = t_sh7706lan_iomem_write_2,
        .bs_w_4 = t_sh7706lan_iomem_write_4,

        .bs_wm_1 = t_sh7706lan_iomem_write_multi_1,
        .bs_wm_2 = t_sh7706lan_iomem_write_multi_2,
        .bs_wm_4 = t_sh7706lan_iomem_write_multi_4,

        .bs_wr_1 = t_sh7706lan_iomem_write_region_1,
        .bs_wr_2 = t_sh7706lan_iomem_write_region_2,
        .bs_wr_4 = t_sh7706lan_iomem_write_region_4,

        .bs_ws_1 = t_sh7706lan_iomem_write_1,
        .bs_ws_2 = t_sh7706lan_iomem_write_2,
        .bs_ws_4 = t_sh7706lan_iomem_write_4,

        .bs_wms_1 = t_sh7706lan_iomem_write_multi_1,
        .bs_wms_2 = t_sh7706lan_iomem_write_multi_2,
        .bs_wms_4 = t_sh7706lan_iomem_write_multi_4,

        .bs_wrs_1 = t_sh7706lan_iomem_write_region_1,
        .bs_wrs_2 = t_sh7706lan_iomem_write_region_2,
        .bs_wrs_4 = t_sh7706lan_iomem_write_region_4,

        .bs_sm_1 = t_sh7706lan_iomem_set_multi_1,
        .bs_sm_2 = t_sh7706lan_iomem_set_multi_2,
        .bs_sm_4 = t_sh7706lan_iomem_set_multi_4,

        .bs_sr_1 = t_sh7706lan_iomem_set_region_1,
        .bs_sr_2 = t_sh7706lan_iomem_set_region_2,
        .bs_sr_4 = t_sh7706lan_iomem_set_region_4,

        .bs_c_1 = t_sh7706lan_iomem_copy_region_1,
        .bs_c_2 = t_sh7706lan_iomem_copy_region_2,
        .bs_c_4 = t_sh7706lan_iomem_copy_region_4,
};

/* read */
uint8_t
t_sh7706lan_iomem_read_1(void *v, bus_space_handle_t bsh, bus_size_t offset)
{

        return *(volatile uint8_t *)(bsh + offset);
}

uint16_t
t_sh7706lan_iomem_read_2(void *v, bus_space_handle_t bsh, bus_size_t offset)
{

        return (*(volatile uint8_t *)(bsh + offset)) |
            (((uint16_t)*(volatile uint8_t *)(bsh + offset + 1)) << 8);
}

uint32_t
t_sh7706lan_iomem_read_4(void *v, bus_space_handle_t bsh, bus_size_t offset)
{

        return (*(volatile uint8_t *)(bsh + offset)) |
            (((uint32_t)*(volatile uint8_t *)(bsh + offset + 1)) << 8) |
            (((uint32_t)*(volatile uint8_t *)(bsh + offset + 2)) << 16) |
            (((uint32_t)*(volatile uint8_t *)(bsh + offset + 3)) << 24);
}

void
t_sh7706lan_iomem_read_multi_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint8_t *addr, bus_size_t count)
{
        volatile uint8_t *p = (void *)(bsh + offset);

        while (count--) {
                *addr++ = *p;
        }
}

void
t_sh7706lan_iomem_read_multi_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint16_t *addr, bus_size_t count)
{
        volatile uint8_t *src = (void *)(bsh + offset);
        volatile uint8_t *dest = (void *)addr;

        while (count--) {
                *dest++ = src[0];
                *dest++ = src[1];
        }
}

void
t_sh7706lan_iomem_read_multi_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint32_t *addr, bus_size_t count)
{
        volatile uint8_t *src = (void *)(bsh + offset);
        volatile uint8_t *dest = (void *)addr;

        while (count--) {
                *dest++ = src[0];
                *dest++ = src[1];
                *dest++ = src[2];
                *dest++ = src[3];
        }
}

void
t_sh7706lan_iomem_read_region_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint8_t *addr, bus_size_t count)
{
        volatile uint8_t *p = (void *)(bsh + offset);

        while (count--) {
                *addr++ = *p++;
        }
}

void
t_sh7706lan_iomem_read_region_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint16_t *addr, bus_size_t count)
{

        t_sh7706lan_iomem_read_region_1(v, bsh, offset, (void *)addr, count * 2);
}

void
t_sh7706lan_iomem_read_region_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint32_t *addr, bus_size_t count)
{

        t_sh7706lan_iomem_read_region_1(v, bsh, offset, (void *)addr, count * 4);
}

/* write */
void
t_sh7706lan_iomem_write_1(void *v, bus_space_handle_t bsh, bus_size_t offset,
    uint8_t value)
{

        *(volatile uint8_t *)(bsh + offset) = value;
}

void
t_sh7706lan_iomem_write_2(void *v, bus_space_handle_t bsh, bus_size_t offset,
    uint16_t value)
{

        *(volatile uint8_t *)(bsh + offset) = value & 0xff;
        *(volatile uint8_t *)(bsh + offset + 1) = (value >> 8) & 0xff;
}

void
t_sh7706lan_iomem_write_4(void *v, bus_space_handle_t bsh, bus_size_t offset,
    uint32_t value)
{

        *(volatile uint8_t *)(bsh + offset) = value & 0xff;
        *(volatile uint8_t *)(bsh + offset + 1) = (value >> 8) & 0xff;
        *(volatile uint8_t *)(bsh + offset + 2) = (value >> 16) & 0xff;
        *(volatile uint8_t *)(bsh + offset + 3) = (value >> 24) & 0xff;
}

void
t_sh7706lan_iomem_write_multi_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint8_t *addr, bus_size_t count)
{
        volatile uint8_t *p = (void *)(bsh + offset);

        while (count--) {
                *p = *addr++;
        }
}

void
t_sh7706lan_iomem_write_multi_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint16_t *addr, bus_size_t count)
{
        volatile uint8_t *dest = (void *)(bsh + offset);
        volatile const uint8_t *src = (const void *)addr;

        while (count--) {
                dest[0] = *src++;
                dest[1] = *src++;
        }
}

void
t_sh7706lan_iomem_write_multi_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint32_t *addr, bus_size_t count)
{
        volatile uint8_t *dest = (void *)(bsh + offset);
        volatile const uint8_t *src = (const void *)addr;

        while (count--) {
                dest[0] = *src++;
                dest[1] = *src++;
                dest[2] = *src++;
                dest[3] = *src++;
        }
}

void
t_sh7706lan_iomem_write_region_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint8_t *addr, bus_size_t count)
{
        volatile uint8_t *p = (void *)(bsh + offset);

        while (count--) {
                *p++ = *addr++;
        }
}

void
t_sh7706lan_iomem_write_region_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint16_t *addr, bus_size_t count)
{

        t_sh7706lan_iomem_write_region_1(v, bsh, offset, (const void*)addr, count * 2);
}

void
t_sh7706lan_iomem_write_region_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, const uint32_t *addr, bus_size_t count)
{

        t_sh7706lan_iomem_write_region_1(v, bsh, offset, (const void*)addr, count * 4);
}

void
t_sh7706lan_iomem_set_multi_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint8_t val, bus_size_t count)
{
        volatile uint8_t *p = (void *)(bsh + offset);

        while (count--) {
                *p = val;
        }
}

void
t_sh7706lan_iomem_set_multi_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint16_t val, bus_size_t count)
{
        volatile uint8_t *dest = (void *)(bsh + offset);
        uint8_t src[2];

        src[0] = val & 0xff;
        src[1] = (val >> 8) & 0xff;

        while (count--) {
                dest[0] = src[0];
                dest[1] = src[1];
        }
}

void
t_sh7706lan_iomem_set_multi_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint32_t val, bus_size_t count)
{
        volatile uint8_t *dest = (void *)(bsh + offset);
        uint8_t src[4];

        src[0] = val & 0xff;
        src[1] = (val >> 8) & 0xff;
        src[2] = (val >> 16) & 0xff;
        src[3] = (val >> 24) & 0xff;

        while (count--) {
                dest[0] = src[0];
                dest[1] = src[1];
                dest[2] = src[2];
                dest[3] = src[3];
        }
}

void
t_sh7706lan_iomem_set_region_1(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint8_t val, bus_size_t count)
{
        volatile uint8_t *addr = (void *)(bsh + offset);

        while (count--) {
                *addr++ = val;
        }
}

void
t_sh7706lan_iomem_set_region_2(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint16_t val, bus_size_t count)
{
        volatile uint8_t *dest = (void *)(bsh + offset);
        uint8_t src[2];

        src[0] = val & 0xff;
        src[1] = (val >> 8) & 0xff;

        while (count--) {
                *dest++ = src[0];
                *dest++ = src[1];
        }
}

void
t_sh7706lan_iomem_set_region_4(void *v, bus_space_handle_t bsh,
    bus_size_t offset, uint32_t val, bus_size_t count)
{
        volatile uint8_t *dest = (void *)(bsh + offset);
        uint8_t src[4];

        src[0] = val & 0xff;
        src[1] = (val >> 8) & 0xff;
        src[2] = (val >> 16) & 0xff;
        src[3] = (val >> 24) & 0xff;

        while (count--) {
                *dest++ = src[0];
                *dest++ = src[1];
                *dest++ = src[2];
                *dest++ = src[3];
        }
}

void
t_sh7706lan_iomem_copy_region_1(void *v, bus_space_handle_t h1, bus_size_t o1,
    bus_space_handle_t h2, bus_size_t o2, bus_size_t count)
{
        volatile uint8_t *addr1 = (void *)(h1 + o1);
        volatile uint8_t *addr2 = (void *)(h2 + o2);

        if (addr1 >= addr2) {   /* src after dest: copy forward */
                while (count--) {
                        *addr2++ = *addr1++;
                }
        } else {                /* dest after src: copy backwards */
                addr1 += count - 1;
                addr2 += count - 1;
                while (count--) {
                        *addr2-- = *addr1--;
                }
        }
}

void
t_sh7706lan_iomem_copy_region_2(void *v, bus_space_handle_t h1, bus_size_t o1,
    bus_space_handle_t h2, bus_size_t o2, bus_size_t count)
{

        t_sh7706lan_iomem_copy_region_1(v, h1, o1, h2, o2, count * 2);
}

void
t_sh7706lan_iomem_copy_region_4(void *v, bus_space_handle_t h1, bus_size_t o1,
    bus_space_handle_t h2, bus_size_t o2, bus_size_t count)
{

        t_sh7706lan_iomem_copy_region_1(v, h1, o1, h2, o2, count * 4);
}