2019-06-04 10:11:33 +02:00
|
|
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
2005-04-16 15:20:36 -07:00
|
|
|
/*
|
|
|
|
|
* linux/arch/arm/lib/delay.S
|
|
|
|
|
*
|
|
|
|
|
* Copyright (C) 1995, 1996 Russell King
|
|
|
|
|
*/
|
|
|
|
|
#include <linux/linkage.h>
|
2024-04-23 08:50:38 +01:00
|
|
|
#include <linux/cfi_types.h>
|
2005-04-16 15:20:36 -07:00
|
|
|
#include <asm/assembler.h>
|
2012-07-06 15:47:17 +01:00
|
|
|
#include <asm/delay.h>
|
2015-02-25 22:50:39 +01:00
|
|
|
|
2022-10-24 20:44:41 +01:00
|
|
|
#ifdef CONFIG_ARCH_RPC
|
|
|
|
|
.arch armv4
|
|
|
|
|
#endif
|
|
|
|
|
|
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
|
|
|
|
|
|
|
|
/*
|
2016-10-07 05:38:35 +01:00
|
|
|
* loops = r0 * HZ * loops_per_jiffy / 1000000
|
|
|
|
|
*
|
2006-03-20 17:10:09 +00:00
|
|
|
* r0 <= 2000
|
|
|
|
|
* HZ <= 1000
|
2005-04-16 15:20:36 -07:00
|
|
|
*/
|
2006-03-20 17:10:09 +00:00
|
|
|
|
2024-04-23 08:50:38 +01:00
|
|
|
SYM_TYPED_FUNC_START(__loop_udelay)
|
2006-03-20 17:10:09 +00:00
|
|
|
ldr r2, .LC1
|
2016-10-07 05:38:35 +01:00
|
|
|
mul r0, r2, r0 @ r0 = delay_us * UDELAY_MULT
|
2024-04-23 08:50:38 +01:00
|
|
|
b __loop_const_udelay
|
|
|
|
|
SYM_FUNC_END(__loop_udelay)
|
|
|
|
|
|
|
|
|
|
SYM_TYPED_FUNC_START(__loop_const_udelay) @ 0 <= r0 <= 0xfffffaf0
|
2005-11-11 21:51:49 +00:00
|
|
|
ldr r2, .LC0
|
2015-02-25 22:50:39 +01:00
|
|
|
ldr r2, [r2]
|
2016-10-07 05:38:35 +01:00
|
|
|
umull r1, r0, r2, r0 @ r0-r1 = r0 * loops_per_jiffy
|
|
|
|
|
adds r1, r1, #0xffffffff @ rounding up ...
|
|
|
|
|
adcs r0, r0, r0 @ and right shift by 31
|
2014-06-30 16:29:12 +01:00
|
|
|
reteq lr
|
2024-04-23 08:50:38 +01:00
|
|
|
b __loop_delay
|
|
|
|
|
SYM_FUNC_END(__loop_const_udelay)
|
2005-04-16 15:20:36 -07:00
|
|
|
|
2013-11-30 15:24:42 +01:00
|
|
|
.align 3
|
2005-04-16 15:20:36 -07:00
|
|
|
|
|
|
|
|
@ Delay routine
|
2024-04-23 08:50:38 +01:00
|
|
|
SYM_TYPED_FUNC_START(__loop_delay)
|
2005-04-16 15:20:36 -07:00
|
|
|
subs r0, r0, #1
|
|
|
|
|
#if 0
|
2014-06-30 16:29:12 +01:00
|
|
|
retls lr
|
2005-04-16 15:20:36 -07:00
|
|
|
subs r0, r0, #1
|
2014-06-30 16:29:12 +01:00
|
|
|
retls lr
|
2005-04-16 15:20:36 -07:00
|
|
|
subs r0, r0, #1
|
2014-06-30 16:29:12 +01:00
|
|
|
retls lr
|
2005-04-16 15:20:36 -07:00
|
|
|
subs r0, r0, #1
|
2014-06-30 16:29:12 +01:00
|
|
|
retls lr
|
2005-04-16 15:20:36 -07:00
|
|
|
subs r0, r0, #1
|
2014-06-30 16:29:12 +01:00
|
|
|
retls lr
|
2005-04-16 15:20:36 -07:00
|
|
|
subs r0, r0, #1
|
2014-06-30 16:29:12 +01:00
|
|
|
retls lr
|
2005-04-16 15:20:36 -07:00
|
|
|
subs r0, r0, #1
|
2014-06-30 16:29:12 +01:00
|
|
|
retls 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
|
2014-06-30 16:29:12 +01:00
|
|
|
ret lr
|
2024-04-23 08:50:38 +01:00
|
|
|
SYM_FUNC_END(__loop_delay)
|