mirror of
https://review.coreboot.org/flashrom.git
synced 2025-10-16 07:11:53 +02:00
3471cba18a
Change-Id: I3322366ebfa7db1d1f1e0fe60c808efd839b2858 Signed-off-by: Antonio Vázquez <antoniovazquezblanco@gmail.com> Reviewed-on: https://review.coreboot.org/c/flashrom/+/89369 Tested-by: build bot (Jenkins) <no-reply@coreboot.org> Reviewed-by: Anastasia Klimchuk <aklm@chromium.org> Reviewed-by: Stefan Reinauer <stefan.reinauer@coreboot.org>
108 lines
2.4 KiB
C
108 lines
2.4 KiB
C
/*
|
|
* This file is part of the flashrom project.
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0-or-later
|
|
* SPDX-FileCopyrightText: 2000 Silicon Integrated System Corporation
|
|
* SPDX-FileCopyrightText: 2009,2010 Carl-Daniel Hailfinger
|
|
* SPDX-FileCopyrightText: 2024 Google LLC
|
|
*/
|
|
|
|
#ifndef __LIBPAYLOAD__
|
|
|
|
#include "platform/udelay.h"
|
|
|
|
#include <stdbool.h>
|
|
#include <unistd.h>
|
|
#include <errno.h>
|
|
#include <time.h>
|
|
#include <sys/time.h>
|
|
#include <stdlib.h>
|
|
#include <limits.h>
|
|
#include "flash.h"
|
|
#include "programmer.h"
|
|
|
|
#if HAVE_CLOCK_GETTIME == 1
|
|
|
|
static void clock_usec_delay(int usecs)
|
|
{
|
|
static clockid_t clock_id =
|
|
#ifdef _POSIX_MONOTONIC_CLOCK
|
|
CLOCK_MONOTONIC;
|
|
#else
|
|
CLOCK_REALTIME;
|
|
#endif
|
|
|
|
struct timespec now;
|
|
if (clock_gettime(clock_id, &now)) {
|
|
/* Fall back to realtime clock if monotonic doesn't work */
|
|
if (clock_id != CLOCK_REALTIME && errno == EINVAL) {
|
|
clock_id = CLOCK_REALTIME;
|
|
clock_gettime(clock_id, &now);
|
|
}
|
|
}
|
|
|
|
const long end_nsec = now.tv_nsec + usecs * 1000L;
|
|
const struct timespec end = {
|
|
end_nsec / (1000 * 1000 * 1000) + now.tv_sec,
|
|
end_nsec % (1000 * 1000 * 1000)
|
|
};
|
|
do {
|
|
clock_gettime(clock_id, &now);
|
|
} while (now.tv_sec < end.tv_sec || (now.tv_sec == end.tv_sec && now.tv_nsec < end.tv_nsec));
|
|
}
|
|
|
|
#else
|
|
|
|
static void clock_usec_delay(unsigned int usecs) {
|
|
struct timeval start, end;
|
|
unsigned long elapsed = 0;
|
|
|
|
gettimeofday(&start, NULL);
|
|
|
|
while (elapsed < usecs) {
|
|
gettimeofday(&end, NULL);
|
|
elapsed = 1000000 * (end.tv_sec - start.tv_sec) +
|
|
(end.tv_usec - start.tv_usec);
|
|
/* Protect against time going forward too much. */
|
|
if ((end.tv_sec > start.tv_sec) &&
|
|
((end.tv_sec - start.tv_sec) >= LONG_MAX / 1000000 - 1))
|
|
elapsed = 0;
|
|
/* Protect against time going backwards during leap seconds. */
|
|
if ((end.tv_sec < start.tv_sec) || (elapsed > LONG_MAX))
|
|
elapsed = 0;
|
|
}
|
|
}
|
|
|
|
#endif /* HAVE_CLOCK_GETTIME == 1 */
|
|
|
|
/* Not very precise sleep. */
|
|
void internal_sleep(unsigned int usecs)
|
|
{
|
|
#if IS_WINDOWS
|
|
Sleep((usecs + 999) / 1000);
|
|
#else
|
|
nanosleep(&(struct timespec){usecs / 1000000, (usecs * 1000) % 1000000000UL}, NULL);
|
|
#endif
|
|
}
|
|
|
|
static const unsigned min_sleep = CONFIG_DELAY_MINIMUM_SLEEP_US;
|
|
|
|
/* Precise delay. */
|
|
void default_delay(unsigned int usecs)
|
|
{
|
|
if (usecs < min_sleep) {
|
|
clock_usec_delay(usecs);
|
|
} else {
|
|
internal_sleep(usecs);
|
|
}
|
|
}
|
|
|
|
#else
|
|
#include <libpayload.h>
|
|
|
|
void default_delay(unsigned int usecs)
|
|
{
|
|
udelay(usecs);
|
|
}
|
|
#endif
|