| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /* | 
					
						
							|  |  |  |  *  linux/arch/arm/lib/delay.S | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  Copyright (C) 1995, 1996 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> | 
					
						
							| 
									
										
										
										
											2012-07-06 15:47:17 +01:00
										 |  |  | #include <asm/delay.h> | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		.text | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:49 +00:00
										 |  |  | .LC0:		.word	loops_per_jiffy
 | 
					
						
							| 
									
										
										
										
											2012-07-06 15:47:17 +01:00
										 |  |  | .LC1:		.word	UDELAY_MULT
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							| 
									
										
										
										
											2006-03-20 17:10:09 +00:00
										 |  |  |  * r0  <= 2000 | 
					
						
							|  |  |  |  * lpj <= 0x01ffffff (max. 3355 bogomips) | 
					
						
							|  |  |  |  * HZ  <= 1000 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  */ | 
					
						
							| 
									
										
										
										
											2006-03-20 17:10:09 +00:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-07-06 15:47:17 +01:00
										 |  |  | ENTRY(__loop_udelay) | 
					
						
							| 
									
										
										
										
											2006-03-20 17:10:09 +00:00
										 |  |  | 		ldr	r2, .LC1 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		mul	r0, r2, r0 | 
					
						
							| 
									
										
										
										
											2012-07-06 15:47:17 +01:00
										 |  |  | ENTRY(__loop_const_udelay)			@ 0 <= r0 <= 0x7fffff06
 | 
					
						
							| 
									
										
										
										
											2011-01-10 23:55:59 +00:00
										 |  |  | 		mov	r1, #-1 | 
					
						
							| 
									
										
										
										
											2005-11-11 21:51:49 +00:00
										 |  |  | 		ldr	r2, .LC0 | 
					
						
							| 
									
										
										
										
											2006-03-20 17:10:09 +00:00
										 |  |  | 		ldr	r2, [r2]		@ max = 0x01ffffff
 | 
					
						
							| 
									
										
										
										
											2011-01-10 23:55:59 +00:00
										 |  |  | 		add	r0, r0, r1, lsr #32-14 | 
					
						
							| 
									
										
										
										
											2006-03-20 17:10:09 +00:00
										 |  |  | 		mov	r0, r0, lsr #14		@ max = 0x0001ffff
 | 
					
						
							| 
									
										
										
										
											2011-01-10 23:55:59 +00:00
										 |  |  | 		add	r2, r2, r1, lsr #32-10 | 
					
						
							| 
									
										
										
										
											2006-03-20 17:10:09 +00:00
										 |  |  | 		mov	r2, r2, lsr #10		@ max = 0x00007fff
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		mul	r0, r2, r0		@ max = 2^32-1
 | 
					
						
							| 
									
										
										
										
											2011-01-10 23:55:59 +00:00
										 |  |  | 		add	r0, r0, r1, lsr #32-6 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		movs	r0, r0, lsr #6 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:17:23 +01:00
										 |  |  | 		moveq	pc, lr | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							| 
									
										
										
										
											2006-03-20 17:10:09 +00:00
										 |  |  |  * loops = r0 * HZ * loops_per_jiffy / 1000000 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | @ Delay routine
 | 
					
						
							| 
									
										
										
										
											2012-07-06 15:47:17 +01:00
										 |  |  | ENTRY(__loop_delay) | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		subs	r0, r0, #1 | 
					
						
							|  |  |  | #if 0 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:17:23 +01:00
										 |  |  | 		movls	pc, lr | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		subs	r0, r0, #1 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:17:23 +01:00
										 |  |  | 		movls	pc, lr | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		subs	r0, r0, #1 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:17:23 +01:00
										 |  |  | 		movls	pc, lr | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		subs	r0, r0, #1 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:17:23 +01:00
										 |  |  | 		movls	pc, lr | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		subs	r0, r0, #1 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:17:23 +01:00
										 |  |  | 		movls	pc, lr | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		subs	r0, r0, #1 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:17:23 +01:00
										 |  |  | 		movls	pc, lr | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		subs	r0, r0, #1 | 
					
						
							| 
									
										
										
										
											2006-06-25 11:17:23 +01:00
										 |  |  | 		movls	pc, lr | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		subs	r0, r0, #1 | 
					
						
							|  |  |  | #endif | 
					
						
							| 
									
										
										
										
											2012-07-06 15:47:17 +01:00
										 |  |  | 		bhi	__loop_delay | 
					
						
							| 
									
										
										
										
											2006-06-25 11:17:23 +01:00
										 |  |  | 		mov	pc, lr | 
					
						
							| 
									
										
										
										
											2012-07-06 15:47:17 +01:00
										 |  |  | ENDPROC(__loop_udelay) | 
					
						
							|  |  |  | ENDPROC(__loop_const_udelay) | 
					
						
							|  |  |  | ENDPROC(__loop_delay) |