[apple/xnu.git] / osfmk / ppc / db_asm.s

/*
 * Copyright (c) 2000 Apple Computer, Inc. All rights reserved.
 *
 * @APPLE_LICENSE_HEADER_START@
 * 
 * The contents of this file constitute Original Code as defined in and
 * are subject to the Apple Public Source License Version 1.1 (the
 * "License").  You may not use this file except in compliance with the
 * License.  Please obtain a copy of the License at
 * http://www.apple.com/publicsource and read it before using this file.
 * 
 * This 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 OR NON-INFRINGEMENT.  Please see the
 * License for the specific language governing rights and limitations
 * under the License.
 * 
 * @APPLE_LICENSE_HEADER_END@
 */
/*
 * @OSF_COPYRIGHT@
 */

#include <debug.h>
#include <ppc/asm.h>
#include <ppc/proc_reg.h>
#include <mach/ppc/vm_param.h>
#include <assym.s>

/* void
 * db_phys_copy(src, dst, bytecount)
 *      vm_offset_t     src;
 *      vm_offset_t     dst;
 *      int             bytecount
 *
 * This routine will copy bytecount bytes from physical address src to physical
 * address dst. 
 */
ENTRY(db_phys_copy, TAG_NO_FRAME_USED)

	/* Switch off data translations */
	mfmsr	r6
	rlwinm	r7,	r6,	0,	MSR_DR_BIT+1,	MSR_DR_BIT-1
	mtmsr	r7
	isync			/* Ensure data translations are off */

	subi	r3,	r3,	4
	subi	r4,	r4,	4

	cmpwi	r5,	3
	ble-	.L_db_phys_copy_bytes
.L_db_phys_copy_loop:
	lwz	r0,	4(r3)
	addi	r3,	r3,	4
	subi	r5,	r5,	4
	stw	r0,	4(r4)
	addi	r4,	r4,	4
	cmpwi	r5,	3
	bgt+	.L_db_phys_copy_loop

	/* If no leftover bytes, we're done now */
	cmpwi	r5,	0
	beq+	.L_db_phys_copy_done
	
.L_db_phys_copy_bytes:
	addi	r3,	r3,	3
	addi	r4,	r4,	3
.L_db_phys_copy_byte_loop:	
	lbz	r0,	1(r3)
	addi	r3,	r3,	1
	subi	r5,	r5,	1
	stb	r0,	1(r4)
	addi	r4,	r4,	1
	cmpwi	r5,	0
	bne+	.L_db_phys_copy_loop

.L_db_phys_copy_done:
	mtmsr	r6		/* Restore original translations */
	isync			/* Ensure data translations are off */

	blr

/* void
 * db_phys_cmp(src_a, src_b, bytecount)
 *      vm_offset_t     src_a;
 *      vm_offset_t     src_b;
 *      int             bytecount
 *
 * This routine will compare bytecount bytes from physical address src_a and physical
 * address src_b. 
 */

	/* Switch off data translations */
	mfmsr	r6
	rlwinm	r7,	r6,	0,	MSR_DR_BIT+1,	MSR_DR_BIT-1
	mtmsr	r7
	isync			/* Ensure data translations are off */

	subi	r3,	r3,	4
	subi	r4,	r4,	4

	cmpwi	r5,	3
	ble-	.L_db_phys_cmp_bytes
.L_db_phys_cmp_loop:
	lwz	r0,	4(r3)
	lwz	r7,	4(r4)
	addi	r3,	r3,	4
	addi	r4,	r4,	4
	subi	r5,	r5,	4
	cmpw	r0,	r7
	bne	.L_db_phys_cmp_false
	cmpwi	r5,	3
	bgt+	.L_db_phys_cmp_loop

	/* If no leftover bytes, we're done now */
	cmpwi	r5,	0
	beq+	.L_db_phys_cmp_true
	
.L_db_phys_cmp_bytes:
	addi	r3,	r3,	3
	addi	r4,	r4,	3
.L_db_phys_cmp_byte_loop:	
	lbz	r0,	1(r3)
	lbz	r7,	1(r4)
	addi	r3,	r3,	1
	addi	r4,	r4,	1
	subi	r5,	r5,	1
	cmpw	r0,	r7
	bne	.L_db_phys_cmp_false
	cmpwi	r5,	0
	bne+	.L_db_phys_cmp_loop

.L_db_phys_cmp_true:
	li	r3,	1
	b	.L_db_phys_cmp_done

.L_db_phys_cmp_false:
	li	r3,	0

.L_db_phys_cmp_done:
	mtmsr	r6		/* Restore original translations */
	isync			/* Ensure data translations are off */

	blr
