FreeBSD/Linux Kernel Cross Reference
sys/arm/arm/copystr.S
1 /* $NetBSD: copystr.S,v 1.8 2002/10/13 14:54:48 bjh21 Exp $ */
2
3 /*-
4 * Copyright (c) 1995 Mark Brinicombe.
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. All advertising materials mentioning features or use of this software
16 * must display the following acknowledgement:
17 * This product includes software developed by Mark Brinicombe.
18 * 4. The name of the company nor the name of the author may be used to
19 * endorse or promote products derived from this software without specific
20 * prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
23 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
24 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
25 * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
26 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
27 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
28 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32 * SUCH DAMAGE.
33 *
34 * copystr.S
35 *
36 * optimised and fault protected copystr functions
37 *
38 * Created : 16/05/95
39 */
40
41
42 #include "assym.s"
43 #include <machine/asm.h>
44 #include <machine/armreg.h>
45 #include <machine/asmacros.h>
46 __FBSDID("$FreeBSD: src/sys/arm/arm/copystr.S,v 1.3 2005/01/05 21:58:47 imp Exp $");
47
48 #include <sys/errno.h>
49
50 .text
51 .align 0
52 #ifdef MULTIPROCESSOR
53 .Lcpu_info:
54 .word _C_LABEL(cpu_info)
55 #else
56 .Lpcb:
57 .word _C_LABEL(__pcpu) + PC_CURPCB
58 #endif
59
60 /*
61 * r0 - from
62 * r1 - to
63 * r2 - maxlens
64 * r3 - lencopied
65 *
66 * Copy string from r0 to r1
67 */
68 ENTRY(copystr)
69 stmfd sp!, {r4-r5} /* stack is 8 byte aligned */
70 teq r2, #0x00000000
71 mov r5, #0x00000000
72 moveq r0, #ENAMETOOLONG
73 beq 2f
74
75 1: ldrb r4, [r0], #0x0001
76 add r5, r5, #0x00000001
77 teq r4, #0x00000000
78 strb r4, [r1], #0x0001
79 teqne r5, r2
80 bne 1b
81
82 teq r4, #0x00000000
83 moveq r0, #0x00000000
84 movne r0, #ENAMETOOLONG
85
86 2: teq r3, #0x00000000
87 strne r5, [r3]
88
89 ldmfd sp!, {r4-r5} /* stack is 8 byte aligned */
90 RET
91
92 #define SAVE_REGS stmfd sp!, {r4-r6}
93 #define RESTORE_REGS ldmfd sp!, {r4-r6}
94
95 /*
96 * r0 - user space address
97 * r1 - kernel space address
98 * r2 - maxlens
99 * r3 - lencopied
100 *
101 * Copy string from user space to kernel space
102 */
103 ENTRY(copyinstr)
104 SAVE_REGS
105
106 teq r2, #0x00000000
107 mov r6, #0x00000000
108 moveq r0, #ENAMETOOLONG
109 beq 2f
110
111 #ifdef MULTIPROCESSOR
112 /* XXX Probably not appropriate for non-Hydra SMPs */
113 stmfd sp!, {r0-r3, r14}
114 bl _C_LABEL(cpu_number)
115 ldr r4, .Lcpu_info
116 ldr r4, [r4, r0, lsl #2]
117 ldr r4, [r4, #CI_CURPCB]
118 ldmfd sp!, {r0-r3, r14}
119 #else
120 ldr r4, .Lpcb
121 ldr r4, [r4]
122 #endif
123
124 #ifdef DIAGNOSTIC
125 teq r4, #0x00000000
126 beq .Lcopystrpcbfault
127 #endif
128
129 adr r5, .Lcopystrfault
130 str r5, [r4, #PCB_ONFAULT]
131
132 1: ldrbt r5, [r0], #0x0001
133 add r6, r6, #0x00000001
134 teq r5, #0x00000000
135 strb r5, [r1], #0x0001
136 teqne r6, r2
137 bne 1b
138
139 mov r0, #0x00000000
140 str r0, [r4, #PCB_ONFAULT]
141
142 teq r5, #0x00000000
143 moveq r0, #0x00000000
144 movne r0, #ENAMETOOLONG
145
146 2: teq r3, #0x00000000
147 strne r6, [r3]
148
149 RESTORE_REGS
150 RET
151
152 /*
153 * r0 - kernel space address
154 * r1 - user space address
155 * r2 - maxlens
156 * r3 - lencopied
157 *
158 * Copy string from kernel space to user space
159 */
160 ENTRY(copyoutstr)
161 SAVE_REGS
162
163 teq r2, #0x00000000
164 mov r6, #0x00000000
165 moveq r0, #ENAMETOOLONG
166 beq 2f
167
168 #ifdef MULTIPROCESSOR
169 /* XXX Probably not appropriate for non-Hydra SMPs */
170 stmfd sp!, {r0-r3, r14}
171 bl _C_LABEL(cpu_number)
172 ldr r4, .Lcpu_info
173 ldr r4, [r4, r0, lsl #2]
174 ldr r4, [r4, #CI_CURPCB]
175 ldmfd sp!, {r0-r3, r14}
176 #else
177 ldr r4, .Lpcb
178 ldr r4, [r4]
179 #endif
180
181 #ifdef DIAGNOSTIC
182 teq r4, #0x00000000
183 beq .Lcopystrpcbfault
184 #endif
185
186 adr r5, .Lcopystrfault
187 str r5, [r4, #PCB_ONFAULT]
188
189 1: ldrb r5, [r0], #0x0001
190 add r6, r6, #0x00000001
191 teq r5, #0x00000000
192 strbt r5, [r1], #0x0001
193 teqne r6, r2
194 bne 1b
195
196 mov r0, #0x00000000
197 str r0, [r4, #PCB_ONFAULT]
198
199 teq r5, #0x00000000
200 moveq r0, #0x00000000
201 movne r0, #ENAMETOOLONG
202
203 2: teq r3, #0x00000000
204 strne r6, [r3]
205
206 RESTORE_REGS
207 RET
208
209 /* A fault occurred during the copy */
210 .Lcopystrfault:
211 mov r1, #0x00000000
212 str r1, [r4, #PCB_ONFAULT]
213 RESTORE_REGS
214 RET
215
216 #ifdef DIAGNOSTIC
217 .Lcopystrpcbfault:
218 mov r2, r1
219 mov r1, r0
220 adr r0, Lcopystrpcbfaulttext
221 bic sp, sp, #7 /* align stack to 8 bytes */
222 b _C_LABEL(panic)
223
224 Lcopystrpcbfaulttext:
225 .asciz "No valid PCB during copyinoutstr() addr1=%08x addr2=%08x\n"
226 .align 0
227 #endif
Cache object: aacf58e5fa15f57c4415f632623535f8
|