| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /* | 
					
						
							|  |  |  |  *  linux/arch/arm/lib/io-readsb.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> | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Linsb_align:	rsb	ip, ip, #4 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		cmp	ip, r2 | 
					
						
							|  |  |  | 		movgt	ip, r2 | 
					
						
							|  |  |  | 		cmp	ip, #2 | 
					
						
							|  |  |  | 		ldrb	r3, [r0] | 
					
						
							|  |  |  | 		strb	r3, [r1], #1 | 
					
						
							|  |  |  | 		ldrgeb	r3, [r0] | 
					
						
							|  |  |  | 		strgeb	r3, [r1], #1 | 
					
						
							|  |  |  | 		ldrgtb	r3, [r0] | 
					
						
							|  |  |  | 		strgtb	r3, [r1], #1 | 
					
						
							|  |  |  | 		subs	r2, r2, ip | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | 		bne	.Linsb_aligned | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | ENTRY(__raw_readsb) | 
					
						
							|  |  |  | 		teq	r2, #0		@ do we have to check for the zero len?
 | 
					
						
							|  |  |  | 		moveq	pc, lr | 
					
						
							|  |  |  | 		ands	ip, r1, #3 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | 		bne	.Linsb_align | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Linsb_aligned:	stmfd	sp!, {r4 - r6, lr} | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		subs	r2, r2, #16 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | 		bmi	.Linsb_no_16 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Linsb_16_lp:	ldrb	r3, [r0] | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		ldrb	r4, [r0] | 
					
						
							|  |  |  | 		ldrb	r5, [r0] | 
					
						
							|  |  |  | 		mov	r3, r3,     put_byte_0 | 
					
						
							|  |  |  | 		ldrb	r6, [r0] | 
					
						
							|  |  |  | 		orr	r3, r3, r4, put_byte_1 | 
					
						
							|  |  |  | 		ldrb	r4, [r0] | 
					
						
							|  |  |  | 		orr	r3, r3, r5, put_byte_2 | 
					
						
							|  |  |  | 		ldrb	r5, [r0] | 
					
						
							|  |  |  | 		orr	r3, r3, r6, put_byte_3 | 
					
						
							|  |  |  | 		ldrb	r6, [r0] | 
					
						
							|  |  |  | 		mov	r4, r4,     put_byte_0 | 
					
						
							|  |  |  | 		ldrb	ip, [r0] | 
					
						
							|  |  |  | 		orr	r4, r4, r5, put_byte_1 | 
					
						
							|  |  |  | 		ldrb	r5, [r0] | 
					
						
							|  |  |  | 		orr	r4, r4, r6, put_byte_2 | 
					
						
							|  |  |  | 		ldrb	r6, [r0] | 
					
						
							|  |  |  | 		orr	r4, r4, ip, put_byte_3 | 
					
						
							|  |  |  | 		ldrb	ip, [r0] | 
					
						
							|  |  |  | 		mov	r5, r5,     put_byte_0 | 
					
						
							|  |  |  | 		ldrb	lr, [r0] | 
					
						
							|  |  |  | 		orr	r5, r5, r6, put_byte_1 | 
					
						
							|  |  |  | 		ldrb	r6, [r0] | 
					
						
							|  |  |  | 		orr	r5, r5, ip, put_byte_2 | 
					
						
							|  |  |  | 		ldrb	ip, [r0] | 
					
						
							|  |  |  | 		orr	r5, r5, lr, put_byte_3 | 
					
						
							|  |  |  | 		ldrb	lr, [r0] | 
					
						
							|  |  |  | 		mov	r6, r6,     put_byte_0 | 
					
						
							|  |  |  | 		orr	r6, r6, ip, put_byte_1 | 
					
						
							|  |  |  | 		ldrb	ip, [r0] | 
					
						
							|  |  |  | 		orr	r6, r6, lr, put_byte_2 | 
					
						
							|  |  |  | 		orr	r6, r6, ip, put_byte_3 | 
					
						
							|  |  |  | 		stmia	r1!, {r3 - r6} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		subs	r2, r2, #16 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | 		bpl	.Linsb_16_lp | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		tst	r2, #15 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:23:45 +01:00
										 |  |  | 		ldmeqfd	sp!, {r4 - r6, pc} | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Linsb_no_16:	tst	r2, #8 | 
					
						
							|  |  |  | 		beq	.Linsb_no_8 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		ldrb	r3, [r0] | 
					
						
							|  |  |  | 		ldrb	r4, [r0] | 
					
						
							|  |  |  | 		ldrb	r5, [r0] | 
					
						
							|  |  |  | 		mov	r3, r3,     put_byte_0 | 
					
						
							|  |  |  | 		ldrb	r6, [r0] | 
					
						
							|  |  |  | 		orr	r3, r3, r4, put_byte_1 | 
					
						
							|  |  |  | 		ldrb	r4, [r0] | 
					
						
							|  |  |  | 		orr	r3, r3, r5, put_byte_2 | 
					
						
							|  |  |  | 		ldrb	r5, [r0] | 
					
						
							|  |  |  | 		orr	r3, r3, r6, put_byte_3 | 
					
						
							|  |  |  | 		ldrb	r6, [r0] | 
					
						
							|  |  |  | 		mov	r4, r4,     put_byte_0 | 
					
						
							|  |  |  | 		ldrb	ip, [r0] | 
					
						
							|  |  |  | 		orr	r4, r4, r5, put_byte_1 | 
					
						
							|  |  |  | 		orr	r4, r4, r6, put_byte_2 | 
					
						
							|  |  |  | 		orr	r4, r4, ip, put_byte_3 | 
					
						
							|  |  |  | 		stmia	r1!, {r3, r4} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Linsb_no_8:	tst	r2, #4 | 
					
						
							|  |  |  | 		beq	.Linsb_no_4 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		ldrb	r3, [r0] | 
					
						
							|  |  |  | 		ldrb	r4, [r0] | 
					
						
							|  |  |  | 		ldrb	r5, [r0] | 
					
						
							|  |  |  | 		ldrb	r6, [r0] | 
					
						
							|  |  |  | 		mov	r3, r3,     put_byte_0 | 
					
						
							|  |  |  | 		orr	r3, r3, r4, put_byte_1 | 
					
						
							|  |  |  | 		orr	r3, r3, r5, put_byte_2 | 
					
						
							|  |  |  | 		orr	r3, r3, r6, put_byte_3 | 
					
						
							|  |  |  | 		str	r3, [r1], #4 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:48 +00:00
										 |  |  | .Linsb_no_4:	ands	r2, r2, #3 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:23:45 +01:00
										 |  |  | 		ldmeqfd	sp!, {r4 - r6, pc} | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		cmp	r2, #2 | 
					
						
							|  |  |  | 		ldrb	r3, [r0] | 
					
						
							|  |  |  | 		strb	r3, [r1], #1 | 
					
						
							|  |  |  | 		ldrgeb	r3, [r0] | 
					
						
							|  |  |  | 		strgeb	r3, [r1], #1 | 
					
						
							|  |  |  | 		ldrgtb	r3, [r0] | 
					
						
							|  |  |  | 		strgtb	r3, [r1] | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:23:45 +01:00
										 |  |  | 		ldmfd	sp!, {r4 - r6, pc} | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENDPROC(__raw_readsb) |