Commit	Line	Data
1c79356b A	1	/*
	2	* Copyright (c) 2000 Apple Computer, Inc. All rights reserved.
	3	*
	4	* @APPLE_LICENSE_HEADER_START@
	5	*
	6	* The contents of this file constitute Original Code as defined in and
	7	* are subject to the Apple Public Source License Version 1.1 (the
	8	* "License"). You may not use this file except in compliance with the
	9	* License. Please obtain a copy of the License at
	10	* http://www.apple.com/publicsource and read it before using this file.
	11	*
	12	* This Original Code and all software distributed under the License are
	13	* distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY KIND, EITHER
	14	* EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
	15	* INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
	16	* FITNESS FOR A PARTICULAR PURPOSE OR NON-INFRINGEMENT. Please see the
	17	* License for the specific language governing rights and limitations
	18	* under the License.
	19	*
	20	* @APPLE_LICENSE_HEADER_END@
	21	*/
	22	/*
	23	* @OSF_COPYRIGHT@
	24	*/
	25
	26	#include <debug.h>
	27	#include <ppc/asm.h>
	28	#include <ppc/proc_reg.h>
	29	#include <mach/ppc/vm_param.h>
	30	#include <assym.s>
	31
	32	/* void
	33	* db_phys_copy(src, dst, bytecount)
	34	* vm_offset_t src;
	35	* vm_offset_t dst;
	36	* int bytecount
	37	*
	38	* This routine will copy bytecount bytes from physical address src to physical
	39	* address dst.
	40	*/
	41	ENTRY(db_phys_copy, TAG_NO_FRAME_USED)
	42
	43	/* Switch off data translations */
	44	mfmsr r6
	45	rlwinm r7, r6, 0, MSR_DR_BIT+1, MSR_DR_BIT-1
	46	mtmsr r7
	47	isync /* Ensure data translations are off */
	48
	49	subi r3, r3, 4
	50	subi r4, r4, 4
	51
	52	cmpwi r5, 3
	53	ble- .L_db_phys_copy_bytes
	54	.L_db_phys_copy_loop:
	55	lwz r0, 4(r3)
	56	addi r3, r3, 4
	57	subi r5, r5, 4
	58	stw r0, 4(r4)
	59	addi r4, r4, 4
	60	cmpwi r5, 3
	61	bgt+ .L_db_phys_copy_loop
	62
	63	/* If no leftover bytes, we're done now */
	64	cmpwi r5, 0
65	beq+ .L_db_phys_copy_done
66
67	.L_db_phys_copy_bytes:
68	addi r3, r3, 3
69	addi r4, r4, 3
70	.L_db_phys_copy_byte_loop:
71	lbz r0, 1(r3)
72	addi r3, r3, 1
73	subi r5, r5, 1
74	stb r0, 1(r4)
75	addi r4, r4, 1
76	cmpwi r5, 0
77	bne+ .L_db_phys_copy_loop
78
79	.L_db_phys_copy_done:
80	mtmsr r6 /* Restore original translations */
81	isync /* Ensure data translations are off */
82
83	blr
84
85	/* void
86	* db_phys_cmp(src_a, src_b, bytecount)
87	* vm_offset_t src_a;
88	* vm_offset_t src_b;
89	* int bytecount
90	*
91	* This routine will compare bytecount bytes from physical address src_a and physical
92	* address src_b.
93	*/
94
95	/* Switch off data translations */
96	mfmsr r6
97	rlwinm r7, r6, 0, MSR_DR_BIT+1, MSR_DR_BIT-1
98	mtmsr r7
99	isync /* Ensure data translations are off */
100
101	subi r3, r3, 4
102	subi r4, r4, 4
103
104	cmpwi r5, 3
105	ble- .L_db_phys_cmp_bytes
106	.L_db_phys_cmp_loop:
107	lwz r0, 4(r3)
108	lwz r7, 4(r4)
109	addi r3, r3, 4
110	addi r4, r4, 4
111	subi r5, r5, 4
112	cmpw r0, r7
113	bne .L_db_phys_cmp_false
114	cmpwi r5, 3
115	bgt+ .L_db_phys_cmp_loop
116
117	/* If no leftover bytes, we're done now */
118	cmpwi r5, 0
119	beq+ .L_db_phys_cmp_true
120
121	.L_db_phys_cmp_bytes:
122	addi r3, r3, 3
123	addi r4, r4, 3
124	.L_db_phys_cmp_byte_loop:
125	lbz r0, 1(r3)
126	lbz r7, 1(r4)
127	addi r3, r3, 1
128	addi r4, r4, 1
129	subi r5, r5, 1
130	cmpw r0, r7
131	bne .L_db_phys_cmp_false
132	cmpwi r5, 0
133	bne+ .L_db_phys_cmp_loop
134
135	.L_db_phys_cmp_true:
136	li r3, 1
137	b .L_db_phys_cmp_done
138
139	.L_db_phys_cmp_false:
140	li r3, 0
141
142	.L_db_phys_cmp_done:
143	mtmsr r6 /* Restore original translations */
144	isync /* Ensure data translations are off */
145
146	blr
147