1 /* SPDX-License-Identifier: GPL-2.0 */ << 2 /* 1 /* 3 * Copyright (C) 2020-2022 Loongson Technology !! 2 * This file is subject to the terms and conditions of the GNU General Public >> 3 * License. See the file "COPYING" in the main directory of this archive >> 4 * for more details. >> 5 * >> 6 * Unified implementation of memcpy, memmove and the __copy_user backend. >> 7 * >> 8 * Copyright (C) 1998, 99, 2000, 01, 2002 Ralf Baechle (ralf@gnu.org) >> 9 * Copyright (C) 1999, 2000, 01, 2002 Silicon Graphics, Inc. >> 10 * Copyright (C) 2002 Broadcom, Inc. >> 11 * memcpy/copy_user author: Mark Vandevoorde >> 12 * Copyright (C) 2007 Maciej W. Rozycki >> 13 * Copyright (C) 2014 Imagination Technologies Ltd. >> 14 * >> 15 * Mnemonic names for arguments to memcpy/__copy_user 4 */ 16 */ 5 17 >> 18 /* >> 19 * Hack to resolve longstanding prefetch issue >> 20 * >> 21 * Prefetching may be fatal on some systems if we're prefetching beyond the >> 22 * end of memory on some systems. It's also a seriously bad idea on non >> 23 * dma-coherent systems. >> 24 */ >> 25 #ifdef CONFIG_DMA_NONCOHERENT >> 26 #undef CONFIG_CPU_HAS_PREFETCH >> 27 #endif >> 28 #ifdef CONFIG_MIPS_MALTA >> 29 #undef CONFIG_CPU_HAS_PREFETCH >> 30 #endif >> 31 #ifdef CONFIG_CPU_MIPSR6 >> 32 #undef CONFIG_CPU_HAS_PREFETCH >> 33 #endif >> 34 6 #include <linux/export.h> 35 #include <linux/export.h> 7 #include <asm/alternative-asm.h> << 8 #include <asm/asm.h> 36 #include <asm/asm.h> 9 #include <asm/asmmacro.h> !! 37 #include <asm/asm-offsets.h> 10 #include <asm/cpu.h> << 11 #include <asm/regdef.h> 38 #include <asm/regdef.h> 12 #include <asm/unwind_hints.h> << 13 39 14 .section .noinstr.text, "ax" !! 40 #define dst a0 >> 41 #define src a1 >> 42 #define len a2 15 43 16 SYM_FUNC_START(memcpy) !! 44 /* 17 /* !! 45 * Spec 18 * Some CPUs support hardware unaligne !! 46 * 19 */ !! 47 * memcpy copies len bytes from src to dst and sets v0 to dst. 20 ALTERNATIVE "b __memcpy_generic", !! 48 * It assumes that 21 "b __memcpy_fast", CPU !! 49 * - src and dst don't overlap 22 SYM_FUNC_END(memcpy) !! 50 * - src is readable 23 SYM_FUNC_ALIAS(__memcpy, memcpy) !! 51 * - dst is writable 24 !! 52 * memcpy uses the standard calling convention 25 EXPORT_SYMBOL(memcpy) !! 53 * 26 EXPORT_SYMBOL(__memcpy) !! 54 * __copy_user copies up to len bytes from src to dst and sets a2 (len) to >> 55 * the number of uncopied bytes due to an exception caused by a read or write. >> 56 * __copy_user assumes that src and dst don't overlap, and that the call is >> 57 * implementing one of the following: >> 58 * copy_to_user >> 59 * - src is readable (no exceptions when reading src) >> 60 * copy_from_user >> 61 * - dst is writable (no exceptions when writing dst) >> 62 * __copy_user uses a non-standard calling convention; see >> 63 * include/asm-mips/uaccess.h >> 64 * >> 65 * When an exception happens on a load, the handler must >> 66 # ensure that all of the destination buffer is overwritten to prevent >> 67 * leaking information to user mode programs. >> 68 */ 27 69 28 _ASM_NOKPROBE(memcpy) !! 70 /* 29 _ASM_NOKPROBE(__memcpy) !! 71 * Implementation >> 72 */ 30 73 31 /* 74 /* 32 * void *__memcpy_generic(void *dst, const voi !! 75 * The exception handler for loads requires that: >> 76 * 1- AT contain the address of the byte just past the end of the source >> 77 * of the copy, >> 78 * 2- src_entry <= src < AT, and >> 79 * 3- (dst - src) == (dst_entry - src_entry), >> 80 * The _entry suffix denotes values when __copy_user was called. >> 81 * >> 82 * (1) is set up up by uaccess.h and maintained by not writing AT in copy_user >> 83 * (2) is met by incrementing src by the number of bytes copied >> 84 * (3) is met by not doing loads between a pair of increments of dst and src >> 85 * >> 86 * The exception handlers for stores adjust len (if necessary) and return. >> 87 * These handlers do not need to overwrite any data. 33 * 88 * 34 * a0: dst !! 89 * For __rmemcpy and memmove an exception is always a kernel bug, therefore 35 * a1: src !! 90 * they're not protected. 36 * a2: n << 37 */ 91 */ 38 SYM_FUNC_START(__memcpy_generic) << 39 move a3, a0 << 40 beqz a2, 2f << 41 92 42 1: ld.b t0, a1, 0 !! 93 /* Instruction type */ 43 st.b t0, a0, 0 !! 94 #define LD_INSN 1 44 addi.d a0, a0, 1 !! 95 #define ST_INSN 2 45 addi.d a1, a1, 1 !! 96 /* Pretech type */ 46 addi.d a2, a2, -1 !! 97 #define SRC_PREFETCH 1 47 bgt a2, zero, 1b !! 98 #define DST_PREFETCH 2 >> 99 #define LEGACY_MODE 1 >> 100 #define EVA_MODE 2 >> 101 #define USEROP 1 >> 102 #define KERNELOP 2 48 103 49 2: move a0, a3 !! 104 /* 50 jr ra !! 105 * Wrapper to add an entry in the exception table 51 SYM_FUNC_END(__memcpy_generic) !! 106 * in case the insn causes a memory exception. 52 _ASM_NOKPROBE(__memcpy_generic) !! 107 * Arguments: >> 108 * insn : Load/store instruction >> 109 * type : Instruction type >> 110 * reg : Register >> 111 * addr : Address >> 112 * handler : Exception handler >> 113 */ 53 114 54 .align 5 !! 115 #define EXC(insn, type, reg, addr, handler) \ 55 SYM_FUNC_START_NOALIGN(__memcpy_small) !! 116 .if \mode == LEGACY_MODE; \ 56 pcaddi t0, 8 !! 117 9: insn reg, addr; \ 57 slli.d a2, a2, 5 !! 118 .section __ex_table,"a"; \ 58 add.d t0, t0, a2 !! 119 PTR_WD 9b, handler; \ 59 jr t0 !! 120 .previous; \ >> 121 /* This is assembled in EVA mode */ \ >> 122 .else; \ >> 123 /* If loading from user or storing to user */ \ >> 124 .if ((\from == USEROP) && (type == LD_INSN)) || \ >> 125 ((\to == USEROP) && (type == ST_INSN)); \ >> 126 9: __BUILD_EVA_INSN(insn##e, reg, addr); \ >> 127 .section __ex_table,"a"; \ >> 128 PTR_WD 9b, handler; \ >> 129 .previous; \ >> 130 .else; \ >> 131 /* \ >> 132 * Still in EVA, but no need for \ >> 133 * exception handler or EVA insn \ >> 134 */ \ >> 135 insn reg, addr; \ >> 136 .endif; \ >> 137 .endif 60 138 61 .align 5 !! 139 /* 62 0: jr ra !! 140 * Only on the 64-bit kernel we can made use of 64-bit registers. >> 141 */ >> 142 #ifdef CONFIG_64BIT >> 143 #define USE_DOUBLE >> 144 #endif >> 145 >> 146 #ifdef USE_DOUBLE >> 147 >> 148 #define LOADK ld /* No exception */ >> 149 #define LOAD(reg, addr, handler) EXC(ld, LD_INSN, reg, addr, handler) >> 150 #define LOADL(reg, addr, handler) EXC(ldl, LD_INSN, reg, addr, handler) >> 151 #define LOADR(reg, addr, handler) EXC(ldr, LD_INSN, reg, addr, handler) >> 152 #define STOREL(reg, addr, handler) EXC(sdl, ST_INSN, reg, addr, handler) >> 153 #define STORER(reg, addr, handler) EXC(sdr, ST_INSN, reg, addr, handler) >> 154 #define STORE(reg, addr, handler) EXC(sd, ST_INSN, reg, addr, handler) >> 155 #define ADD daddu >> 156 #define SUB dsubu >> 157 #define SRL dsrl >> 158 #define SRA dsra >> 159 #define SLL dsll >> 160 #define SLLV dsllv >> 161 #define SRLV dsrlv >> 162 #define NBYTES 8 >> 163 #define LOG_NBYTES 3 63 164 64 .align 5 !! 165 /* 65 1: ld.b t0, a1, 0 !! 166 * As we are sharing code base with the mips32 tree (which use the o32 ABI 66 st.b t0, a0, 0 !! 167 * register definitions). We need to redefine the register definitions from 67 jr ra !! 168 * the n64 ABI register naming to the o32 ABI register naming. >> 169 */ >> 170 #undef t0 >> 171 #undef t1 >> 172 #undef t2 >> 173 #undef t3 >> 174 #define t0 $8 >> 175 #define t1 $9 >> 176 #define t2 $10 >> 177 #define t3 $11 >> 178 #define t4 $12 >> 179 #define t5 $13 >> 180 #define t6 $14 >> 181 #define t7 $15 >> 182 >> 183 #else >> 184 >> 185 #define LOADK lw /* No exception */ >> 186 #define LOAD(reg, addr, handler) EXC(lw, LD_INSN, reg, addr, handler) >> 187 #define LOADL(reg, addr, handler) EXC(lwl, LD_INSN, reg, addr, handler) >> 188 #define LOADR(reg, addr, handler) EXC(lwr, LD_INSN, reg, addr, handler) >> 189 #define STOREL(reg, addr, handler) EXC(swl, ST_INSN, reg, addr, handler) >> 190 #define STORER(reg, addr, handler) EXC(swr, ST_INSN, reg, addr, handler) >> 191 #define STORE(reg, addr, handler) EXC(sw, ST_INSN, reg, addr, handler) >> 192 #define ADD addu >> 193 #define SUB subu >> 194 #define SRL srl >> 195 #define SLL sll >> 196 #define SRA sra >> 197 #define SLLV sllv >> 198 #define SRLV srlv >> 199 #define NBYTES 4 >> 200 #define LOG_NBYTES 2 >> 201 >> 202 #endif /* USE_DOUBLE */ >> 203 >> 204 #define LOADB(reg, addr, handler) EXC(lb, LD_INSN, reg, addr, handler) >> 205 #define STOREB(reg, addr, handler) EXC(sb, ST_INSN, reg, addr, handler) >> 206 >> 207 #ifdef CONFIG_CPU_HAS_PREFETCH >> 208 # define _PREF(hint, addr, type) \ >> 209 .if \mode == LEGACY_MODE; \ >> 210 kernel_pref(hint, addr); \ >> 211 .else; \ >> 212 .if ((\from == USEROP) && (type == SRC_PREFETCH)) || \ >> 213 ((\to == USEROP) && (type == DST_PREFETCH)); \ >> 214 /* \ >> 215 * PREFE has only 9 bits for the offset \ >> 216 * compared to PREF which has 16, so it may \ >> 217 * need to use the $at register but this \ >> 218 * register should remain intact because it's \ >> 219 * used later on. Therefore use $v1. \ >> 220 */ \ >> 221 .set at=v1; \ >> 222 user_pref(hint, addr); \ >> 223 .set noat; \ >> 224 .else; \ >> 225 kernel_pref(hint, addr); \ >> 226 .endif; \ >> 227 .endif >> 228 #else >> 229 # define _PREF(hint, addr, type) >> 230 #endif >> 231 >> 232 #define PREFS(hint, addr) _PREF(hint, addr, SRC_PREFETCH) >> 233 #define PREFD(hint, addr) _PREF(hint, addr, DST_PREFETCH) >> 234 >> 235 #ifdef CONFIG_CPU_LITTLE_ENDIAN >> 236 #define LDFIRST LOADR >> 237 #define LDREST LOADL >> 238 #define STFIRST STORER >> 239 #define STREST STOREL >> 240 #define SHIFT_DISCARD SLLV >> 241 #else >> 242 #define LDFIRST LOADL >> 243 #define LDREST LOADR >> 244 #define STFIRST STOREL >> 245 #define STREST STORER >> 246 #define SHIFT_DISCARD SRLV >> 247 #endif >> 248 >> 249 #define FIRST(unit) ((unit)*NBYTES) >> 250 #define REST(unit) (FIRST(unit)+NBYTES-1) >> 251 #define UNIT(unit) FIRST(unit) >> 252 >> 253 #define ADDRMASK (NBYTES-1) >> 254 >> 255 .text >> 256 .set noreorder >> 257 #ifndef CONFIG_CPU_DADDI_WORKAROUNDS >> 258 .set noat >> 259 #else >> 260 .set at=v1 >> 261 #endif 68 262 69 .align 5 263 .align 5 70 2: ld.h t0, a1, 0 << 71 st.h t0, a0, 0 << 72 jr ra << 73 264 74 .align 5 !! 265 /* 75 3: ld.h t0, a1, 0 !! 266 * Macro to build the __copy_user common code 76 ld.b t1, a1, 2 !! 267 * Arguments: 77 st.h t0, a0, 0 !! 268 * mode : LEGACY_MODE or EVA_MODE 78 st.b t1, a0, 2 !! 269 * from : Source operand. USEROP or KERNELOP >> 270 * to : Destination operand. USEROP or KERNELOP >> 271 */ >> 272 .macro __BUILD_COPY_USER mode, from, to >> 273 >> 274 /* initialize __memcpy if this the first time we execute this macro */ >> 275 .ifnotdef __memcpy >> 276 .set __memcpy, 1 >> 277 .hidden __memcpy /* make sure it does not leak */ >> 278 .endif >> 279 >> 280 /* >> 281 * Note: dst & src may be unaligned, len may be 0 >> 282 * Temps >> 283 */ >> 284 #define rem t8 >> 285 >> 286 R10KCBARRIER(0(ra)) >> 287 /* >> 288 * The "issue break"s below are very approximate. >> 289 * Issue delays for dcache fills will perturb the schedule, as will >> 290 * load queue full replay traps, etc. >> 291 * >> 292 * If len < NBYTES use byte operations. >> 293 */ >> 294 PREFS( 0, 0(src) ) >> 295 PREFD( 1, 0(dst) ) >> 296 sltu t2, len, NBYTES >> 297 and t1, dst, ADDRMASK >> 298 PREFS( 0, 1*32(src) ) >> 299 PREFD( 1, 1*32(dst) ) >> 300 bnez t2, .Lcopy_bytes_checklen\@ >> 301 and t0, src, ADDRMASK >> 302 PREFS( 0, 2*32(src) ) >> 303 PREFD( 1, 2*32(dst) ) >> 304 #ifndef CONFIG_CPU_NO_LOAD_STORE_LR >> 305 bnez t1, .Ldst_unaligned\@ >> 306 nop >> 307 bnez t0, .Lsrc_unaligned_dst_aligned\@ >> 308 #else /* CONFIG_CPU_NO_LOAD_STORE_LR */ >> 309 or t0, t0, t1 >> 310 bnez t0, .Lcopy_unaligned_bytes\@ >> 311 #endif /* CONFIG_CPU_NO_LOAD_STORE_LR */ >> 312 /* >> 313 * use delay slot for fall-through >> 314 * src and dst are aligned; need to compute rem >> 315 */ >> 316 .Lboth_aligned\@: >> 317 SRL t0, len, LOG_NBYTES+3 # +3 for 8 units/iter >> 318 beqz t0, .Lcleanup_both_aligned\@ # len < 8*NBYTES >> 319 and rem, len, (8*NBYTES-1) # rem = len % (8*NBYTES) >> 320 PREFS( 0, 3*32(src) ) >> 321 PREFD( 1, 3*32(dst) ) >> 322 .align 4 >> 323 1: >> 324 R10KCBARRIER(0(ra)) >> 325 LOAD(t0, UNIT(0)(src), .Ll_exc\@) >> 326 LOAD(t1, UNIT(1)(src), .Ll_exc_copy\@) >> 327 LOAD(t2, UNIT(2)(src), .Ll_exc_copy\@) >> 328 LOAD(t3, UNIT(3)(src), .Ll_exc_copy\@) >> 329 SUB len, len, 8*NBYTES >> 330 LOAD(t4, UNIT(4)(src), .Ll_exc_copy\@) >> 331 LOAD(t7, UNIT(5)(src), .Ll_exc_copy\@) >> 332 STORE(t0, UNIT(0)(dst), .Ls_exc_p8u\@) >> 333 STORE(t1, UNIT(1)(dst), .Ls_exc_p7u\@) >> 334 LOAD(t0, UNIT(6)(src), .Ll_exc_copy\@) >> 335 LOAD(t1, UNIT(7)(src), .Ll_exc_copy\@) >> 336 ADD src, src, 8*NBYTES >> 337 ADD dst, dst, 8*NBYTES >> 338 STORE(t2, UNIT(-6)(dst), .Ls_exc_p6u\@) >> 339 STORE(t3, UNIT(-5)(dst), .Ls_exc_p5u\@) >> 340 STORE(t4, UNIT(-4)(dst), .Ls_exc_p4u\@) >> 341 STORE(t7, UNIT(-3)(dst), .Ls_exc_p3u\@) >> 342 STORE(t0, UNIT(-2)(dst), .Ls_exc_p2u\@) >> 343 STORE(t1, UNIT(-1)(dst), .Ls_exc_p1u\@) >> 344 PREFS( 0, 8*32(src) ) >> 345 PREFD( 1, 8*32(dst) ) >> 346 bne len, rem, 1b >> 347 nop >> 348 >> 349 /* >> 350 * len == rem == the number of bytes left to copy < 8*NBYTES >> 351 */ >> 352 .Lcleanup_both_aligned\@: >> 353 beqz len, .Ldone\@ >> 354 sltu t0, len, 4*NBYTES >> 355 bnez t0, .Lless_than_4units\@ >> 356 and rem, len, (NBYTES-1) # rem = len % NBYTES >> 357 /* >> 358 * len >= 4*NBYTES >> 359 */ >> 360 LOAD( t0, UNIT(0)(src), .Ll_exc\@) >> 361 LOAD( t1, UNIT(1)(src), .Ll_exc_copy\@) >> 362 LOAD( t2, UNIT(2)(src), .Ll_exc_copy\@) >> 363 LOAD( t3, UNIT(3)(src), .Ll_exc_copy\@) >> 364 SUB len, len, 4*NBYTES >> 365 ADD src, src, 4*NBYTES >> 366 R10KCBARRIER(0(ra)) >> 367 STORE(t0, UNIT(0)(dst), .Ls_exc_p4u\@) >> 368 STORE(t1, UNIT(1)(dst), .Ls_exc_p3u\@) >> 369 STORE(t2, UNIT(2)(dst), .Ls_exc_p2u\@) >> 370 STORE(t3, UNIT(3)(dst), .Ls_exc_p1u\@) >> 371 .set reorder /* DADDI_WAR */ >> 372 ADD dst, dst, 4*NBYTES >> 373 beqz len, .Ldone\@ >> 374 .set noreorder >> 375 .Lless_than_4units\@: >> 376 /* >> 377 * rem = len % NBYTES >> 378 */ >> 379 beq rem, len, .Lcopy_bytes\@ >> 380 nop >> 381 1: >> 382 R10KCBARRIER(0(ra)) >> 383 LOAD(t0, 0(src), .Ll_exc\@) >> 384 ADD src, src, NBYTES >> 385 SUB len, len, NBYTES >> 386 STORE(t0, 0(dst), .Ls_exc_p1u\@) >> 387 .set reorder /* DADDI_WAR */ >> 388 ADD dst, dst, NBYTES >> 389 bne rem, len, 1b >> 390 .set noreorder >> 391 >> 392 #ifndef CONFIG_CPU_NO_LOAD_STORE_LR >> 393 /* >> 394 * src and dst are aligned, need to copy rem bytes (rem < NBYTES) >> 395 * A loop would do only a byte at a time with possible branch >> 396 * mispredicts. Can't do an explicit LOAD dst,mask,or,STORE >> 397 * because can't assume read-access to dst. Instead, use >> 398 * STREST dst, which doesn't require read access to dst. >> 399 * >> 400 * This code should perform better than a simple loop on modern, >> 401 * wide-issue mips processors because the code has fewer branches and >> 402 * more instruction-level parallelism. >> 403 */ >> 404 #define bits t2 >> 405 beqz len, .Ldone\@ >> 406 ADD t1, dst, len # t1 is just past last byte of dst >> 407 li bits, 8*NBYTES >> 408 SLL rem, len, 3 # rem = number of bits to keep >> 409 LOAD(t0, 0(src), .Ll_exc\@) >> 410 SUB bits, bits, rem # bits = number of bits to discard >> 411 SHIFT_DISCARD t0, t0, bits >> 412 STREST(t0, -1(t1), .Ls_exc\@) >> 413 jr ra >> 414 move len, zero >> 415 .Ldst_unaligned\@: >> 416 /* >> 417 * dst is unaligned >> 418 * t0 = src & ADDRMASK >> 419 * t1 = dst & ADDRMASK; T1 > 0 >> 420 * len >= NBYTES >> 421 * >> 422 * Copy enough bytes to align dst >> 423 * Set match = (src and dst have same alignment) >> 424 */ >> 425 #define match rem >> 426 LDFIRST(t3, FIRST(0)(src), .Ll_exc\@) >> 427 ADD t2, zero, NBYTES >> 428 LDREST(t3, REST(0)(src), .Ll_exc_copy\@) >> 429 SUB t2, t2, t1 # t2 = number of bytes copied >> 430 xor match, t0, t1 >> 431 R10KCBARRIER(0(ra)) >> 432 STFIRST(t3, FIRST(0)(dst), .Ls_exc\@) >> 433 beq len, t2, .Ldone\@ >> 434 SUB len, len, t2 >> 435 ADD dst, dst, t2 >> 436 beqz match, .Lboth_aligned\@ >> 437 ADD src, src, t2 >> 438 >> 439 .Lsrc_unaligned_dst_aligned\@: >> 440 SRL t0, len, LOG_NBYTES+2 # +2 for 4 units/iter >> 441 PREFS( 0, 3*32(src) ) >> 442 beqz t0, .Lcleanup_src_unaligned\@ >> 443 and rem, len, (4*NBYTES-1) # rem = len % 4*NBYTES >> 444 PREFD( 1, 3*32(dst) ) >> 445 1: >> 446 /* >> 447 * Avoid consecutive LD*'s to the same register since some mips >> 448 * implementations can't issue them in the same cycle. >> 449 * It's OK to load FIRST(N+1) before REST(N) because the two addresses >> 450 * are to the same unit (unless src is aligned, but it's not). >> 451 */ >> 452 R10KCBARRIER(0(ra)) >> 453 LDFIRST(t0, FIRST(0)(src), .Ll_exc\@) >> 454 LDFIRST(t1, FIRST(1)(src), .Ll_exc_copy\@) >> 455 SUB len, len, 4*NBYTES >> 456 LDREST(t0, REST(0)(src), .Ll_exc_copy\@) >> 457 LDREST(t1, REST(1)(src), .Ll_exc_copy\@) >> 458 LDFIRST(t2, FIRST(2)(src), .Ll_exc_copy\@) >> 459 LDFIRST(t3, FIRST(3)(src), .Ll_exc_copy\@) >> 460 LDREST(t2, REST(2)(src), .Ll_exc_copy\@) >> 461 LDREST(t3, REST(3)(src), .Ll_exc_copy\@) >> 462 PREFS( 0, 9*32(src) ) # 0 is PREF_LOAD (not streamed) >> 463 ADD src, src, 4*NBYTES >> 464 #ifdef CONFIG_CPU_SB1 >> 465 nop # improves slotting >> 466 #endif >> 467 STORE(t0, UNIT(0)(dst), .Ls_exc_p4u\@) >> 468 STORE(t1, UNIT(1)(dst), .Ls_exc_p3u\@) >> 469 STORE(t2, UNIT(2)(dst), .Ls_exc_p2u\@) >> 470 STORE(t3, UNIT(3)(dst), .Ls_exc_p1u\@) >> 471 PREFD( 1, 9*32(dst) ) # 1 is PREF_STORE (not streamed) >> 472 .set reorder /* DADDI_WAR */ >> 473 ADD dst, dst, 4*NBYTES >> 474 bne len, rem, 1b >> 475 .set noreorder >> 476 >> 477 .Lcleanup_src_unaligned\@: >> 478 beqz len, .Ldone\@ >> 479 and rem, len, NBYTES-1 # rem = len % NBYTES >> 480 beq rem, len, .Lcopy_bytes\@ >> 481 nop >> 482 1: >> 483 R10KCBARRIER(0(ra)) >> 484 LDFIRST(t0, FIRST(0)(src), .Ll_exc\@) >> 485 LDREST(t0, REST(0)(src), .Ll_exc_copy\@) >> 486 ADD src, src, NBYTES >> 487 SUB len, len, NBYTES >> 488 STORE(t0, 0(dst), .Ls_exc_p1u\@) >> 489 .set reorder /* DADDI_WAR */ >> 490 ADD dst, dst, NBYTES >> 491 bne len, rem, 1b >> 492 .set noreorder >> 493 >> 494 #endif /* !CONFIG_CPU_NO_LOAD_STORE_LR */ >> 495 .Lcopy_bytes_checklen\@: >> 496 beqz len, .Ldone\@ >> 497 nop >> 498 .Lcopy_bytes\@: >> 499 /* 0 < len < NBYTES */ >> 500 R10KCBARRIER(0(ra)) >> 501 #define COPY_BYTE(N) \ >> 502 LOADB(t0, N(src), .Ll_exc\@); \ >> 503 SUB len, len, 1; \ >> 504 beqz len, .Ldone\@; \ >> 505 STOREB(t0, N(dst), .Ls_exc_p1\@) >> 506 >> 507 COPY_BYTE(0) >> 508 COPY_BYTE(1) >> 509 #ifdef USE_DOUBLE >> 510 COPY_BYTE(2) >> 511 COPY_BYTE(3) >> 512 COPY_BYTE(4) >> 513 COPY_BYTE(5) >> 514 #endif >> 515 LOADB(t0, NBYTES-2(src), .Ll_exc\@) >> 516 SUB len, len, 1 >> 517 jr ra >> 518 STOREB(t0, NBYTES-2(dst), .Ls_exc_p1\@) >> 519 .Ldone\@: 79 jr ra 520 jr ra >> 521 nop 80 522 81 .align 5 !! 523 #ifdef CONFIG_CPU_NO_LOAD_STORE_LR 82 4: ld.w t0, a1, 0 !! 524 .Lcopy_unaligned_bytes\@: 83 st.w t0, a0, 0 !! 525 1: >> 526 COPY_BYTE(0) >> 527 COPY_BYTE(1) >> 528 COPY_BYTE(2) >> 529 COPY_BYTE(3) >> 530 COPY_BYTE(4) >> 531 COPY_BYTE(5) >> 532 COPY_BYTE(6) >> 533 COPY_BYTE(7) >> 534 ADD src, src, 8 >> 535 b 1b >> 536 ADD dst, dst, 8 >> 537 #endif /* CONFIG_CPU_NO_LOAD_STORE_LR */ >> 538 .if __memcpy == 1 >> 539 END(memcpy) >> 540 .set __memcpy, 0 >> 541 .hidden __memcpy >> 542 .endif >> 543 >> 544 .Ll_exc_copy\@: >> 545 /* >> 546 * Copy bytes from src until faulting load address (or until a >> 547 * lb faults) >> 548 * >> 549 * When reached by a faulting LDFIRST/LDREST, THREAD_BUADDR($28) >> 550 * may be more than a byte beyond the last address. >> 551 * Hence, the lb below may get an exception. >> 552 * >> 553 * Assumes src < THREAD_BUADDR($28) >> 554 */ >> 555 LOADK t0, TI_TASK($28) >> 556 nop >> 557 LOADK t0, THREAD_BUADDR(t0) >> 558 1: >> 559 LOADB(t1, 0(src), .Ll_exc\@) >> 560 ADD src, src, 1 >> 561 sb t1, 0(dst) # can't fault -- we're copy_from_user >> 562 .set reorder /* DADDI_WAR */ >> 563 ADD dst, dst, 1 >> 564 bne src, t0, 1b >> 565 .set noreorder >> 566 .Ll_exc\@: >> 567 LOADK t0, TI_TASK($28) >> 568 nop >> 569 LOADK t0, THREAD_BUADDR(t0) # t0 is just past last good address >> 570 nop >> 571 SUB len, AT, t0 # len number of uncopied bytes 84 jr ra 572 jr ra >> 573 nop 85 574 86 .align 5 !! 575 #define SEXC(n) \ 87 5: ld.w t0, a1, 0 !! 576 .set reorder; /* DADDI_WAR */ \ 88 ld.b t1, a1, 4 !! 577 .Ls_exc_p ## n ## u\@: \ 89 st.w t0, a0, 0 !! 578 ADD len, len, n*NBYTES; \ 90 st.b t1, a0, 4 !! 579 jr ra; \ >> 580 .set noreorder >> 581 >> 582 SEXC(8) >> 583 SEXC(7) >> 584 SEXC(6) >> 585 SEXC(5) >> 586 SEXC(4) >> 587 SEXC(3) >> 588 SEXC(2) >> 589 SEXC(1) >> 590 >> 591 .Ls_exc_p1\@: >> 592 .set reorder /* DADDI_WAR */ >> 593 ADD len, len, 1 >> 594 jr ra >> 595 .set noreorder >> 596 .Ls_exc\@: 91 jr ra 597 jr ra >> 598 nop >> 599 .endm 92 600 >> 601 #ifndef CONFIG_HAVE_PLAT_MEMCPY 93 .align 5 602 .align 5 94 6: ld.w t0, a1, 0 !! 603 LEAF(memmove) 95 ld.h t1, a1, 4 !! 604 EXPORT_SYMBOL(memmove) 96 st.w t0, a0, 0 !! 605 ADD t0, a0, a2 97 st.h t1, a0, 4 !! 606 ADD t1, a1, a2 >> 607 sltu t0, a1, t0 # dst + len <= src -> memcpy >> 608 sltu t1, a0, t1 # dst >= src + len -> memcpy >> 609 and t0, t1 >> 610 beqz t0, .L__memcpy >> 611 move v0, a0 /* return value */ >> 612 beqz a2, .Lr_out >> 613 END(memmove) >> 614 >> 615 /* fall through to __rmemcpy */ >> 616 LEAF(__rmemcpy) /* a0=dst a1=src a2=len */ >> 617 sltu t0, a1, a0 >> 618 beqz t0, .Lr_end_bytes_up # src >= dst >> 619 nop >> 620 ADD a0, a2 # dst = dst + len >> 621 ADD a1, a2 # src = src + len >> 622 >> 623 .Lr_end_bytes: >> 624 R10KCBARRIER(0(ra)) >> 625 lb t0, -1(a1) >> 626 SUB a2, a2, 0x1 >> 627 sb t0, -1(a0) >> 628 SUB a1, a1, 0x1 >> 629 .set reorder /* DADDI_WAR */ >> 630 SUB a0, a0, 0x1 >> 631 bnez a2, .Lr_end_bytes >> 632 .set noreorder >> 633 >> 634 .Lr_out: 98 jr ra 635 jr ra >> 636 move a2, zero >> 637 >> 638 .Lr_end_bytes_up: >> 639 R10KCBARRIER(0(ra)) >> 640 lb t0, (a1) >> 641 SUB a2, a2, 0x1 >> 642 sb t0, (a0) >> 643 ADD a1, a1, 0x1 >> 644 .set reorder /* DADDI_WAR */ >> 645 ADD a0, a0, 0x1 >> 646 bnez a2, .Lr_end_bytes_up >> 647 .set noreorder 99 648 100 .align 5 << 101 7: ld.w t0, a1, 0 << 102 ld.w t1, a1, 3 << 103 st.w t0, a0, 0 << 104 st.w t1, a0, 3 << 105 jr ra 649 jr ra >> 650 move a2, zero >> 651 END(__rmemcpy) 106 652 >> 653 /* >> 654 * A combined memcpy/__copy_user >> 655 * __copy_user sets len to 0 for success; else to an upper bound of >> 656 * the number of uncopied bytes. >> 657 * memcpy sets v0 to dst. >> 658 */ 107 .align 5 659 .align 5 108 8: ld.d t0, a1, 0 !! 660 LEAF(memcpy) /* a0=dst a1=src a2=len */ 109 st.d t0, a0, 0 !! 661 EXPORT_SYMBOL(memcpy) 110 jr ra !! 662 move v0, dst /* return value */ 111 SYM_FUNC_END(__memcpy_small) !! 663 .L__memcpy: 112 _ASM_NOKPROBE(__memcpy_small) !! 664 #ifndef CONFIG_EVA >> 665 FEXPORT(__raw_copy_from_user) >> 666 EXPORT_SYMBOL(__raw_copy_from_user) >> 667 FEXPORT(__raw_copy_to_user) >> 668 EXPORT_SYMBOL(__raw_copy_to_user) >> 669 #endif >> 670 /* Legacy Mode, user <-> user */ >> 671 __BUILD_COPY_USER LEGACY_MODE USEROP USEROP >> 672 >> 673 #endif >> 674 >> 675 #ifdef CONFIG_EVA 113 676 114 /* 677 /* 115 * void *__memcpy_fast(void *dst, const void * !! 678 * For EVA we need distinct symbols for reading and writing to user space. 116 * !! 679 * This is because we need to use specific EVA instructions to perform the 117 * a0: dst !! 680 * virtual <-> physical translation when a virtual address is actually in user 118 * a1: src !! 681 * space 119 * a2: n !! 682 */ 120 */ << 121 SYM_FUNC_START(__memcpy_fast) << 122 sltui t0, a2, 9 << 123 bnez t0, __memcpy_small << 124 << 125 add.d a3, a1, a2 << 126 add.d a2, a0, a2 << 127 ld.d a6, a1, 0 << 128 ld.d a7, a3, -8 << 129 << 130 /* align up destination address */ << 131 andi t1, a0, 7 << 132 sub.d t0, zero, t1 << 133 addi.d t0, t0, 8 << 134 add.d a1, a1, t0 << 135 add.d a5, a0, t0 << 136 << 137 addi.d a4, a3, -64 << 138 bgeu a1, a4, .Llt64 << 139 << 140 /* copy 64 bytes at a time */ << 141 .Lloop64: << 142 ld.d t0, a1, 0 << 143 ld.d t1, a1, 8 << 144 ld.d t2, a1, 16 << 145 ld.d t3, a1, 24 << 146 ld.d t4, a1, 32 << 147 ld.d t5, a1, 40 << 148 ld.d t6, a1, 48 << 149 ld.d t7, a1, 56 << 150 addi.d a1, a1, 64 << 151 st.d t0, a5, 0 << 152 st.d t1, a5, 8 << 153 st.d t2, a5, 16 << 154 st.d t3, a5, 24 << 155 st.d t4, a5, 32 << 156 st.d t5, a5, 40 << 157 st.d t6, a5, 48 << 158 st.d t7, a5, 56 << 159 addi.d a5, a5, 64 << 160 bltu a1, a4, .Lloop64 << 161 << 162 /* copy the remaining bytes */ << 163 .Llt64: << 164 addi.d a4, a3, -32 << 165 bgeu a1, a4, .Llt32 << 166 ld.d t0, a1, 0 << 167 ld.d t1, a1, 8 << 168 ld.d t2, a1, 16 << 169 ld.d t3, a1, 24 << 170 addi.d a1, a1, 32 << 171 st.d t0, a5, 0 << 172 st.d t1, a5, 8 << 173 st.d t2, a5, 16 << 174 st.d t3, a5, 24 << 175 addi.d a5, a5, 32 << 176 << 177 .Llt32: << 178 addi.d a4, a3, -16 << 179 bgeu a1, a4, .Llt16 << 180 ld.d t0, a1, 0 << 181 ld.d t1, a1, 8 << 182 addi.d a1, a1, 16 << 183 st.d t0, a5, 0 << 184 st.d t1, a5, 8 << 185 addi.d a5, a5, 16 << 186 << 187 .Llt16: << 188 addi.d a4, a3, -8 << 189 bgeu a1, a4, .Llt8 << 190 ld.d t0, a1, 0 << 191 st.d t0, a5, 0 << 192 << 193 .Llt8: << 194 st.d a6, a0, 0 << 195 st.d a7, a2, -8 << 196 683 197 /* return */ !! 684 /* 198 jr ra !! 685 * __copy_from_user (EVA) 199 SYM_FUNC_END(__memcpy_fast) !! 686 */ 200 _ASM_NOKPROBE(__memcpy_fast) !! 687 >> 688 LEAF(__raw_copy_from_user) >> 689 EXPORT_SYMBOL(__raw_copy_from_user) >> 690 __BUILD_COPY_USER EVA_MODE USEROP KERNELOP >> 691 END(__raw_copy_from_user) >> 692 >> 693 >> 694 >> 695 /* >> 696 * __copy_to_user (EVA) >> 697 */ >> 698 >> 699 LEAF(__raw_copy_to_user) >> 700 EXPORT_SYMBOL(__raw_copy_to_user) >> 701 __BUILD_COPY_USER EVA_MODE KERNELOP USEROP >> 702 END(__raw_copy_to_user) 201 703 202 STACK_FRAME_NON_STANDARD __memcpy_small !! 704 #endif
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.