162306a36Sopenharmony_ci/* 262306a36Sopenharmony_ci * This file is subject to the terms and conditions of the GNU General Public 362306a36Sopenharmony_ci * License. See the file "COPYING" in the main directory of this archive 462306a36Sopenharmony_ci * for more details. 562306a36Sopenharmony_ci * 662306a36Sopenharmony_ci * Copyright (C) 1994 by Waldorf Electronics 762306a36Sopenharmony_ci * Copyright (C) 1995 - 2000, 01, 03 by Ralf Baechle 862306a36Sopenharmony_ci * Copyright (C) 1999, 2000 Silicon Graphics, Inc. 962306a36Sopenharmony_ci * Copyright (C) 2007, 2014 Maciej W. Rozycki 1062306a36Sopenharmony_ci */ 1162306a36Sopenharmony_ci#include <linux/delay.h> 1262306a36Sopenharmony_ci#include <linux/export.h> 1362306a36Sopenharmony_ci#include <linux/param.h> 1462306a36Sopenharmony_ci#include <linux/smp.h> 1562306a36Sopenharmony_ci#include <linux/stringify.h> 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_ci#include <asm/asm.h> 1862306a36Sopenharmony_ci#include <asm/compiler.h> 1962306a36Sopenharmony_ci 2062306a36Sopenharmony_ci#ifndef CONFIG_CPU_DADDI_WORKAROUNDS 2162306a36Sopenharmony_ci#define GCC_DADDI_IMM_ASM() "I" 2262306a36Sopenharmony_ci#else 2362306a36Sopenharmony_ci#define GCC_DADDI_IMM_ASM() "r" 2462306a36Sopenharmony_ci#endif 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci#ifndef CONFIG_HAVE_PLAT_DELAY 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_civoid __delay(unsigned long loops) 2962306a36Sopenharmony_ci{ 3062306a36Sopenharmony_ci __asm__ __volatile__ ( 3162306a36Sopenharmony_ci " .set noreorder \n" 3262306a36Sopenharmony_ci " .align 3 \n" 3362306a36Sopenharmony_ci "1: bnez %0, 1b \n" 3462306a36Sopenharmony_ci " " __stringify(LONG_SUBU) " %0, %1 \n" 3562306a36Sopenharmony_ci " .set reorder \n" 3662306a36Sopenharmony_ci : "=r" (loops) 3762306a36Sopenharmony_ci : GCC_DADDI_IMM_ASM() (1), "0" (loops)); 3862306a36Sopenharmony_ci} 3962306a36Sopenharmony_ciEXPORT_SYMBOL(__delay); 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ci/* 4262306a36Sopenharmony_ci * Division by multiplication: you don't have to worry about 4362306a36Sopenharmony_ci * loss of precision. 4462306a36Sopenharmony_ci * 4562306a36Sopenharmony_ci * Use only for very small delays ( < 1 msec). Should probably use a 4662306a36Sopenharmony_ci * lookup table, really, as the multiplications take much too long with 4762306a36Sopenharmony_ci * short delays. This is a "reasonable" implementation, though (and the 4862306a36Sopenharmony_ci * first constant multiplications gets optimized away if the delay is 4962306a36Sopenharmony_ci * a constant) 5062306a36Sopenharmony_ci */ 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_civoid __udelay(unsigned long us) 5362306a36Sopenharmony_ci{ 5462306a36Sopenharmony_ci unsigned int lpj = raw_current_cpu_data.udelay_val; 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_ci __delay((us * 0x000010c7ull * HZ * lpj) >> 32); 5762306a36Sopenharmony_ci} 5862306a36Sopenharmony_ciEXPORT_SYMBOL(__udelay); 5962306a36Sopenharmony_ci 6062306a36Sopenharmony_civoid __ndelay(unsigned long ns) 6162306a36Sopenharmony_ci{ 6262306a36Sopenharmony_ci unsigned int lpj = raw_current_cpu_data.udelay_val; 6362306a36Sopenharmony_ci 6462306a36Sopenharmony_ci __delay((ns * 0x00000005ull * HZ * lpj) >> 32); 6562306a36Sopenharmony_ci} 6662306a36Sopenharmony_ciEXPORT_SYMBOL(__ndelay); 6762306a36Sopenharmony_ci 6862306a36Sopenharmony_ci#endif 69