timer-r0drv-freebsd.c revision 833f83ce101b6e9168f519decc0dc7a1079d35f7
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync/* $Id$ */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync/** @file
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * innotek Portable Runtime - Memory Allocation, Ring-0 Driver, FreeBSD.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync/*
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * Copyright (c) 2007 knut st. osmundsen <bird-src-spam@anduin.net>
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync *
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * Permission is hereby granted, free of charge, to any person
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * obtaining a copy of this software and associated documentation
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * files (the "Software"), to deal in the Software without
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * restriction, including without limitation the rights to use,
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * copy, modify, merge, publish, distribute, sublicense, and/or sell
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * copies of the Software, and to permit persons to whom the
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * Software is furnished to do so, subject to the following
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * conditions:
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync *
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * The above copyright notice and this permission notice shall be
930b5f872e89407f445d4000d4e4aaecaa6a0998vboxsync * included in all copies or substantial portions of the Software.
930b5f872e89407f445d4000d4e4aaecaa6a0998vboxsync *
930b5f872e89407f445d4000d4e4aaecaa6a0998vboxsync * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
930b5f872e89407f445d4000d4e4aaecaa6a0998vboxsync * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
930b5f872e89407f445d4000d4e4aaecaa6a0998vboxsync * OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
930b5f872e89407f445d4000d4e4aaecaa6a0998vboxsync * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
930b5f872e89407f445d4000d4e4aaecaa6a0998vboxsync * HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
930b5f872e89407f445d4000d4e4aaecaa6a0998vboxsync * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
930b5f872e89407f445d4000d4e4aaecaa6a0998vboxsync * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * OTHER DEALINGS IN THE SOFTWARE.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync/*******************************************************************************
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync* Header Files *
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync*******************************************************************************/
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync#include "the-freebsd-kernel.h"
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync#include <iprt/timer.h>
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync#include <iprt/time.h>
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync#include <iprt/spinlock.h>
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync#include <iprt/err.h>
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync#include <iprt/asm.h>
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync#include <iprt/assert.h>
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync#include <iprt/alloc.h>
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync#include "internal/magics.h"
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync/*******************************************************************************
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync* Structures and Typedefs *
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync*******************************************************************************/
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync/**
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * The internal representation of an FreeBSD timer handle.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsynctypedef struct RTTIMER
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** Magic.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * This is RTTIMER_MAGIC, but changes to something else before the timer
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * is destroyed to indicate clearly that thread should exit. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync uint32_t volatile u32Magic;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** Flag indicating the the timer is suspended. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync uint8_t volatile fSuspended;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** Whether the timer must run on a specific CPU or not. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync uint8_t fSpecificCpu;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** The CPU it must run on if fSpecificCpu is set. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync uint8_t iCpu;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** The FreeBSD callout structure. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync struct callout Callout;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** Callback. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync PFNRTTIMER pfnTimer;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** User argument. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync void *pvUser;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** The timer interval. 0 if one-shot. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync uint64_t u64NanoInterval;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** The start of the current run.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * This is used to calculate when the timer ought to fire the next time. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync uint64_t volatile u64StartTS;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** The start of the current run.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * This is used to calculate when the timer ought to fire the next time. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync uint64_t volatile u64NextTS;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /** The current tick number (since u64StartTS). */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync uint64_t volatile iTick;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync} RTTIMER;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync/*******************************************************************************
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync* Internal Functions *
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync*******************************************************************************/
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncstatic void rtTimerFreeBSDCallback(void *pvTimer);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncRTDECL(int) RTTimerCreateEx(PRTTIMER *ppTimer, uint64_t u64NanoInterval, unsigned fFlags, PFNRTTIMER pfnTimer, void *pvUser)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync *ppTimer = NULL;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /*
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * Validate flags.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if (!RTTIMER_FLAGS_IS_VALID(fFlags))
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VERR_INVALID_PARAMETER;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if ( (fFlags & RTTIMER_FLAGS_CPU_SPECIFIC)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync && (fFlags & RTTIMER_FLAGS_CPU_ALL) != RTTIMER_FLAGS_CPU_ALL
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync && (fFlags & RTTIMER_FLAGS_CPU_MASK) > mp_maxid)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VERR_INVALID_PARAMETER;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /*
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * Allocate and initialize the timer handle.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync PRTTIMER pTimer = (PRTTIMER)RTMemAlloc(sizeof(*pTimer));
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if (!pTimer)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VERR_NO_MEMORY;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->u32Magic = RTTIMER_MAGIC;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->fSuspended = true;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->fSpecificCpu = !!(fFlags & RTTIMER_FLAGS_CPU_SPECIFIC);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->iCpu = fFlags & RTTIMER_FLAGS_CPU_MASK;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->pfnTimer = pfnTimer;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->pvUser = pvUser;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->u64NanoInterval = u64NanoInterval;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->u64StartTS = 0;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync callout_init(&pTimer->Callout, CALLOUT_MPSAFE);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync *ppTimer = pTimer;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VINF_SUCCESS;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync}
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync/**
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * Validates the timer handle.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync *
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * @returns true if valid, false if invalid.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * @param pTimer The handle.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncDECLINLINE(bool) rtTimerIsValid(PRTTIMER pTimer)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync AssertReturn(VALID_PTR(pTimer), false);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync AssertReturn(pTimer->u32Magic == RTTIMER_MAGIC, false);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return true;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync}
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncRTDECL(int) RTTimerDestroy(PRTTIMER pTimer)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /* It's ok to pass NULL pointer. */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if (pTimer == /*NIL_RTTIMER*/ NULL)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VINF_SUCCESS;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if (!rtTimerIsValid(pTimer))
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VERR_INVALID_HANDLE;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /*
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * Free the associated resources.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->u32Magic++;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync callout_stop(&pTimer->Callout);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync RTMemFree(pTimer);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VINF_SUCCESS;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync}
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncRTDECL(int) RTTimerStart(PRTTIMER pTimer, uint64_t u64First)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync struct timeval tv;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if (!rtTimerIsValid(pTimer))
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VERR_INVALID_HANDLE;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if (!pTimer->fSuspended)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VERR_TIMER_ACTIVE;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /*
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * Calc when it should start fireing.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync u64First += RTTimeNanoTS();
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->fSuspended = false;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->iTick = 0;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->u64StartTS = u64First;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->u64NextTS = u64First;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync tv.tv_sec = u64First / 1000000000;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync tv.tv_usec = (u64First % 1000000000) / 1000;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync callout_reset(&pTimer->Callout, tvtohz(&tv), rtTimerFreeBSDCallback, pTimer);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VINF_SUCCESS;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync}
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncRTDECL(int) RTTimerStop(PRTTIMER pTimer)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if (!rtTimerIsValid(pTimer))
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VERR_INVALID_HANDLE;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if (pTimer->fSuspended)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VERR_TIMER_SUSPENDED;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /*
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * Suspend the timer.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->fSuspended = true;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync callout_stop(&pTimer->Callout);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VINF_SUCCESS;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync}
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync/**
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * smp_rendezvous action callback.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync *
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * This will perform the timer callback if we're on the right CPU.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync *
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync * @param pvTimer The timer.
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncstatic void rtTimerFreeBSDIpiAction(void *pvTimer)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync PRTTIMER pTimer = (PRTTIMER)pvTimer;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if ( pTimer->iCpu == RTTIMER_FLAGS_CPU_ALL
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync || (u_int)pTimer->iCpu == curcpu)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->pfnTimer(pTimer, pTimer->pvUser);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync}
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncstatic void rtTimerFreeBSDCallback(void *pvTimer)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync PRTTIMER pTimer = (PRTTIMER)pvTimer;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /* calculate and set the next timeout */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if (!pTimer->u64NanoInterval)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync {
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->fSuspended = true;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync callout_stop(&pTimer->Callout);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync }
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync else
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync {
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync struct timeval tv;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync const uint64_t u64NanoTS = RTTimeNanoTS();
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->u64NextTS = pTimer->u64StartTS + pTimer->iTick * pTimer->u64NanoInterval;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if (pTimer->u64NextTS < u64NanoTS)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->u64NextTS = u64NanoTS + RTTimerGetSystemGranularity() / 2;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync tv.tv_sec = pTimer->u64NextTS / 1000000000;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync tv.tv_usec = (pTimer->u64NextTS % 1000000000) / 1000;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync callout_reset(&pTimer->Callout, tvtohz(&tv), rtTimerFreeBSDCallback, pTimer);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync }
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync /* callback */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync if ( !pTimer->fSpecificCpu
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync || pTimer->iCpu == curcpu)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync pTimer->pfnTimer(pTimer, pTimer->pvUser);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync else
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync smp_rendezvous(NULL, rtTimerFreeBSDIpiAction, NULL, pvTimer);
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync}
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncRTDECL(uint32_t) RTTimerGetSystemGranularity(void)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return 1000000000 / hz; /* ns */
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync}
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncRTDECL(int) RTTimerRequestSystemGranularity(uint32_t u32Request, uint32_t *pu32Granted)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VERR_NOT_SUPPORTED;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync}
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsyncRTDECL(int) RTTimerReleaseSystemGranularity(uint32_t u32Granted)
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync{
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync return VERR_NOT_SUPPORTED;
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync}
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync
3194da424708abdd288b28d96892b3a5f3f7df0bvboxsync