Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 | /* * 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 |