blob: 3ccade0f813038c89404a26f92b4a35a3638dd86 [file] [log] [blame]
Thomas Gleixnerd2912cb2019-06-04 10:11:33 +02001/* SPDX-License-Identifier: GPL-2.0-only */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002/*
3 * linux/arch/arm/lib/delay.S
4 *
5 * Copyright (C) 1995, 1996 Russell King
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 */
7#include <linux/linkage.h>
8#include <asm/assembler.h>
Will Deacond0a533b2012-07-06 15:47:17 +01009#include <asm/delay.h>
Nicolas Pitre215e3622015-02-25 22:50:39 +010010
Linus Torvalds1da177e2005-04-16 15:20:36 -070011 .text
12
Nicolas Pitre8adbb372005-11-11 21:51:49 +000013.LC0: .word loops_per_jiffy
Will Deacond0a533b2012-07-06 15:47:17 +010014.LC1: .word UDELAY_MULT
Linus Torvalds1da177e2005-04-16 15:20:36 -070015
16/*
Nicolas Pitre207b1152016-10-07 05:38:35 +010017 * loops = r0 * HZ * loops_per_jiffy / 1000000
18 *
Peter Teichmann6d4518d2006-03-20 17:10:09 +000019 * r0 <= 2000
Peter Teichmann6d4518d2006-03-20 17:10:09 +000020 * HZ <= 1000
Linus Torvalds1da177e2005-04-16 15:20:36 -070021 */
Peter Teichmann6d4518d2006-03-20 17:10:09 +000022
Will Deacond0a533b2012-07-06 15:47:17 +010023ENTRY(__loop_udelay)
Peter Teichmann6d4518d2006-03-20 17:10:09 +000024 ldr r2, .LC1
Nicolas Pitre207b1152016-10-07 05:38:35 +010025 mul r0, r2, r0 @ r0 = delay_us * UDELAY_MULT
26ENTRY(__loop_const_udelay) @ 0 <= r0 <= 0xfffffaf0
Nicolas Pitre8adbb372005-11-11 21:51:49 +000027 ldr r2, .LC0
Nicolas Pitre215e3622015-02-25 22:50:39 +010028 ldr r2, [r2]
Nicolas Pitre207b1152016-10-07 05:38:35 +010029 umull r1, r0, r2, r0 @ r0-r1 = r0 * loops_per_jiffy
30 adds r1, r1, #0xffffffff @ rounding up ...
31 adcs r0, r0, r0 @ and right shift by 31
Russell King6ebbf2c2014-06-30 16:29:12 +010032 reteq lr
Linus Torvalds1da177e2005-04-16 15:20:36 -070033
Fabio Estevam11d4bb12013-11-30 15:24:42 +010034 .align 3
Linus Torvalds1da177e2005-04-16 15:20:36 -070035
36@ Delay routine
Will Deacond0a533b2012-07-06 15:47:17 +010037ENTRY(__loop_delay)
Linus Torvalds1da177e2005-04-16 15:20:36 -070038 subs r0, r0, #1
39#if 0
Russell King6ebbf2c2014-06-30 16:29:12 +010040 retls lr
Linus Torvalds1da177e2005-04-16 15:20:36 -070041 subs r0, r0, #1
Russell King6ebbf2c2014-06-30 16:29:12 +010042 retls lr
Linus Torvalds1da177e2005-04-16 15:20:36 -070043 subs r0, r0, #1
Russell King6ebbf2c2014-06-30 16:29:12 +010044 retls lr
Linus Torvalds1da177e2005-04-16 15:20:36 -070045 subs r0, r0, #1
Russell King6ebbf2c2014-06-30 16:29:12 +010046 retls lr
Linus Torvalds1da177e2005-04-16 15:20:36 -070047 subs r0, r0, #1
Russell King6ebbf2c2014-06-30 16:29:12 +010048 retls lr
Linus Torvalds1da177e2005-04-16 15:20:36 -070049 subs r0, r0, #1
Russell King6ebbf2c2014-06-30 16:29:12 +010050 retls lr
Linus Torvalds1da177e2005-04-16 15:20:36 -070051 subs r0, r0, #1
Russell King6ebbf2c2014-06-30 16:29:12 +010052 retls lr
Linus Torvalds1da177e2005-04-16 15:20:36 -070053 subs r0, r0, #1
54#endif
Will Deacond0a533b2012-07-06 15:47:17 +010055 bhi __loop_delay
Russell King6ebbf2c2014-06-30 16:29:12 +010056 ret lr
Will Deacond0a533b2012-07-06 15:47:17 +010057ENDPROC(__loop_udelay)
58ENDPROC(__loop_const_udelay)
59ENDPROC(__loop_delay)