| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /* | 
					
						
							|  |  |  |  * This file is subject to the terms and conditions of the GNU General Public | 
					
						
							|  |  |  |  * License.  See the file "COPYING" in the main directory of this archive | 
					
						
							|  |  |  |  * for more details. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Unified implementation of memcpy, memmove and the __copy_user backend. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Copyright (C) 1998, 99, 2000, 01, 2002 Ralf Baechle (ralf@gnu.org)
 | 
					
						
							|  |  |  |  * Copyright (C) 1999, 2000, 01, 2002 Silicon Graphics, Inc. | 
					
						
							|  |  |  |  * Copyright (C) 2002 Broadcom, Inc. | 
					
						
							|  |  |  |  *   memcpy/copy_user author: Mark Vandevoorde | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  |  * Copyright (C) 2007  Maciej W. Rozycki | 
					
						
							| 
									
										
										
										
											2014-01-07 12:57:04 +00:00
										 |  |  |  * Copyright (C) 2014 Imagination Technologies Ltd. | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  * | 
					
						
							|  |  |  |  * Mnemonic names for arguments to memcpy/__copy_user | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2005-10-20 22:55:26 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * Hack to resolve longstanding prefetch issue | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Prefetching may be fatal on some systems if we're prefetching beyond the | 
					
						
							|  |  |  |  * end of memory on some systems.  It's also a seriously bad idea on non | 
					
						
							|  |  |  |  * dma-coherent systems. | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2009-01-28 17:48:40 +00:00
										 |  |  | #ifdef CONFIG_DMA_NONCOHERENT | 
					
						
							| 
									
										
										
										
											2005-10-20 22:55:26 +01:00
										 |  |  | #undef CONFIG_CPU_HAS_PREFETCH | 
					
						
							|  |  |  | #endif | 
					
						
							|  |  |  | #ifdef CONFIG_MIPS_MALTA | 
					
						
							|  |  |  | #undef CONFIG_CPU_HAS_PREFETCH | 
					
						
							|  |  |  | #endif | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #include <asm/asm.h> | 
					
						
							| 
									
										
										
										
											2005-09-09 22:32:31 +02:00
										 |  |  | #include <asm/asm-offsets.h> | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #include <asm/regdef.h> | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define dst a0 | 
					
						
							|  |  |  | #define src a1 | 
					
						
							|  |  |  | #define len a2 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * Spec | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * memcpy copies len bytes from src to dst and sets v0 to dst. | 
					
						
							|  |  |  |  * It assumes that | 
					
						
							|  |  |  |  *   - src and dst don't overlap | 
					
						
							|  |  |  |  *   - src is readable | 
					
						
							|  |  |  |  *   - dst is writable | 
					
						
							|  |  |  |  * memcpy uses the standard calling convention | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * __copy_user copies up to len bytes from src to dst and sets a2 (len) to | 
					
						
							|  |  |  |  * the number of uncopied bytes due to an exception caused by a read or write. | 
					
						
							|  |  |  |  * __copy_user assumes that src and dst don't overlap, and that the call is | 
					
						
							|  |  |  |  * implementing one of the following: | 
					
						
							|  |  |  |  *   copy_to_user | 
					
						
							|  |  |  |  *     - src is readable  (no exceptions when reading src) | 
					
						
							|  |  |  |  *   copy_from_user | 
					
						
							|  |  |  |  *     - dst is writable  (no exceptions when writing dst) | 
					
						
							|  |  |  |  * __copy_user uses a non-standard calling convention; see
 | 
					
						
							|  |  |  |  * include/asm-mips/uaccess.h | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * When an exception happens on a load, the handler must | 
					
						
							|  |  |  |  # ensure that all of the destination buffer is overwritten to prevent | 
					
						
							|  |  |  |  * leaking information to user mode programs. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * Implementation | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * The exception handler for loads requires that: | 
					
						
							|  |  |  |  *  1- AT contain the address of the byte just past the end of the source | 
					
						
							|  |  |  |  *     of the copy, | 
					
						
							|  |  |  |  *  2- src_entry <= src < AT, and | 
					
						
							|  |  |  |  *  3- (dst - src) == (dst_entry - src_entry), | 
					
						
							|  |  |  |  * The _entry suffix denotes values when __copy_user was called. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * (1) is set up up by uaccess.h and maintained by not writing AT in copy_user | 
					
						
							|  |  |  |  * (2) is met by incrementing src by the number of bytes copied | 
					
						
							|  |  |  |  * (3) is met by not doing loads between a pair of increments of dst and src | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The exception handlers for stores adjust len (if necessary) and return. | 
					
						
							|  |  |  |  * These handlers do not need to overwrite any data. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * For __rmemcpy and memmove an exception is always a kernel bug, therefore | 
					
						
							|  |  |  |  * they're not protected. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 12:57:04 +00:00
										 |  |  | /* Instruction type */ | 
					
						
							|  |  |  | #define LD_INSN 1 | 
					
						
							|  |  |  | #define ST_INSN 2 | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | /* Pretech type */ | 
					
						
							|  |  |  | #define SRC_PREFETCH 1 | 
					
						
							|  |  |  | #define DST_PREFETCH 2 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | #define LEGACY_MODE 1 | 
					
						
							|  |  |  | #define EVA_MODE    2 | 
					
						
							|  |  |  | #define USEROP   1 | 
					
						
							|  |  |  | #define KERNELOP 2 | 
					
						
							| 
									
										
										
										
											2014-01-07 12:57:04 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * Wrapper to add an entry in the exception table | 
					
						
							|  |  |  |  * in case the insn causes a memory exception. | 
					
						
							|  |  |  |  * Arguments: | 
					
						
							|  |  |  |  * insn    : Load/store instruction | 
					
						
							|  |  |  |  * type    : Instruction type | 
					
						
							|  |  |  |  * reg     : Register | 
					
						
							|  |  |  |  * addr    : Address | 
					
						
							|  |  |  |  * handler : Exception handler | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | #define EXC(insn, type, reg, addr, handler)			\ | 
					
						
							|  |  |  | 	.if \mode == LEGACY_MODE;				\
 | 
					
						
							|  |  |  | 9:		insn reg, addr;					\
 | 
					
						
							|  |  |  | 		.section __ex_table,"a";			\
 | 
					
						
							|  |  |  | 		PTR	9b, handler;				\
 | 
					
						
							|  |  |  | 		.previous;					\
 | 
					
						
							| 
									
										
										
										
											2014-01-07 16:20:22 +00:00
										 |  |  | 	/* This is assembled in EVA mode */			\ | 
					
						
							|  |  |  | 	.else;							\
 | 
					
						
							|  |  |  | 		/* If loading from user or storing to user */	\ | 
					
						
							|  |  |  | 		.if ((\from == USEROP) && (type == LD_INSN)) || \ | 
					
						
							|  |  |  | 		    ((\to == USEROP) && (type == ST_INSN));	\
 | 
					
						
							|  |  |  | 9:			__BUILD_EVA_INSN(insn##e, reg, addr);	\ | 
					
						
							|  |  |  | 			.section __ex_table,"a";		\
 | 
					
						
							|  |  |  | 			PTR	9b, handler;			\
 | 
					
						
							|  |  |  | 			.previous;				\
 | 
					
						
							|  |  |  | 		.else;						\
 | 
					
						
							|  |  |  | 			/*					\ | 
					
						
							|  |  |  | 			 *  Still in EVA, but no need for	\ | 
					
						
							|  |  |  | 			 * exception handler or EVA insn	\ | 
					
						
							|  |  |  | 			 */					\ | 
					
						
							|  |  |  | 			insn reg, addr;				\
 | 
					
						
							|  |  |  | 		.endif;						\
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	.endif | 
					
						
							| 
									
										
										
										
											2014-01-07 16:20:22 +00:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /* | 
					
						
							|  |  |  |  * Only on the 64-bit kernel we can made use of 64-bit registers. | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:16 -07:00
										 |  |  | #ifdef CONFIG_64BIT | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #define USE_DOUBLE | 
					
						
							|  |  |  | #endif | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #ifdef USE_DOUBLE | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 12:57:04 +00:00
										 |  |  | #define LOADK ld /* No exception */ | 
					
						
							|  |  |  | #define LOAD(reg, addr, handler)	EXC(ld, LD_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define LOADL(reg, addr, handler)	EXC(ldl, LD_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define LOADR(reg, addr, handler)	EXC(ldr, LD_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define STOREL(reg, addr, handler)	EXC(sdl, ST_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define STORER(reg, addr, handler)	EXC(sdr, ST_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define STORE(reg, addr, handler)	EXC(sd, ST_INSN, reg, addr, handler) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #define ADD    daddu | 
					
						
							|  |  |  | #define SUB    dsubu | 
					
						
							|  |  |  | #define SRL    dsrl | 
					
						
							|  |  |  | #define SRA    dsra | 
					
						
							|  |  |  | #define SLL    dsll | 
					
						
							|  |  |  | #define SLLV   dsllv | 
					
						
							|  |  |  | #define SRLV   dsrlv | 
					
						
							|  |  |  | #define NBYTES 8 | 
					
						
							|  |  |  | #define LOG_NBYTES 3 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:17 -07:00
										 |  |  | /* | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  * As we are sharing code base with the mips32 tree (which use the o32 ABI | 
					
						
							|  |  |  |  * register definitions). We need to redefine the register definitions from | 
					
						
							|  |  |  |  * the n64 ABI register naming to the o32 ABI register naming. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | #undef t0 | 
					
						
							|  |  |  | #undef t1 | 
					
						
							|  |  |  | #undef t2 | 
					
						
							|  |  |  | #undef t3 | 
					
						
							|  |  |  | #define t0	$8 | 
					
						
							|  |  |  | #define t1	$9 | 
					
						
							|  |  |  | #define t2	$10 | 
					
						
							|  |  |  | #define t3	$11 | 
					
						
							|  |  |  | #define t4	$12 | 
					
						
							|  |  |  | #define t5	$13 | 
					
						
							|  |  |  | #define t6	$14 | 
					
						
							|  |  |  | #define t7	$15 | 
					
						
							| 
									
										
										
										
											2005-09-03 15:56:17 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #else | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 12:57:04 +00:00
										 |  |  | #define LOADK lw /* No exception */ | 
					
						
							|  |  |  | #define LOAD(reg, addr, handler)	EXC(lw, LD_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define LOADL(reg, addr, handler)	EXC(lwl, LD_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define LOADR(reg, addr, handler)	EXC(lwr, LD_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define STOREL(reg, addr, handler)	EXC(swl, ST_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define STORER(reg, addr, handler)	EXC(swr, ST_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define STORE(reg, addr, handler)	EXC(sw, ST_INSN, reg, addr, handler) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #define ADD    addu | 
					
						
							|  |  |  | #define SUB    subu | 
					
						
							|  |  |  | #define SRL    srl | 
					
						
							|  |  |  | #define SLL    sll | 
					
						
							|  |  |  | #define SRA    sra | 
					
						
							|  |  |  | #define SLLV   sllv | 
					
						
							|  |  |  | #define SRLV   srlv | 
					
						
							|  |  |  | #define NBYTES 4 | 
					
						
							|  |  |  | #define LOG_NBYTES 2 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #endif /* USE_DOUBLE */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 12:57:04 +00:00
										 |  |  | #define LOADB(reg, addr, handler)	EXC(lb, LD_INSN, reg, addr, handler) | 
					
						
							|  |  |  | #define STOREB(reg, addr, handler)	EXC(sb, ST_INSN, reg, addr, handler) | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | #define _PREF(hint, addr, type)						\ | 
					
						
							|  |  |  | 	.if \mode == LEGACY_MODE;					\
 | 
					
						
							|  |  |  | 		PREF(hint, addr);					\
 | 
					
						
							| 
									
										
										
										
											2014-01-07 16:20:22 +00:00
										 |  |  | 	.else;								\
 | 
					
						
							|  |  |  | 		.if ((\from == USEROP) && (type == SRC_PREFETCH)) ||	\ | 
					
						
							|  |  |  | 		    ((\to == USEROP) && (type == DST_PREFETCH));	\
 | 
					
						
							|  |  |  | 			/*						\ | 
					
						
							|  |  |  | 			 * PREFE has only 9 bits for the offset		\ | 
					
						
							|  |  |  | 			 * compared to PREF which has 16, so it may	\ | 
					
						
							|  |  |  | 			 * need to use the $at register but this	\ | 
					
						
							|  |  |  | 			 * register should remain intact because it's	\ | 
					
						
							|  |  |  | 			 * used later on. Therefore use $v1.		\ | 
					
						
							|  |  |  | 			 */						\ | 
					
						
							|  |  |  | 			.set at=v1;					\
 | 
					
						
							|  |  |  | 			PREFE(hint, addr);				\
 | 
					
						
							|  |  |  | 			.set noat;					\
 | 
					
						
							|  |  |  | 		.else;							\
 | 
					
						
							|  |  |  | 			PREF(hint, addr);				\
 | 
					
						
							|  |  |  | 		.endif;							\
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	.endif | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | #define PREFS(hint, addr) _PREF(hint, addr, SRC_PREFETCH) | 
					
						
							|  |  |  | #define PREFD(hint, addr) _PREF(hint, addr, DST_PREFETCH) | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #ifdef CONFIG_CPU_LITTLE_ENDIAN | 
					
						
							|  |  |  | #define LDFIRST LOADR | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | #define LDREST	LOADL | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #define STFIRST STORER | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | #define STREST	STOREL | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #define SHIFT_DISCARD SLLV | 
					
						
							|  |  |  | #else | 
					
						
							|  |  |  | #define LDFIRST LOADL | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | #define LDREST	LOADR | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #define STFIRST STOREL | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | #define STREST	STORER | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #define SHIFT_DISCARD SRLV | 
					
						
							|  |  |  | #endif | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define FIRST(unit) ((unit)*NBYTES) | 
					
						
							|  |  |  | #define REST(unit)  (FIRST(unit)+NBYTES-1) | 
					
						
							|  |  |  | #define UNIT(unit)  FIRST(unit) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define ADDRMASK (NBYTES-1) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	.text | 
					
						
							|  |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | #ifndef CONFIG_CPU_DADDI_WORKAROUNDS | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	.set	noat
 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | #else | 
					
						
							|  |  |  | 	.set	at=v1 | 
					
						
							|  |  |  | #endif | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	.align	5
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/* | 
					
						
							|  |  |  | 	 * Macro to build the __copy_user common code | 
					
						
							|  |  |  | 	 * Arguements: | 
					
						
							|  |  |  | 	 * mode : LEGACY_MODE or EVA_MODE | 
					
						
							|  |  |  | 	 * from : Source operand. USEROP or KERNELOP | 
					
						
							|  |  |  | 	 * to   : Destination operand. USEROP or KERNELOP | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	.macro __BUILD_COPY_USER mode, from, to | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* initialize __memcpy if this the first time we execute this macro */ | 
					
						
							|  |  |  | 	.ifnotdef __memcpy
 | 
					
						
							|  |  |  | 	.set __memcpy, 1 | 
					
						
							|  |  |  | 	.hidden __memcpy /* make sure it does not leak */ | 
					
						
							|  |  |  | 	.endif | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	/* | 
					
						
							|  |  |  | 	 * Note: dst & src may be unaligned, len may be 0 | 
					
						
							|  |  |  | 	 * Temps | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | #define rem t8 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-11-25 11:47:56 +01:00
										 |  |  | 	R10KCBARRIER(0(ra)) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	/* | 
					
						
							|  |  |  | 	 * The "issue break"s below are very approximate. | 
					
						
							|  |  |  | 	 * Issue delays for dcache fills will perturb the schedule, as will | 
					
						
							|  |  |  | 	 * load queue full replay traps, etc. | 
					
						
							|  |  |  | 	 * | 
					
						
							|  |  |  | 	 * If len < NBYTES use byte operations. | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | 	PREFS(	0, 0(src) ) | 
					
						
							|  |  |  | 	PREFD(	1, 0(dst) ) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	sltu	t2, len, NBYTES | 
					
						
							|  |  |  | 	and	t1, dst, ADDRMASK | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | 	PREFS(	0, 1*32(src) ) | 
					
						
							|  |  |  | 	PREFD(	1, 1*32(dst) ) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	bnez	t2, .Lcopy_bytes_checklen\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 and	t0, src, ADDRMASK | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | 	PREFS(	0, 2*32(src) ) | 
					
						
							|  |  |  | 	PREFD(	1, 2*32(dst) ) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	bnez	t1, .Ldst_unaligned\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 nop | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	bnez	t0, .Lsrc_unaligned_dst_aligned\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	/* | 
					
						
							|  |  |  | 	 * use delay slot for fall-through | 
					
						
							|  |  |  | 	 * src and dst are aligned; need to compute rem
 | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Lboth_aligned\@:
 | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | 	 SRL	t0, len, LOG_NBYTES+3	 # +3 for 8 units/iter | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	beqz	t0, .Lcleanup_both_aligned\@ # len < 8*NBYTES
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 and	rem, len, (8*NBYTES-1)	 # rem = len % (8*NBYTES) | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | 	PREFS(	0, 3*32(src) ) | 
					
						
							|  |  |  | 	PREFD(	1, 3*32(dst) ) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	.align	4
 | 
					
						
							|  |  |  | 1: | 
					
						
							| 
									
										
										
										
											2007-11-25 11:47:56 +01:00
										 |  |  | 	R10KCBARRIER(0(ra)) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LOAD(t0, UNIT(0)(src), .Ll_exc\@)
 | 
					
						
							|  |  |  | 	LOAD(t1, UNIT(1)(src), .Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LOAD(t2, UNIT(2)(src), .Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LOAD(t3, UNIT(3)(src), .Ll_exc_copy\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	SUB	len, len, 8*NBYTES | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LOAD(t4, UNIT(4)(src), .Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LOAD(t7, UNIT(5)(src), .Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	STORE(t0, UNIT(0)(dst),	.Ls_exc_p8u\@)
 | 
					
						
							|  |  |  | 	STORE(t1, UNIT(1)(dst),	.Ls_exc_p7u\@)
 | 
					
						
							|  |  |  | 	LOAD(t0, UNIT(6)(src), .Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LOAD(t1, UNIT(7)(src), .Ll_exc_copy\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	ADD	src, src, 8*NBYTES | 
					
						
							|  |  |  | 	ADD	dst, dst, 8*NBYTES | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	STORE(t2, UNIT(-6)(dst), .Ls_exc_p6u\@)
 | 
					
						
							|  |  |  | 	STORE(t3, UNIT(-5)(dst), .Ls_exc_p5u\@)
 | 
					
						
							|  |  |  | 	STORE(t4, UNIT(-4)(dst), .Ls_exc_p4u\@)
 | 
					
						
							|  |  |  | 	STORE(t7, UNIT(-3)(dst), .Ls_exc_p3u\@)
 | 
					
						
							|  |  |  | 	STORE(t0, UNIT(-2)(dst), .Ls_exc_p2u\@)
 | 
					
						
							|  |  |  | 	STORE(t1, UNIT(-1)(dst), .Ls_exc_p1u\@)
 | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | 	PREFS(	0, 8*32(src) ) | 
					
						
							|  |  |  | 	PREFD(	1, 8*32(dst) ) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	bne	len, rem, 1b | 
					
						
							|  |  |  | 	 nop | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* | 
					
						
							|  |  |  | 	 * len == rem == the number of bytes left to copy < 8*NBYTES | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Lcleanup_both_aligned\@:
 | 
					
						
							|  |  |  | 	beqz	len, .Ldone\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 sltu	t0, len, 4*NBYTES | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	bnez	t0, .Lless_than_4units\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 and	rem, len, (NBYTES-1)	# rem = len % NBYTES | 
					
						
							|  |  |  | 	/* | 
					
						
							|  |  |  | 	 * len >= 4*NBYTES | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LOAD( t0, UNIT(0)(src),	.Ll_exc\@)
 | 
					
						
							|  |  |  | 	LOAD( t1, UNIT(1)(src),	.Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LOAD( t2, UNIT(2)(src),	.Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LOAD( t3, UNIT(3)(src),	.Ll_exc_copy\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	SUB	len, len, 4*NBYTES | 
					
						
							|  |  |  | 	ADD	src, src, 4*NBYTES | 
					
						
							| 
									
										
										
										
											2007-11-25 11:47:56 +01:00
										 |  |  | 	R10KCBARRIER(0(ra)) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	STORE(t0, UNIT(0)(dst),	.Ls_exc_p4u\@)
 | 
					
						
							|  |  |  | 	STORE(t1, UNIT(1)(dst),	.Ls_exc_p3u\@)
 | 
					
						
							|  |  |  | 	STORE(t2, UNIT(2)(dst),	.Ls_exc_p2u\@)
 | 
					
						
							|  |  |  | 	STORE(t3, UNIT(3)(dst),	.Ls_exc_p1u\@)
 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	reorder				/* DADDI_WAR */ | 
					
						
							|  |  |  | 	ADD	dst, dst, 4*NBYTES | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	beqz	len, .Ldone\@
 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Lless_than_4units\@:
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	/* | 
					
						
							|  |  |  | 	 * rem = len % NBYTES | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	beq	rem, len, .Lcopy_bytes\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 nop | 
					
						
							|  |  |  | 1: | 
					
						
							| 
									
										
										
										
											2007-11-25 11:47:56 +01:00
										 |  |  | 	R10KCBARRIER(0(ra)) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LOAD(t0, 0(src), .Ll_exc\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	ADD	src, src, NBYTES | 
					
						
							|  |  |  | 	SUB	len, len, NBYTES | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	STORE(t0, 0(dst), .Ls_exc_p1u\@)
 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	reorder				/* DADDI_WAR */ | 
					
						
							|  |  |  | 	ADD	dst, dst, NBYTES | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	bne	rem, len, 1b | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/* | 
					
						
							|  |  |  | 	 * src and dst are aligned, need to copy rem bytes (rem < NBYTES) | 
					
						
							|  |  |  | 	 * A loop would do only a byte at a time with possible branch | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | 	 * mispredicts.	 Can't do an explicit LOAD dst,mask,or,STORE | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 * because can't assume read-access to dst.  Instead, use | 
					
						
							|  |  |  | 	 * STREST dst, which doesn't require read access to dst. | 
					
						
							|  |  |  | 	 * | 
					
						
							|  |  |  | 	 * This code should perform better than a simple loop on modern, | 
					
						
							|  |  |  | 	 * wide-issue mips processors because the code has fewer branches and | 
					
						
							|  |  |  | 	 * more instruction-level parallelism. | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | #define bits t2 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	beqz	len, .Ldone\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 ADD	t1, dst, len	# t1 is just past last byte of dst | 
					
						
							|  |  |  | 	li	bits, 8*NBYTES | 
					
						
							|  |  |  | 	SLL	rem, len, 3	# rem = number of bits to keep | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LOAD(t0, 0(src), .Ll_exc\@)
 | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | 	SUB	bits, bits, rem # bits = number of bits to discard | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	SHIFT_DISCARD t0, t0, bits | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	STREST(t0, -1(t1), .Ls_exc\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	jr	ra | 
					
						
							|  |  |  | 	 move	len, zero | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Ldst_unaligned\@:
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	/* | 
					
						
							|  |  |  | 	 * dst is unaligned | 
					
						
							|  |  |  | 	 * t0 = src & ADDRMASK | 
					
						
							|  |  |  | 	 * t1 = dst & ADDRMASK; T1 > 0
 | 
					
						
							|  |  |  | 	 * len >= NBYTES | 
					
						
							|  |  |  | 	 * | 
					
						
							|  |  |  | 	 * Copy enough bytes to align dst | 
					
						
							|  |  |  | 	 * Set match = (src and dst have same alignment) | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | #define match rem | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LDFIRST(t3, FIRST(0)(src), .Ll_exc\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	ADD	t2, zero, NBYTES | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LDREST(t3, REST(0)(src), .Ll_exc_copy\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	SUB	t2, t2, t1	# t2 = number of bytes copied | 
					
						
							|  |  |  | 	xor	match, t0, t1 | 
					
						
							| 
									
										
										
										
											2007-11-25 11:47:56 +01:00
										 |  |  | 	R10KCBARRIER(0(ra)) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	STFIRST(t3, FIRST(0)(dst), .Ls_exc\@)
 | 
					
						
							|  |  |  | 	beq	len, t2, .Ldone\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 SUB	len, len, t2 | 
					
						
							|  |  |  | 	ADD	dst, dst, t2 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	beqz	match, .Lboth_aligned\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 ADD	src, src, t2 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Lsrc_unaligned_dst_aligned\@:
 | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | 	SRL	t0, len, LOG_NBYTES+2	 # +2 for 4 units/iter | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | 	PREFS(	0, 3*32(src) ) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	beqz	t0, .Lcleanup_src_unaligned\@
 | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | 	 and	rem, len, (4*NBYTES-1)	 # rem = len % 4*NBYTES | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | 	PREFD(	1, 3*32(dst) ) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 1: | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * Avoid consecutive LD*'s to the same register since some mips | 
					
						
							|  |  |  |  * implementations can't issue them in the same cycle. | 
					
						
							|  |  |  |  * It's OK to load FIRST(N+1) before REST(N) because the two addresses | 
					
						
							|  |  |  |  * are to the same unit (unless src is aligned, but it's not). | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2007-11-25 11:47:56 +01:00
										 |  |  | 	R10KCBARRIER(0(ra)) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LDFIRST(t0, FIRST(0)(src), .Ll_exc\@)
 | 
					
						
							|  |  |  | 	LDFIRST(t1, FIRST(1)(src), .Ll_exc_copy\@)
 | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | 	SUB	len, len, 4*NBYTES | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LDREST(t0, REST(0)(src), .Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LDREST(t1, REST(1)(src), .Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LDFIRST(t2, FIRST(2)(src), .Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LDFIRST(t3, FIRST(3)(src), .Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LDREST(t2, REST(2)(src), .Ll_exc_copy\@)
 | 
					
						
							|  |  |  | 	LDREST(t3, REST(3)(src), .Ll_exc_copy\@)
 | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | 	PREFS(	0, 9*32(src) )		# 0 is PREF_LOAD  (not streamed) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	ADD	src, src, 4*NBYTES | 
					
						
							|  |  |  | #ifdef CONFIG_CPU_SB1 | 
					
						
							|  |  |  | 	nop				# improves slotting | 
					
						
							|  |  |  | #endif | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	STORE(t0, UNIT(0)(dst),	.Ls_exc_p4u\@)
 | 
					
						
							|  |  |  | 	STORE(t1, UNIT(1)(dst),	.Ls_exc_p3u\@)
 | 
					
						
							|  |  |  | 	STORE(t2, UNIT(2)(dst),	.Ls_exc_p2u\@)
 | 
					
						
							|  |  |  | 	STORE(t3, UNIT(3)(dst),	.Ls_exc_p1u\@)
 | 
					
						
							| 
									
										
										
										
											2014-01-07 15:59:03 +00:00
										 |  |  | 	PREFD(	1, 9*32(dst) )		# 1 is PREF_STORE (not streamed) | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	reorder				/* DADDI_WAR */ | 
					
						
							|  |  |  | 	ADD	dst, dst, 4*NBYTES | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	bne	len, rem, 1b | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Lcleanup_src_unaligned\@:
 | 
					
						
							|  |  |  | 	beqz	len, .Ldone\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 and	rem, len, NBYTES-1  # rem = len % NBYTES | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	beq	rem, len, .Lcopy_bytes\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 nop | 
					
						
							|  |  |  | 1: | 
					
						
							| 
									
										
										
										
											2007-11-25 11:47:56 +01:00
										 |  |  | 	R10KCBARRIER(0(ra)) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LDFIRST(t0, FIRST(0)(src), .Ll_exc\@)
 | 
					
						
							|  |  |  | 	LDREST(t0, REST(0)(src), .Ll_exc_copy\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	ADD	src, src, NBYTES | 
					
						
							|  |  |  | 	SUB	len, len, NBYTES | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	STORE(t0, 0(dst), .Ls_exc_p1u\@)
 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	reorder				/* DADDI_WAR */ | 
					
						
							|  |  |  | 	ADD	dst, dst, NBYTES | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	bne	len, rem, 1b | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Lcopy_bytes_checklen\@:
 | 
					
						
							|  |  |  | 	beqz	len, .Ldone\@
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 nop | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Lcopy_bytes\@:
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	/* 0 < len < NBYTES  */ | 
					
						
							| 
									
										
										
										
											2007-11-25 11:47:56 +01:00
										 |  |  | 	R10KCBARRIER(0(ra)) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | #define COPY_BYTE(N)			\ | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LOADB(t0, N(src), .Ll_exc\@);	\
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	SUB	len, len, 1;		\
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	beqz	len, .Ldone\@;		\
 | 
					
						
							|  |  |  | 	STOREB(t0, N(dst), .Ls_exc_p1\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	COPY_BYTE(0) | 
					
						
							|  |  |  | 	COPY_BYTE(1) | 
					
						
							|  |  |  | #ifdef USE_DOUBLE | 
					
						
							|  |  |  | 	COPY_BYTE(2) | 
					
						
							|  |  |  | 	COPY_BYTE(3) | 
					
						
							|  |  |  | 	COPY_BYTE(4) | 
					
						
							|  |  |  | 	COPY_BYTE(5) | 
					
						
							|  |  |  | #endif | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LOADB(t0, NBYTES-2(src), .Ll_exc\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	SUB	len, len, 1 | 
					
						
							|  |  |  | 	jr	ra | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	STOREB(t0, NBYTES-2(dst), .Ls_exc_p1\@)
 | 
					
						
							|  |  |  | .Ldone\@:
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	jr	ra | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	.if __memcpy == 1 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	END(memcpy) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	.set __memcpy, 0 | 
					
						
							|  |  |  | 	.hidden __memcpy
 | 
					
						
							|  |  |  | 	.endif | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Ll_exc_copy\@:
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	/* | 
					
						
							|  |  |  | 	 * Copy bytes from src until faulting load address (or until a | 
					
						
							|  |  |  | 	 * lb faults) | 
					
						
							|  |  |  | 	 * | 
					
						
							|  |  |  | 	 * When reached by a faulting LDFIRST/LDREST, THREAD_BUADDR($28) | 
					
						
							|  |  |  | 	 * may be more than a byte beyond the last address. | 
					
						
							|  |  |  | 	 * Hence, the lb below may get an exception. | 
					
						
							|  |  |  | 	 * | 
					
						
							|  |  |  | 	 * Assumes src < THREAD_BUADDR($28) | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2014-01-07 12:57:04 +00:00
										 |  |  | 	LOADK	t0, TI_TASK($28) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 nop | 
					
						
							| 
									
										
										
										
											2014-01-07 12:57:04 +00:00
										 |  |  | 	LOADK	t0, THREAD_BUADDR(t0) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 1: | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	LOADB(t1, 0(src), .Ll_exc\@)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	ADD	src, src, 1 | 
					
						
							|  |  |  | 	sb	t1, 0(dst)	# can't fault -- we're copy_from_user | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	reorder				/* DADDI_WAR */ | 
					
						
							|  |  |  | 	ADD	dst, dst, 1 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	bne	src, t0, 1b | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Ll_exc\@:
 | 
					
						
							| 
									
										
										
										
											2014-01-07 12:57:04 +00:00
										 |  |  | 	LOADK	t0, TI_TASK($28) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 nop | 
					
						
							| 
									
										
										
										
											2014-01-07 12:57:04 +00:00
										 |  |  | 	LOADK	t0, THREAD_BUADDR(t0)	# t0 is just past last good address | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 nop | 
					
						
							|  |  |  | 	SUB	len, AT, t0		# len number of uncopied bytes | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	bnez	t6, .Ldone\@	/* Skip the zeroing part if inatomic */
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	/* | 
					
						
							|  |  |  | 	 * Here's where we rely on src and dst being incremented in tandem, | 
					
						
							|  |  |  | 	 *   See (3) above. | 
					
						
							|  |  |  | 	 * dst += (fault addr - src) to put dst at first byte to clear | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	ADD	dst, t0			# compute start address in a1 | 
					
						
							|  |  |  | 	SUB	dst, src | 
					
						
							|  |  |  | 	/* | 
					
						
							|  |  |  | 	 * Clear len bytes starting at dst.  Can't call __bzero because it | 
					
						
							|  |  |  | 	 * might modify len.  An inefficient loop for these rare times... | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	reorder				/* DADDI_WAR */ | 
					
						
							|  |  |  | 	SUB	src, len, 1 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	beqz	len, .Ldone\@
 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 1:	sb	zero, 0(dst) | 
					
						
							|  |  |  | 	ADD	dst, dst, 1 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | #ifndef CONFIG_CPU_DADDI_WORKAROUNDS | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	bnez	src, 1b | 
					
						
							|  |  |  | 	 SUB	src, src, 1 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | #else | 
					
						
							|  |  |  | 	.set	push
 | 
					
						
							|  |  |  | 	.set	noat
 | 
					
						
							|  |  |  | 	li	v1, 1 | 
					
						
							|  |  |  | 	bnez	src, 1b | 
					
						
							|  |  |  | 	 SUB	src, src, v1 | 
					
						
							|  |  |  | 	.set	pop
 | 
					
						
							|  |  |  | #endif | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	jr	ra | 
					
						
							|  |  |  | 	 nop | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | #define SEXC(n)							\ | 
					
						
							| 
									
										
										
										
											2013-01-22 12:59:30 +01:00
										 |  |  | 	.set	reorder;			/* DADDI_WAR */ \
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Ls_exc_p ## n ## u\@:						\ | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	ADD	len, len, n*NBYTES;				\
 | 
					
						
							|  |  |  | 	jr	ra;						\
 | 
					
						
							|  |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | SEXC(8) | 
					
						
							|  |  |  | SEXC(7) | 
					
						
							|  |  |  | SEXC(6) | 
					
						
							|  |  |  | SEXC(5) | 
					
						
							|  |  |  | SEXC(4) | 
					
						
							|  |  |  | SEXC(3) | 
					
						
							|  |  |  | SEXC(2) | 
					
						
							|  |  |  | SEXC(1) | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Ls_exc_p1\@:
 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	reorder				/* DADDI_WAR */ | 
					
						
							|  |  |  | 	ADD	len, len, 1 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	jr	ra | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | .Ls_exc\@:
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	jr	ra | 
					
						
							|  |  |  | 	 nop | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 	.endm | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	.align	5
 | 
					
						
							|  |  |  | LEAF(memmove) | 
					
						
							|  |  |  | 	ADD	t0, a0, a2 | 
					
						
							|  |  |  | 	ADD	t1, a1, a2 | 
					
						
							|  |  |  | 	sltu	t0, a1, t0			# dst + len <= src -> memcpy | 
					
						
							|  |  |  | 	sltu	t1, a0, t1			# dst >= src + len -> memcpy | 
					
						
							|  |  |  | 	and	t0, t1 | 
					
						
							| 
									
										
										
										
											2008-01-29 10:14:59 +00:00
										 |  |  | 	beqz	t0, .L__memcpy | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 move	v0, a0				/* return value */ | 
					
						
							| 
									
										
										
										
											2008-01-29 10:14:59 +00:00
										 |  |  | 	beqz	a2, .Lr_out | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	END(memmove) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* fall through to __rmemcpy */ | 
					
						
							|  |  |  | LEAF(__rmemcpy)					/* a0=dst a1=src a2=len */ | 
					
						
							|  |  |  | 	 sltu	t0, a1, a0 | 
					
						
							| 
									
										
										
										
											2008-01-29 10:14:59 +00:00
										 |  |  | 	beqz	t0, .Lr_end_bytes_up		# src >= dst | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 nop | 
					
						
							|  |  |  | 	ADD	a0, a2				# dst = dst + len | 
					
						
							|  |  |  | 	ADD	a1, a2				# src = src + len | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-01-29 10:14:59 +00:00
										 |  |  | .Lr_end_bytes: | 
					
						
							| 
									
										
										
										
											2007-11-25 11:47:56 +01:00
										 |  |  | 	R10KCBARRIER(0(ra)) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	lb	t0, -1(a1) | 
					
						
							|  |  |  | 	SUB	a2, a2, 0x1 | 
					
						
							|  |  |  | 	sb	t0, -1(a0) | 
					
						
							|  |  |  | 	SUB	a1, a1, 0x1 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	reorder				/* DADDI_WAR */ | 
					
						
							|  |  |  | 	SUB	a0, a0, 0x1 | 
					
						
							| 
									
										
										
										
											2008-01-29 10:14:59 +00:00
										 |  |  | 	bnez	a2, .Lr_end_bytes | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-01-29 10:14:59 +00:00
										 |  |  | .Lr_out: | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	jr	ra | 
					
						
							|  |  |  | 	 move	a2, zero | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-01-29 10:14:59 +00:00
										 |  |  | .Lr_end_bytes_up: | 
					
						
							| 
									
										
										
										
											2007-11-25 11:47:56 +01:00
										 |  |  | 	R10KCBARRIER(0(ra)) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	lb	t0, (a1) | 
					
						
							|  |  |  | 	SUB	a2, a2, 0x1 | 
					
						
							|  |  |  | 	sb	t0, (a0) | 
					
						
							|  |  |  | 	ADD	a1, a1, 0x1 | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	reorder				/* DADDI_WAR */ | 
					
						
							|  |  |  | 	ADD	a0, a0, 0x1 | 
					
						
							| 
									
										
										
										
											2008-01-29 10:14:59 +00:00
										 |  |  | 	bnez	a2, .Lr_end_bytes_up | 
					
						
							| 
									
										
										
										
											2007-10-23 12:43:25 +01:00
										 |  |  | 	.set	noreorder
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	jr	ra | 
					
						
							|  |  |  | 	 move	a2, zero | 
					
						
							|  |  |  | 	END(__rmemcpy) | 
					
						
							| 
									
										
										
										
											2014-01-07 14:34:05 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * t6 is used as a flag to note inatomic mode. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | LEAF(__copy_user_inatomic) | 
					
						
							|  |  |  | 	b	__copy_user_common | 
					
						
							|  |  |  | 	li	t6, 1 | 
					
						
							|  |  |  | 	END(__copy_user_inatomic) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * A combined memcpy/__copy_user | 
					
						
							|  |  |  |  * __copy_user sets len to 0 for success; else to an upper bound of
 | 
					
						
							|  |  |  |  * the number of uncopied bytes. | 
					
						
							|  |  |  |  * memcpy sets v0 to dst. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 	.align	5
 | 
					
						
							|  |  |  | LEAF(memcpy)					/* a0=dst a1=src a2=len */ | 
					
						
							|  |  |  | 	move	v0, dst				/* return value */ | 
					
						
							|  |  |  | .L__memcpy: | 
					
						
							|  |  |  | FEXPORT(__copy_user) | 
					
						
							|  |  |  | 	li	t6, 0	/* not inatomic */ | 
					
						
							|  |  |  | __copy_user_common: | 
					
						
							|  |  |  | 	/* Legacy Mode, user <-> user */ | 
					
						
							|  |  |  | 	__BUILD_COPY_USER LEGACY_MODE USEROP USEROP | 
					
						
							| 
									
										
										
										
											2014-01-07 16:20:22 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | #ifdef CONFIG_EVA | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * For EVA we need distinct symbols for reading and writing to user space. | 
					
						
							|  |  |  |  * This is because we need to use specific EVA instructions to perform the | 
					
						
							|  |  |  |  * virtual <-> physical translation when a virtual address is actually in user | 
					
						
							|  |  |  |  * space | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | LEAF(__copy_user_inatomic_eva) | 
					
						
							|  |  |  | 	b       __copy_from_user_common | 
					
						
							|  |  |  | 	li	t6, 1 | 
					
						
							|  |  |  | 	END(__copy_user_inatomic_eva) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * __copy_from_user (EVA) | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | LEAF(__copy_from_user_eva) | 
					
						
							|  |  |  | 	li	t6, 0	/* not inatomic */ | 
					
						
							|  |  |  | __copy_from_user_common: | 
					
						
							|  |  |  | 	__BUILD_COPY_USER EVA_MODE USEROP KERNELOP | 
					
						
							|  |  |  | END(__copy_from_user_eva) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * __copy_to_user (EVA) | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | LEAF(__copy_to_user_eva) | 
					
						
							|  |  |  | __BUILD_COPY_USER EVA_MODE KERNELOP USEROP | 
					
						
							|  |  |  | END(__copy_to_user_eva) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * __copy_in_user (EVA) | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | LEAF(__copy_in_user_eva) | 
					
						
							|  |  |  | __BUILD_COPY_USER EVA_MODE USEROP USEROP | 
					
						
							|  |  |  | END(__copy_in_user_eva) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #endif |