| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /* | 
					
						
							|  |  |  |  *  linux/arch/arm/lib/io-readsw-armv4.S | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  Copyright (C) 1995-2000 Russell King | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This program is free software; you can redistribute it and/or modify
 | 
					
						
							|  |  |  |  * it under the terms of the GNU General Public License version 2 as | 
					
						
							|  |  |  |  * published by the Free Software Foundation. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | #include <linux/linkage.h> | 
					
						
							|  |  |  | #include <asm/assembler.h> | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		.macro	pack, rd, hw1, hw2 | 
					
						
							|  |  |  | #ifndef __ARMEB__ | 
					
						
							|  |  |  | 		orr	\rd, \hw1, \hw2, lsl #16 | 
					
						
							|  |  |  | #else | 
					
						
							|  |  |  | 		orr	\rd, \hw2, \hw1, lsl #16 | 
					
						
							|  |  |  | #endif | 
					
						
							|  |  |  | 		.endm | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Linsw_align:	movs	ip, r1, lsl #31 | 
					
						
							|  |  |  | 		bne	.Linsw_noalign | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		ldrh	ip, [r0] | 
					
						
							|  |  |  | 		sub	r2, r2, #1 | 
					
						
							|  |  |  | 		strh	ip, [r1], #2 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | ENTRY(__raw_readsw) | 
					
						
							|  |  |  | 		teq	r2, #0 | 
					
						
							|  |  |  | 		moveq	pc, lr | 
					
						
							|  |  |  | 		tst	r1, #3 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | 		bne	.Linsw_align | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		stmfd	sp!, {r4, r5, lr} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		subs	r2, r2, #8 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | 		bmi	.Lno_insw_8 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Linsw_8_lp:	ldrh	r3, [r0] | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		ldrh	r4, [r0] | 
					
						
							|  |  |  | 		pack	r3, r3, r4 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		ldrh	r4, [r0] | 
					
						
							|  |  |  | 		ldrh	r5, [r0] | 
					
						
							|  |  |  | 		pack	r4, r4, r5 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		ldrh	r5, [r0] | 
					
						
							|  |  |  | 		ldrh	ip, [r0] | 
					
						
							|  |  |  | 		pack	r5, r5, ip | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		ldrh	ip, [r0] | 
					
						
							|  |  |  | 		ldrh	lr, [r0] | 
					
						
							|  |  |  | 		pack	ip, ip, lr | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		subs	r2, r2, #8 | 
					
						
							|  |  |  | 		stmia	r1!, {r3 - r5, ip} | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | 		bpl	.Linsw_8_lp | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Lno_insw_8:	tst	r2, #4 | 
					
						
							|  |  |  | 		beq	.Lno_insw_4 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		ldrh	r3, [r0] | 
					
						
							|  |  |  | 		ldrh	r4, [r0] | 
					
						
							|  |  |  | 		pack	r3, r3, r4 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		ldrh	r4, [r0] | 
					
						
							|  |  |  | 		ldrh	ip, [r0] | 
					
						
							|  |  |  | 		pack	r4, r4, ip | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		stmia	r1!, {r3, r4} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Lno_insw_4:	movs	r2, r2, lsl #31 | 
					
						
							|  |  |  | 		bcc	.Lno_insw_2 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		ldrh	r3, [r0] | 
					
						
							|  |  |  | 		ldrh	ip, [r0] | 
					
						
							|  |  |  | 		pack	r3, r3, ip | 
					
						
							|  |  |  | 		str	r3, [r1], #4 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Lno_insw_2:	ldrneh	r3, [r0] | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		strneh	r3, [r1] | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		ldmfd	sp!, {r4, r5, pc} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #ifdef __ARMEB__ | 
					
						
							|  |  |  | #define _BE_ONLY_(code...)	code | 
					
						
							|  |  |  | #define _LE_ONLY_(code...) | 
					
						
							|  |  |  | #define push_hbyte0		lsr #8 | 
					
						
							|  |  |  | #define pull_hbyte1		lsl #24 | 
					
						
							|  |  |  | #else | 
					
						
							|  |  |  | #define _BE_ONLY_(code...) | 
					
						
							|  |  |  | #define _LE_ONLY_(code...) code | 
					
						
							|  |  |  | #define push_hbyte0		lsl #24 | 
					
						
							|  |  |  | #define pull_hbyte1		lsr #8 | 
					
						
							|  |  |  | #endif | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Linsw_noalign:	stmfd	sp!, {r4, lr} | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		ldrccb	ip, [r1, #-1]! | 
					
						
							|  |  |  | 		bcc	1f | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		ldrh	ip, [r0] | 
					
						
							|  |  |  | 		sub	r2, r2, #1 | 
					
						
							|  |  |  |    _BE_ONLY_(	mov	ip, ip, ror #8		) | 
					
						
							|  |  |  | 		strb	ip, [r1], #1 | 
					
						
							|  |  |  |    _LE_ONLY_(	mov	ip, ip, lsr #8		) | 
					
						
							|  |  |  |    _BE_ONLY_(	mov	ip, ip, lsr #24		) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 1:		subs	r2, r2, #2 | 
					
						
							|  |  |  | 		bmi	3f | 
					
						
							|  |  |  |    _BE_ONLY_(	mov	ip, ip, lsl #24		) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 2:		ldrh	r3, [r0] | 
					
						
							|  |  |  | 		ldrh	r4, [r0] | 
					
						
							|  |  |  | 		subs	r2, r2, #2 | 
					
						
							|  |  |  | 		orr	ip, ip, r3, lsl #8 | 
					
						
							|  |  |  | 		orr	ip, ip, r4, push_hbyte0 | 
					
						
							|  |  |  | 		str	ip, [r1], #4 | 
					
						
							|  |  |  | 		mov	ip, r4, pull_hbyte1 | 
					
						
							|  |  |  | 		bpl	2b | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |    _BE_ONLY_(	mov	ip, ip, lsr #24		) | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 3:		tst	r2, #1 | 
					
						
							|  |  |  | 		strb	ip, [r1], #1 | 
					
						
							|  |  |  | 		ldrneh	ip, [r0] | 
					
						
							|  |  |  |    _BE_ONLY_(	movne	ip, ip, ror #8		) | 
					
						
							|  |  |  | 		strneb	ip, [r1], #1 | 
					
						
							|  |  |  |    _LE_ONLY_(	movne	ip, ip, lsr #8		) | 
					
						
							|  |  |  |    _BE_ONLY_(	movne	ip, ip, lsr #24		) | 
					
						
							|  |  |  | 		strneb	ip, [r1] | 
					
						
							|  |  |  | 		ldmfd	sp!, {r4, pc} | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENDPROC(__raw_readsw) |