1041 lines
28 KiB
C
1041 lines
28 KiB
C
/* $NetBSD: le_bus.c,v 1.6 2002/05/30 22:25:51 thorpej Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1998 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Leo Weppelman.
|
|
*
|
|
* 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.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by the NetBSD
|
|
* Foundation, Inc. and its contributors.
|
|
* 4. Neither the name of The NetBSD Foundation nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* 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/types.h>
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/malloc.h>
|
|
#include <machine/bswap.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/bus.h>
|
|
|
|
/*
|
|
* This file contains the common functions for using a litte endian (linear)
|
|
* bus on a big endian atari.
|
|
*/
|
|
|
|
/* Autoconf detection stuff */
|
|
static int leb_bus_space_peek_1 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
static int leb_bus_space_peek_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
static int leb_bus_space_peek_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
static int leb_bus_space_peek_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
|
|
/* read (single) */
|
|
static u_int8_t leb_bus_space_read_1 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
static u_int16_t leb_bus_space_read_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
static u_int32_t leb_bus_space_read_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
static u_int64_t leb_bus_space_read_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
|
|
/* write (single) */
|
|
static void leb_bus_space_write_1 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int8_t));
|
|
static void leb_bus_space_write_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int16_t));
|
|
static void leb_bus_space_write_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int32_t));
|
|
static void leb_bus_space_write_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int64_t));
|
|
|
|
/* read (single) stream */
|
|
static u_int16_t leb_bus_space_read_stream_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
static u_int32_t leb_bus_space_read_stream_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
static u_int64_t leb_bus_space_read_stream_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t));
|
|
|
|
/* write (single) stream */
|
|
static void leb_bus_space_write_stream_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int16_t));
|
|
static void leb_bus_space_write_stream_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int32_t));
|
|
static void leb_bus_space_write_stream_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int64_t));
|
|
|
|
/* read multiple */
|
|
static void leb_bus_space_read_multi_1 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int8_t *,
|
|
bus_size_t));
|
|
static void leb_bus_space_read_multi_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int16_t *,
|
|
bus_size_t));
|
|
static void leb_bus_space_read_multi_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int32_t *,
|
|
bus_size_t));
|
|
static void leb_bus_space_read_multi_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int64_t *,
|
|
bus_size_t));
|
|
|
|
/* write multiple */
|
|
static void leb_bus_space_write_multi_1 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int8_t *, bus_size_t));
|
|
static void leb_bus_space_write_multi_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int16_t *, bus_size_t));
|
|
static void leb_bus_space_write_multi_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int32_t *, bus_size_t));
|
|
static void leb_bus_space_write_multi_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int64_t *, bus_size_t));
|
|
|
|
/* read multiple stream */
|
|
static void leb_bus_space_read_multi_stream_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int16_t *,
|
|
bus_size_t));
|
|
static void leb_bus_space_read_multi_stream_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int32_t *,
|
|
bus_size_t));
|
|
static void leb_bus_space_read_multi_stream_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int64_t *,
|
|
bus_size_t));
|
|
|
|
/* write multiple stream */
|
|
static void leb_bus_space_write_multi_stream_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int16_t *, bus_size_t));
|
|
static void leb_bus_space_write_multi_stream_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int32_t *, bus_size_t));
|
|
static void leb_bus_space_write_multi_stream_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int64_t *, bus_size_t));
|
|
|
|
/* read region */
|
|
static void leb_bus_space_read_region_1 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int8_t *,
|
|
bus_size_t));
|
|
static void leb_bus_space_read_region_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int16_t *,
|
|
bus_size_t));
|
|
static void leb_bus_space_read_region_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int32_t *,
|
|
bus_size_t));
|
|
static void leb_bus_space_read_region_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int64_t *,
|
|
bus_size_t));
|
|
|
|
/* write region */
|
|
static void leb_bus_space_write_region_1 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int8_t *, bus_size_t));
|
|
static void leb_bus_space_write_region_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int16_t *, bus_size_t));
|
|
static void leb_bus_space_write_region_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int32_t *, bus_size_t));
|
|
static void leb_bus_space_write_region_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t,
|
|
const u_int64_t *, bus_size_t));
|
|
|
|
/* read region stream */
|
|
static void leb_bus_space_read_region_stream_2 __P((
|
|
bus_space_tag_t, bus_space_handle_t,
|
|
bus_size_t, u_int16_t *, bus_size_t));
|
|
static void leb_bus_space_read_region_stream_4 __P((
|
|
bus_space_tag_t, bus_space_handle_t,
|
|
bus_size_t, u_int32_t *, bus_size_t));
|
|
static void leb_bus_space_read_region_stream_8 __P((
|
|
bus_space_tag_t, bus_space_handle_t,
|
|
bus_size_t, u_int64_t *, bus_size_t));
|
|
|
|
/* write region */
|
|
static void leb_bus_space_write_region_stream_2 __P((
|
|
bus_space_tag_t, bus_space_handle_t,
|
|
bus_size_t, const u_int16_t *, bus_size_t));
|
|
static void leb_bus_space_write_region_stream_4 __P((
|
|
bus_space_tag_t, bus_space_handle_t,
|
|
bus_size_t, const u_int32_t *, bus_size_t));
|
|
static void leb_bus_space_write_region_stream_8 __P((
|
|
bus_space_tag_t, bus_space_handle_t,
|
|
bus_size_t, const u_int64_t *, bus_size_t));
|
|
|
|
/* set multi */
|
|
static void leb_bus_space_set_multi_1 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int8_t,
|
|
bus_size_t));
|
|
static void leb_bus_space_set_multi_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int16_t,
|
|
bus_size_t));
|
|
static void leb_bus_space_set_multi_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int32_t,
|
|
bus_size_t));
|
|
static void leb_bus_space_set_multi_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int64_t,
|
|
bus_size_t));
|
|
|
|
/* set region */
|
|
static void leb_bus_space_set_region_1 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int8_t,
|
|
bus_size_t));
|
|
static void leb_bus_space_set_region_2 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int16_t,
|
|
bus_size_t));
|
|
static void leb_bus_space_set_region_4 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int32_t,
|
|
bus_size_t));
|
|
static void leb_bus_space_set_region_8 __P((bus_space_tag_t,
|
|
bus_space_handle_t, bus_size_t, u_int64_t,
|
|
bus_size_t));
|
|
|
|
/*
|
|
* Define these inline, to avoid function call overhead.
|
|
* XXX: Maybe move to an m68k include file?
|
|
*/
|
|
static u_int16_t swap16 __P((u_int16_t v));
|
|
static u_int32_t swap32 __P((u_int32_t v));
|
|
|
|
static __inline__ u_int16_t swap16(u_int16_t v)
|
|
{
|
|
__asm volatile ("rolw #8, %0" : "=d"(v) : "0"(v));
|
|
return(v);
|
|
}
|
|
|
|
static __inline__ u_int32_t swap32(u_int32_t v)
|
|
{
|
|
__asm volatile (" rolw #8, %0 \n"
|
|
" swap %0 \n"
|
|
" rolw #8, %0" : "=d"(v) : "0"(v));
|
|
return(v);
|
|
}
|
|
|
|
/*
|
|
* Don't force a function call overhead on these primitives...
|
|
*/
|
|
#define __read_1(h, o) *((u_int8_t *)((h) + (o)))
|
|
#define __read_2(h, o) swap16(*((u_int16_t *)((h) + (o))))
|
|
#define __read_4(h, o) swap32(*((u_int32_t *)((h) + (o))))
|
|
#define __read_8(h, o) bswap64(*((u_int64_t *)((h) + (o))))
|
|
|
|
#define __write_1(h, o, v) *((u_int8_t *)((h) + (o))) = (v)
|
|
#define __write_2(h, o, v) *((u_int16_t *)((h) + (o))) = swap16(v)
|
|
#define __write_4(h, o, v) *((u_int32_t *)((h) + (o))) = swap32(v)
|
|
#define __write_8(h, o, v) *((u_int64_t *)((h) + (o))) = bswap64(v)
|
|
|
|
bus_space_tag_t
|
|
leb_alloc_bus_space_tag(storage)
|
|
bus_space_tag_t storage;
|
|
{
|
|
bus_space_tag_t leb_t;
|
|
|
|
/*
|
|
* Allow the caller to specify storage space for the tag. This
|
|
* is used during console config (when malloc() can't be used).
|
|
*/
|
|
if (storage != NULL)
|
|
leb_t = storage;
|
|
else {
|
|
if ((leb_t = malloc(sizeof(*leb_t), M_TEMP, M_NOWAIT)) == NULL)
|
|
return(NULL);
|
|
}
|
|
bzero(leb_t, sizeof(*leb_t));
|
|
|
|
leb_t->abs_p_1 = leb_bus_space_peek_1;
|
|
leb_t->abs_p_2 = leb_bus_space_peek_2;
|
|
leb_t->abs_p_4 = leb_bus_space_peek_4;
|
|
leb_t->abs_p_8 = leb_bus_space_peek_8;
|
|
leb_t->abs_r_1 = leb_bus_space_read_1;
|
|
leb_t->abs_r_2 = leb_bus_space_read_2;
|
|
leb_t->abs_r_4 = leb_bus_space_read_4;
|
|
leb_t->abs_r_8 = leb_bus_space_read_8;
|
|
leb_t->abs_rs_1 = leb_bus_space_read_1;
|
|
leb_t->abs_rs_2 = leb_bus_space_read_stream_2;
|
|
leb_t->abs_rs_4 = leb_bus_space_read_stream_4;
|
|
leb_t->abs_rs_8 = leb_bus_space_read_stream_8;
|
|
leb_t->abs_rm_1 = leb_bus_space_read_multi_1;
|
|
leb_t->abs_rm_2 = leb_bus_space_read_multi_2;
|
|
leb_t->abs_rm_4 = leb_bus_space_read_multi_4;
|
|
leb_t->abs_rm_8 = leb_bus_space_read_multi_8;
|
|
leb_t->abs_rms_1 = leb_bus_space_read_multi_1;
|
|
leb_t->abs_rms_2 = leb_bus_space_read_multi_stream_2;
|
|
leb_t->abs_rms_4 = leb_bus_space_read_multi_stream_4;
|
|
leb_t->abs_rms_8 = leb_bus_space_read_multi_stream_8;
|
|
leb_t->abs_rr_1 = leb_bus_space_read_region_1;
|
|
leb_t->abs_rr_2 = leb_bus_space_read_region_2;
|
|
leb_t->abs_rr_4 = leb_bus_space_read_region_4;
|
|
leb_t->abs_rr_8 = leb_bus_space_read_region_8;
|
|
leb_t->abs_rrs_1 = leb_bus_space_read_region_1;
|
|
leb_t->abs_rrs_2 = leb_bus_space_read_region_stream_2;
|
|
leb_t->abs_rrs_4 = leb_bus_space_read_region_stream_4;
|
|
leb_t->abs_rrs_8 = leb_bus_space_read_region_stream_8;
|
|
leb_t->abs_w_1 = leb_bus_space_write_1;
|
|
leb_t->abs_w_2 = leb_bus_space_write_2;
|
|
leb_t->abs_w_4 = leb_bus_space_write_4;
|
|
leb_t->abs_w_8 = leb_bus_space_write_8;
|
|
leb_t->abs_ws_1 = leb_bus_space_write_1;
|
|
leb_t->abs_ws_2 = leb_bus_space_write_stream_2;
|
|
leb_t->abs_ws_4 = leb_bus_space_write_stream_4;
|
|
leb_t->abs_ws_8 = leb_bus_space_write_stream_8;
|
|
leb_t->abs_wm_1 = leb_bus_space_write_multi_1;
|
|
leb_t->abs_wm_2 = leb_bus_space_write_multi_2;
|
|
leb_t->abs_wm_4 = leb_bus_space_write_multi_4;
|
|
leb_t->abs_wm_8 = leb_bus_space_write_multi_8;
|
|
leb_t->abs_wms_1 = leb_bus_space_write_multi_1;
|
|
leb_t->abs_wms_2 = leb_bus_space_write_multi_stream_2;
|
|
leb_t->abs_wms_4 = leb_bus_space_write_multi_stream_4;
|
|
leb_t->abs_wms_8 = leb_bus_space_write_multi_stream_8;
|
|
leb_t->abs_wr_1 = leb_bus_space_write_region_1;
|
|
leb_t->abs_wr_2 = leb_bus_space_write_region_2;
|
|
leb_t->abs_wr_4 = leb_bus_space_write_region_4;
|
|
leb_t->abs_wr_8 = leb_bus_space_write_region_8;
|
|
leb_t->abs_wrs_1 = leb_bus_space_write_region_1;
|
|
leb_t->abs_wrs_2 = leb_bus_space_write_region_stream_2;
|
|
leb_t->abs_wrs_4 = leb_bus_space_write_region_stream_4;
|
|
leb_t->abs_wrs_8 = leb_bus_space_write_region_stream_8;
|
|
leb_t->abs_sm_1 = leb_bus_space_set_multi_1;
|
|
leb_t->abs_sm_2 = leb_bus_space_set_multi_2;
|
|
leb_t->abs_sm_4 = leb_bus_space_set_multi_4;
|
|
leb_t->abs_sm_8 = leb_bus_space_set_multi_8;
|
|
leb_t->abs_sr_1 = leb_bus_space_set_region_1;
|
|
leb_t->abs_sr_2 = leb_bus_space_set_region_2;
|
|
leb_t->abs_sr_4 = leb_bus_space_set_region_4;
|
|
leb_t->abs_sr_8 = leb_bus_space_set_region_8;
|
|
|
|
return(leb_t);
|
|
}
|
|
|
|
|
|
/*
|
|
* The various access functions
|
|
*/
|
|
|
|
/*
|
|
* int bus_space_peek_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t sh, bus_size_t offset));
|
|
*
|
|
* Check if the address is suitable for reading N-byte quantities.
|
|
*/
|
|
static int
|
|
leb_bus_space_peek_1(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(!badbaddr((caddr_t)(h + o), 1));
|
|
}
|
|
|
|
static int
|
|
leb_bus_space_peek_2(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(!badbaddr((caddr_t)(h + o), 2));
|
|
}
|
|
|
|
static int
|
|
leb_bus_space_peek_4(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(!badbaddr((caddr_t)(h + o), 4));
|
|
}
|
|
|
|
static int
|
|
leb_bus_space_peek_8(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(!badbaddr((caddr_t)(h + o), 8));
|
|
}
|
|
|
|
/*
|
|
* u_intX_t bus_space_read_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset));
|
|
*
|
|
* Return an 1, 2, 4, or 8 byte value read from the bus_space described
|
|
* by tag/handle at `offset'. The value is converted to host-endian.
|
|
*/
|
|
static u_int8_t
|
|
leb_bus_space_read_1(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(__read_1(h, o));
|
|
}
|
|
|
|
static u_int16_t
|
|
leb_bus_space_read_2(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(__read_2(h, o));
|
|
}
|
|
|
|
static u_int32_t
|
|
leb_bus_space_read_4(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(__read_4(h, o));
|
|
}
|
|
|
|
static u_int64_t
|
|
leb_bus_space_read_8(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(__read_8(h, o));
|
|
}
|
|
|
|
/*
|
|
* u_intX_t bus_space_write_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset, u_intX_t val));
|
|
*
|
|
* Write an 1, 2, 4, or 8 byte value to the bus_space described by tag/handle
|
|
* at `offset'. The value `val' is converted from host to bus endianness
|
|
* before being written.
|
|
*/
|
|
static void
|
|
leb_bus_space_write_1(t, h, o, v)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
u_int8_t v;
|
|
{
|
|
__write_1(h, o, v);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_2(t, h, o, v)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
u_int16_t v;
|
|
{
|
|
__write_2(h, o, v);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_4(t, h, o, v)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
u_int32_t v;
|
|
{
|
|
__write_4(h, o, v);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_8(t, h, o, v)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
u_int64_t v;
|
|
{
|
|
__write_8(h, o, v);
|
|
}
|
|
|
|
/*
|
|
* u_intX_t bus_space_read_stream_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset));
|
|
*
|
|
* Return an 1, 2, 4, or 8 byte value read from the bus_space described
|
|
* by tag/handle at `offset'. No endian conversion is done.
|
|
*/
|
|
static u_int16_t
|
|
leb_bus_space_read_stream_2(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(*((u_int16_t *)(h + o)));
|
|
}
|
|
|
|
static u_int32_t
|
|
leb_bus_space_read_stream_4(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(*((u_int32_t *)(h + o)));
|
|
}
|
|
|
|
static u_int64_t
|
|
leb_bus_space_read_stream_8(t, h, o)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
{
|
|
return(*((u_int64_t *)(h + o)));
|
|
}
|
|
|
|
/*
|
|
* u_intX_t bus_space_write_stream_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset, u_intX_t val));
|
|
*
|
|
* Write an 1, 2, 4, or 8 byte value to the bus_space described by tag/handle
|
|
* at `offset'. No endian conversion is done.
|
|
*/
|
|
static void
|
|
leb_bus_space_write_stream_2(t, h, o, v)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
u_int16_t v;
|
|
{
|
|
*((u_int16_t *)(h + o)) = v;
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_stream_4(t, h, o, v)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
u_int32_t v;
|
|
{
|
|
*((u_int32_t *)(h + o)) = v;
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_stream_8(t, h, o, v)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o;
|
|
u_int64_t v;
|
|
{
|
|
*((u_int64_t *)(h + o)) = v;
|
|
}
|
|
|
|
/*
|
|
* void bus_space_read_multi_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset, u_intX_t *address,
|
|
* bus_size_t count));
|
|
*
|
|
* Read 'count' 1, 2, 4, or 8 byte values from the bus_space described by
|
|
* tag/handle at `offset' and store them in the address range starting at
|
|
* 'address'. The values are converted to cpu endian order before being
|
|
* being stored.
|
|
*/
|
|
static void
|
|
leb_bus_space_read_multi_1(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int8_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
*a = __read_1(h, o);
|
|
}
|
|
static void
|
|
leb_bus_space_read_multi_2(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int16_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
*a = __read_2(h, o);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_read_multi_4(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int32_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
*a = __read_4(h, o);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_read_multi_8(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int64_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
*a = __read_8(h, o);
|
|
}
|
|
|
|
/*
|
|
* void bus_space_write_multi_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset,
|
|
* const u_intX_t *address, bus_size_t count));
|
|
*
|
|
* Write 'count' 1, 2, 4, or 8 byte values from the address range starting
|
|
* at 'address' to the bus_space described by tag/handle at `offset'.
|
|
* The values are converted to bus endian order before being written to
|
|
* the bus.
|
|
*/
|
|
static void
|
|
leb_bus_space_write_multi_1(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int8_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
__write_1(h, o, *a);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_multi_2(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int16_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
__write_2(h, o, *a);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_multi_4(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int32_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
__write_4(h, o, *a);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_multi_8(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int64_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
__write_8(h, o, *a);
|
|
}
|
|
|
|
/*
|
|
* void bus_space_read_multi_stream_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset, u_intX_t *address,
|
|
* bus_size_t count));
|
|
*
|
|
* Read 'count' 1, 2, 4, or 8 byte values from the bus_space described by
|
|
* tag/handle at `offset' and store them in the address range starting at
|
|
* 'address'. No endian conversion is being done.
|
|
*/
|
|
static void
|
|
leb_bus_space_read_multi_stream_2(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int16_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
*a = *((u_int16_t *)(h + o));
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_read_multi_stream_4(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int32_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
*a = *((u_int32_t *)(h + o));
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_read_multi_stream_8(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int64_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
*a = *((u_int64_t *)(h + o));
|
|
}
|
|
|
|
/*
|
|
* void bus_space_write_multi_stream_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset,
|
|
* const u_intX_t *address, bus_size_t count));
|
|
*
|
|
* Write 'count' 1, 2, 4, or 8 byte values from the address range starting
|
|
* at 'address' to the bus_space described by tag/handle at `offset'.
|
|
* No endian conversion is being done.
|
|
*/
|
|
static void
|
|
leb_bus_space_write_multi_stream_2(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int16_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
*((u_int16_t *)(h + o)) = *a;
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_multi_stream_4(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int32_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
*((u_int32_t *)(h + o)) = *a;
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_multi_stream_8(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int64_t *a;
|
|
{
|
|
for (; c; a++, c--)
|
|
*((u_int64_t *)(h + o)) = *a;
|
|
}
|
|
|
|
/*
|
|
* void bus_space_read_region_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset,
|
|
* u_intN_t *addr, bus_size_t count));
|
|
*
|
|
* Read `count' 1, 2, 4, or 8 byte quantities from bus space
|
|
* described by tag/handle and starting at `offset' and copy into
|
|
* buffer provided.
|
|
*/
|
|
static void
|
|
leb_bus_space_read_region_1(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int8_t *a;
|
|
{
|
|
for (; c; a++, o++, c--)
|
|
*a = __read_1(h, o);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_read_region_2(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int16_t *a;
|
|
{
|
|
for (; c; a++, o += 2, c--)
|
|
*a = __read_2(h, o);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_read_region_4(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int32_t *a;
|
|
{
|
|
for (; c; a++, o += 4, c--)
|
|
*a = __read_4(h, o);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_read_region_8(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int64_t *a;
|
|
{
|
|
for (; c; a++, o += 8, c--)
|
|
*a = __read_8(h, o);
|
|
}
|
|
|
|
/*
|
|
* void bus_space_write_region_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset,
|
|
* u_intN_t *addr, bus_size_t count));
|
|
*
|
|
* Copy `count' 1, 2, 4, or 8 byte quantities from the buffer provided
|
|
* into the bus space described by tag/handle and starting at `offset'.
|
|
*/
|
|
static void
|
|
leb_bus_space_write_region_1(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int8_t *a;
|
|
{
|
|
for (; c; a++, o++, c--)
|
|
__write_1(h, o, *a);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_region_2(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int16_t *a;
|
|
{
|
|
for (; c; a++, o += 2, c--)
|
|
__write_2(h, o, *a);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_region_4(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int32_t *a;
|
|
{
|
|
for (; c; a++, o += 4, c--)
|
|
__write_4(h, o, *a);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_region_8(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int64_t *a;
|
|
{
|
|
for (; c; a++, o += 8, c--)
|
|
__write_8(h, o, *a);
|
|
}
|
|
|
|
/*
|
|
* void bus_space_read_region_stream_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset,
|
|
* u_intN_t *addr, bus_size_t count));
|
|
*
|
|
* Read `count' 1, 2, 4, or 8 byte quantities from bus space
|
|
* described by tag/handle and starting at `offset' and copy into
|
|
* buffer provided.
|
|
* No endian conversion is being done.
|
|
*/
|
|
static void
|
|
leb_bus_space_read_region_stream_2(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int16_t *a;
|
|
{
|
|
for (; c; a++, o += 2, c--)
|
|
*a = *(u_int16_t *)(h + o);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_read_region_stream_4(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int32_t *a;
|
|
{
|
|
for (; c; a++, o += 4, c--)
|
|
*a = *(u_int32_t *)(h + o);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_read_region_stream_8(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int64_t *a;
|
|
{
|
|
for (; c; a++, o += 8, c--)
|
|
*a = *(u_int64_t *)(h + o);
|
|
}
|
|
|
|
/*
|
|
* void bus_space_write_region_stream_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset,
|
|
* u_intN_t *addr, bus_size_t count));
|
|
*
|
|
* Copy `count' 1, 2, 4, or 8 byte quantities from the buffer provided
|
|
* into the bus space described by tag/handle and starting at `offset'.
|
|
* No endian conversion is being done.
|
|
*/
|
|
static void
|
|
leb_bus_space_write_region_stream_2(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int16_t *a;
|
|
{
|
|
for (; c; a++, o += 2, c--)
|
|
*((u_int16_t *)(h + o)) = *a;
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_region_stream_4(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int32_t *a;
|
|
{
|
|
for (; c; a++, o += 4, c--)
|
|
*((u_int32_t *)(h + o)) = *a;
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_write_region_stream_8(t, h, o, a, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
const u_int64_t *a;
|
|
{
|
|
for (; c; a++, o += 8, c--)
|
|
*((u_int64_t *)(h + o)) = *a;
|
|
}
|
|
|
|
/*
|
|
* void bus_space_set_multi_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset, u_intN_t val,
|
|
* bus_size_t count));
|
|
*
|
|
* Write the 1, 2, 4, or 8 byte value `val' to bus space described
|
|
* by tag/handle/offset `count' times.
|
|
*/
|
|
|
|
static void
|
|
leb_bus_space_set_multi_1(t, h, o, v, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int8_t v;
|
|
{
|
|
for (; c; c--)
|
|
__write_1(h, o, v);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_set_multi_2(t, h, o, v, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int16_t v;
|
|
{
|
|
v = swap16(v);
|
|
for (; c; c--)
|
|
*((u_int16_t *)(h + o)) = v;
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_set_multi_4(t, h, o, v, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int32_t v;
|
|
{
|
|
v = swap32(v);
|
|
for (; c; c--)
|
|
*((u_int32_t *)(h + o)) = v;
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_set_multi_8(t, h, o, v, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int64_t v;
|
|
{
|
|
v = bswap64(v);
|
|
for (; c; c--)
|
|
*((u_int64_t *)(h + o)) = v;
|
|
}
|
|
|
|
/*
|
|
* void bus_space_set_region_N __P((bus_space_tag_t tag,
|
|
* bus_space_handle_t bsh, bus_size_t offset, u_intN_t val,
|
|
* bus_size_t count));
|
|
*
|
|
* Write `count' 1, 2, 4, or 8 byte value `val' to bus space described
|
|
* by tag/handle starting at `offset'.
|
|
*/
|
|
static void
|
|
leb_bus_space_set_region_1(t, h, o, v, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int8_t v;
|
|
{
|
|
for (; c; o++, c--)
|
|
__write_1(h, o, v);
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_set_region_2(t, h, o, v, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int16_t v;
|
|
{
|
|
v = swap16(v);
|
|
for (; c; o += 2, c--)
|
|
*((u_int16_t *)(h + o)) = v;
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_set_region_4(t, h, o, v, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int32_t v;
|
|
{
|
|
v = swap32(v);
|
|
for (; c; o += 4, c--)
|
|
*((u_int32_t *)(h + o)) = v;
|
|
}
|
|
|
|
static void
|
|
leb_bus_space_set_region_8(t, h, o, v, c)
|
|
bus_space_tag_t t;
|
|
bus_space_handle_t h;
|
|
bus_size_t o, c;
|
|
u_int64_t v;
|
|
{
|
|
v = bswap64(v);
|
|
for (; c; o += 8, c--)
|
|
*((u_int64_t *)(h + o)) = v;
|
|
}
|