NetBSD-5.0.2/sys/arch/powerpc/ibm4xx/4xx_locore.S
/* $NetBSD: 4xx_locore.S,v 1.7 2007/03/04 06:00:34 christos Exp $ */
/*
* Copyright 2001 Wasabi Systems, Inc.
* All rights reserved.
*
* Written by Eduardo Horvath and Simon Burge for Wasabi Systems, Inc.
*
* 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 for the NetBSD Project by
* Wasabi Systems, Inc.
* 4. The name of Wasabi Systems, Inc. may not be used to endorse
* or promote products derived from this software without specific prior
* written permission.
*
* THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``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 WASABI SYSTEMS, INC
* 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.
*/
/*
* Copyright (C) 1995, 1996 Wolfgang Solfrank.
* Copyright (C) 1995, 1996 TooLs GmbH.
* All rights reserved.
*
* 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 TooLs GmbH.
* 4. The name of TooLs GmbH may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``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 TOOLS GMBH 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.
*/
/*
* This is not a standalone file. To use it, #inlcude it at
* the end of your port's locore.S
*/
/*
* Pull in common PowerPC locore subroutines.
*/
#include <powerpc/powerpc/locore_subr.S>
/*
* Pull in common trap vector code.
*/
#include <powerpc/ibm4xx/trap_subr.S>
#include <powerpc/ibm4xx/4xx_trap_subr.S>
/*
* Include PIO routines
*/
#include <powerpc/powerpc/pio_subr.S>
.globl _C_LABEL(ppc4xx_reset)
_C_LABEL(ppc4xx_reset):
mfspr %r3,SPR_DBCR0
oris %r3,%r3,DBCR0_RST_SYSTEM@h
mtspr SPR_DBCR0,%r3
ba 0
#if 0
/*
* XXXX the following doesn't quite work right yet.
*/
/*
* void bcopy(const void *src, void *dst, size_t len);
*
* swap %r3 and %r4 and fall through to memcopy.
*/
.globl _C_LABEL(bcopy)
_C_LABEL(bcopy):
mr %r0,%r3
mr %r3,%r4
mr %r4,%r0
/* FALLTHROUGH */
/*
* void *memcpy(void *dst (%r3), const void *src (%r4), size_t len (%r5));
*
* Copy memory (obviously)
*
* We will try to do data cache block aligned stores so we
* can use block allocate and not have to read from the
* destination.
*
* Register use:
*
* %r1 stack (of course)
* %r3 dst
* %r4 src
* %r5 len
* %r6 tmp
* %r7 holds 32
* %r8 holds dst
* %r24-%r31 block move regs
*
*/
ENTRY(memcpy)
stwu %r1,-(10*4)(%r1) /* Allocate some RAM to save 8 regs to. */
cmpwi %r5, 32 /* Less than 32 bytes ? */
stmw %r24,8(%r1) /* Save ALL regs (could be optimized) */
mr %r8,%r3 /* save dst */
li %r7,32
dcbt %r0,%r4 /* Start bringing in cache line. */
blt 1f /* Finish up */
neg %r6,%r3 /* Find how far unaligned we are... */
andi. %r6,%r6,31 /* Cache-align dest. */
mtxer %r6
sub %r5,%r5,%r6 /* subtract count */
lswx %r24,%r0,%r4 /* Load some. */
add %r4,%r4,%r6
dcbt %r0,%r4 /* Fetch next line */
stswx %r24,%r0,%r3 /* Store some */
add %r3,%r3,%r6
addic. %r6,%r5,-32 /* Pre-decrement next line */
ble 1f /* Less than 32-bytes? finishup */
/* Dest should not be cache line aligned. */
/* XXX need gas 2.11 to grok dcba insn */
#ifdef GAS_2_11
dcba %r0,%r3 /* Allocate a line */
#else
.long 0x7c001dec /* dcba 0,r3 */
#endif
0:
dcbt %r7,%r4 /* Bring in the next line, too */
lswi %r24,%r4,32
addi %r4,%r4,32 /* Inc src */
mr %r5,%r6
addic. %r6,%r5,-32
stswi %r24,%r3,32
addi %r3,%r3,32 /* Inc dst */
#ifdef GAS_2_11
dcba 0,%r3 /* Allocate another line */
#else
.long 0x7c071dec /* dcba %r7,%r3 */
#endif
bgt 0b
1:
mtxer %r5 /* Store byte count */
lswx %r24,%r0,%r4 /* Load up to 32 bytes */
stswx %r24,%r0,%r3 /* Store up to 32 bytes */
mr %r3,%r8 /* Return dst */
lmw %r24,8(%r1)
addi %r1,%r1,(10*4)
blr
#endif