libplatsupport/src/arch/x86/delay.c

/*
 * Copyright 2017, Data61, CSIRO (ABN 41 687 119 230)
 *
 * SPDX-License-Identifier: BSD-2-Clause
 */

#include <autoconf.h>
#include <platsupport/gen_config.h>
#include <platsupport/arch/tsc.h>
#include <platsupport/delay.h>
#include <stdint.h>
#include <stdio.h>

#define DEFAULT_CPUFREQ 1500000000UL

static unsigned long cpufreq_hint = DEFAULT_CPUFREQ;
#define CYCLES_PER_US(cpufreq) (cpufreq / 1000000)

static void
ps_do_cycle_delay(uint64_t cycles)
{
    uint64_t end = rdtsc_pure() + cycles;

    while (1) {
        if (end <= rdtsc_pure()) {
            break;
        }
    }
}

void
ps_udelay(unsigned long us)
{
    ps_do_cycle_delay((uint64_t)us * CYCLES_PER_US(cpufreq_hint));
}

void
ps_cpufreq_hint(unsigned long hz)
{
    if (hz == 0) {
        ZF_LOGW("%s:%d - Invalid CPU frequency for delay loop, use the default\n",
		__FILE__, __LINE__);
        hz = DEFAULT_CPUFREQ;
    }

    cpufreq_hint = hz;
}