| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  | /* | 
					
						
							|  |  |  |  * Copyright 2005-2010 Analog Devices Inc. | 
					
						
							|  |  |  |  * | 
					
						
							| 
									
										
										
										
											2012-05-17 14:45:27 +08:00
										 |  |  |  * Licensed under the Clear BSD license or the GPL-2 (or later) | 
					
						
							| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include <linux/linkage.h> | 
					
						
							| 
									
										
										
										
											2010-05-04 14:59:21 +00:00
										 |  |  | #include <asm/context.S> | 
					
						
							| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | /* void *strncpy(char *dest, const char *src, size_t n);
 | 
					
						
							|  |  |  |  * R0 = address (dest) | 
					
						
							|  |  |  |  * R1 = address (src) | 
					
						
							|  |  |  |  * R2 = size | 
					
						
							| 
									
										
										
										
											2010-05-04 14:59:21 +00:00
										 |  |  |  * Returns a pointer (R0) to the destination string dest | 
					
						
							|  |  |  |  *  we do this by not changing R0 | 
					
						
							| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #ifdef CONFIG_STRNCPY_L1 | 
					
						
							|  |  |  | .section .l1.text | 
					
						
							|  |  |  | #else | 
					
						
							|  |  |  | .text | 
					
						
							|  |  |  | #endif | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | .align 2
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | ENTRY(_strncpy) | 
					
						
							|  |  |  | 	CC = R2 == 0;
 | 
					
						
							| 
									
										
										
										
											2011-06-01 15:52:41 +08:00
										 |  |  | 	if CC JUMP 6f;
 | 
					
						
							| 
									
										
										
										
											2010-05-04 14:59:21 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	P2 = R2 ;       /* size */
 | 
					
						
							| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  | 	P0 = R0 ;       /* dst*/
 | 
					
						
							|  |  |  | 	P1 = R1 ;       /* src*/
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-05-04 14:59:21 +00:00
										 |  |  | 	LSETUP (1f, 2f) LC0 = P2;
 | 
					
						
							| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  | 1: | 
					
						
							|  |  |  | 	R1 = B [P1++] (Z);
 | 
					
						
							|  |  |  | 	B [P0++] = R1;
 | 
					
						
							| 
									
										
										
										
											2010-05-04 14:59:21 +00:00
										 |  |  | 	CC = R1 == 0;
 | 
					
						
							| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  | 2: | 
					
						
							| 
									
										
										
										
											2010-05-04 14:59:21 +00:00
										 |  |  | 	if CC jump 3f;
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	RTS;
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* if src is shorter than n, we need to null pad bytes in dest | 
					
						
							|  |  |  | 	 * but, we can get here when the last byte is zero, and we don't | 
					
						
							|  |  |  | 	 * want to copy an extra byte at the end, so we need to check | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  | 3: | 
					
						
							| 
									
										
										
										
											2010-05-04 14:59:21 +00:00
										 |  |  | 	R2 = LC0;
 | 
					
						
							|  |  |  | 	CC = R2 | 
					
						
							|  |  |  | 	if ! CC jump 6f;
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* if the required null padded portion is small, do it here, rather than | 
					
						
							|  |  |  | 	 * handling the overhead of memset (which is OK when things are big). | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	R3 = 0x20;
 | 
					
						
							|  |  |  | 	CC = R2 < R3;
 | 
					
						
							|  |  |  | 	IF CC jump 4f;
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  | 	R2 += -1;
 | 
					
						
							| 
									
										
										
										
											2010-05-04 14:59:21 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/* Set things up for memset | 
					
						
							|  |  |  | 	 * R0 = address | 
					
						
							|  |  |  | 	 * R1 = filler byte (this case it's zero, set above) | 
					
						
							|  |  |  | 	 * R2 = count (set above) | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	I1 = R0;
 | 
					
						
							|  |  |  | 	R0 = RETS;
 | 
					
						
							|  |  |  | 	I0 = R0;
 | 
					
						
							|  |  |  | 	R0 = P0;
 | 
					
						
							|  |  |  | 	pseudo_long_call _memset, p0;
 | 
					
						
							|  |  |  | 	R0 = I0;
 | 
					
						
							|  |  |  | 	RETS = R0;
 | 
					
						
							|  |  |  | 	R0 = I1;
 | 
					
						
							|  |  |  | 	RTS;
 | 
					
						
							| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | 4: | 
					
						
							| 
									
										
										
										
											2010-05-04 14:59:21 +00:00
										 |  |  | 	LSETUP(5f, 5f) LC0;
 | 
					
						
							|  |  |  | 5: | 
					
						
							|  |  |  | 	B [P0++] = R1;
 | 
					
						
							|  |  |  | 6: | 
					
						
							| 
									
										
										
										
											2010-05-03 17:23:20 +00:00
										 |  |  | 	RTS;
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | ENDPROC(_strncpy) |