/*
 * Copyright (c) 2000 Apple Computer, Inc. All rights reserved.
 *
 * @APPLE_LICENSE_HEADER_START@
 * 
 * Copyright (c) 1999-2003 Apple Computer, Inc.  All Rights Reserved.
 * 
 * This file contains Original Code and/or Modifications of Original Code
 * as defined in and that are subject to the Apple Public Source License
 * Version 2.0 (the 'License'). You may not use this file except in
 * compliance with the License. Please obtain a copy of the License at
 * http://www.opensource.apple.com/apsl/ and read it before using this
 * file.
 * 
 * The Original Code and all software distributed under the License are
 * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
 * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
 * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
 * Please see the License for the specific language governing rights and
 * limitations under the License.
 * 
 * @APPLE_LICENSE_HEADER_END@
 */
#include <debug.h>
#include <ppc/asm.h>
#include <ppc/proc_reg.h>
#include <mach/ppc/vm_param.h>
#include <assym.s>

.set kLog2CacheLineSize, 5
.set kCacheLineSize, 32
 
ENTRY(kdp_flush_cache, TAG_NO_FRAME_USED)
	cmpi    cr0,0,r4,0			/* is this zero length? */
	add     r4,r3,r4			/* calculate last byte + 1 */
	subi    r4,r4,1				/* calculate last byte */

	srwi    r5,r3,kLog2CacheLineSize	/* calc first cache line index */
	srwi    r4,r4,kLog2CacheLineSize	/* calc last cache line index */
	beq     cr0, LdataToCodeDone		/* done if zero length */

	subf    r4,r5,r4			/* calc diff (# lines minus 1) */
	addi    r4,r4,1				/* # of cache lines to flush */
	slwi    r5,r5,kLog2CacheLineSize	/* calc addr of first cache line */

	/* flush the data cache lines */
	mr      r3,r5				/* starting address for loop */
	mtctr   r4					/* loop count */
LdataToCodeFlushLoop:
	dcbf    0, r3						/* flush the data cache line */
	addi    r3,r3,kCacheLineSize		/* advance to next cache line */
	bdnz    LdataToCodeFlushLoop		/* loop until count is zero */
	sync								/* wait until RAM is valid */

	/* invalidate the code cache lines */
	mr      r3,r5						/* starting address for loop */
	mtctr   r4							/* loop count */
LdataToCodeInvalidateLoop:
	icbi    0, r3						/* invalidate code cache line */
	addi    r3,r3,kCacheLineSize		/* advance to next cache line */
	bdnz    LdataToCodeInvalidateLoop	/* loop until count is zero */
	sync								/* wait until last icbi completes */
	isync								/* discard prefetched instructions */
LdataToCodeDone:
	blr									/* return nothing */

ENTRY(kdp_sync_cache, TAG_NO_FRAME_USED)
	sync					/* data sync */
	isync					/* inst sync */
	blr						/* return nothing */

ENTRY(kdp_xlate_off, TAG_NO_FRAME_USED)
	mfmsr	r3
	rlwinm	r3,r3,0,MSR_FP_BIT+1,MSR_FP_BIT-1	; Force floating point off
	rlwinm	r3,r3,0,MSR_VEC_BIT+1,MSR_VEC_BIT-1	; Force vectors off
	rlwinm	r4, r3, 0, MSR_DR_BIT+1, MSR_IR_BIT-1
	mtmsr	r4
	isync
	blr

ENTRY(kdp_xlate_restore, TAG_NO_FRAME_USED)
	mtmsr	r3
	isync
	blr